2001-05-14 Till Straumann <strauman@slac.stanford.edu>

	Per PR216, "libbsp/powerpc/shared" BSP has been modified considerably
	with the goal to make it more flexible and reusable by other
	BSPs. The main strategies were:
	    - eliminate hardcoded base addresses; devices use offsets
	      and a BSP defined base address.
	    - separate functionality into different files (e.g. reboot from
	      inch.c to reboot.c) which can be overridden by a 'derived' BSP.
	    - separate initialization code into separate files (e.g.  PCI
	      bridge detection/initialization was separated from the more
	      generic PCI access routines), also to make it easier for
	      'derived' BSPs to substitute their own initialization code.
	There are also a couple of enhancements and fixes:
	    - IRQ handling code now has a hook for attaching a VME bridge.
	    - OpenPIC is now explicitely initialized (polarities, senses).
	      Eliminated the implicit assumption on the presence of an ISA PIC.
	    - UART and console driver now supports more than 1 port. The current
	      maximum of 2 can easily be extended by enlarging a table (it
	      would even be easier if the ISR API was not broken by design).
	    - fixed polled_io.c so it correctly supports console on COM2
	    - fixed TLB invalidation code (start.S).
	    - exception handler prints a stack backtrace.
	    - added BSP_pciFindDevice() to scan the pci bus for a particular
	      vendor/device/instance.

1 files changed, 55 insertions, 0 deletions

diff --git a/c/src/lib/libbsp/powerpc/shared/pci/pcifinddevice.c b/c/src/lib/libbsp/powerpc/shared/pci/pcifinddevice.c
new file mode 100644
index 0000000000..a1d2a0d3ad
--- /dev/null
+++ b/c/src/lib/libbsp/powerpc/shared/pci/pcifinddevice.c
@@ -0,0 +1,55 @@
+
+/* Author: Till Straumann <strauman@slac.stanford.edu>, 2001 */
+
+/* find a particular PCI device
+ * (we assume, the firmware configured the PCI bus[es] for us)
+ *
+ * $Id$
+ */
+
+#define PCI_INVALID_VENDORDEVICEID	0xffffffff
+#define PCI_MULTI_FUNCTION			0x80
+
+#include <bsp/pci.h>
+#include <rtems/bspIo.h>
+
+int
+BSP_pciFindDevice(unsigned short vendorid, unsigned short deviceid,
+                int instance, int *pbus, int *pdev, int *pfun)
+{
+unsigned int d;
+unsigned short s;
+unsigned char bus,dev,fun,hd;
+
+	for (bus=0; bus<BusCountPCI(); bus++) {
+      for (dev=0; dev<PCI_MAX_DEVICES; dev++) {
+
+		pci_read_config_byte(bus,dev,0, PCI_HEADER_TYPE, &hd);
+		hd = (hd & PCI_MULTI_FUNCTION ? PCI_MAX_FUNCTIONS : 1);
+
+		for (fun=0; fun<hd; fun++) {
+			/* 
+			 * The last devfn id/slot is special; must skip it
+			 */
+			if (PCI_MAX_DEVICES-1==dev && PCI_MAX_FUNCTIONS-1 == fun)
+				break;
+			(void)pci_read_config_dword(bus,dev,fun,PCI_VENDOR_ID,&d);
+			if (PCI_INVALID_VENDORDEVICEID == d)
+				continue;
+#ifdef PCI_DEBUG
+			printk("BSP_pciFindDevice: found 0x%08x at %i/%i/%i\n",d,bus,dev,fun);
+#endif
+			(void) pci_read_config_word(bus,dev,fun,PCI_VENDOR_ID,&s);
+			if (vendorid != s)
+				continue;
+			(void) pci_read_config_word(bus,dev,fun,PCI_DEVICE_ID,&s);
+			if (deviceid == s) {
+				if (instance--) continue;
+				*pbus=bus; *pdev=dev; *pfun=fun;
+				return 0;
+			}
+		}
+      }
+	}
+    return -1;
+}