diff options
author | Joel Sherrill <joel.sherrill@OARcorp.com> | 2007-09-06 16:33:32 +0000 |
---|---|---|
committer | Joel Sherrill <joel.sherrill@OARcorp.com> | 2007-09-06 16:33:32 +0000 |
commit | a7ff7e7f9d9869bfe105c68a4ed9710cecbb4401 (patch) | |
tree | 749d617e41092d3049ff27036ee78eba5334f818 | |
parent | 2007-09-06 Daniel Hellstrom <daniel@gaisler.com> (diff) | |
download | rtems-a7ff7e7f9d9869bfe105c68a4ed9710cecbb4401.tar.bz2 |
2007-09-06 Daniel Hellstrom <daniel@gaisler.com>
* shared/pci/pcifinddevice.c: New file.
-rw-r--r-- | c/src/lib/libbsp/sparc/ChangeLog | 4 | ||||
-rw-r--r-- | c/src/lib/libbsp/sparc/shared/pci/pcifinddevice.c | 57 |
2 files changed, 61 insertions, 0 deletions
diff --git a/c/src/lib/libbsp/sparc/ChangeLog b/c/src/lib/libbsp/sparc/ChangeLog index bf0e175e49..8a34e96c68 100644 --- a/c/src/lib/libbsp/sparc/ChangeLog +++ b/c/src/lib/libbsp/sparc/ChangeLog @@ -1,3 +1,7 @@ +2007-09-06 Daniel Hellstrom <daniel@gaisler.com> + + * shared/pci/pcifinddevice.c: New file. + 2007-09-06 Joel Sherrill <joel.sherrill@OARcorp.com> * shared/uart/apbuart.c: Fix some warnings. diff --git a/c/src/lib/libbsp/sparc/shared/pci/pcifinddevice.c b/c/src/lib/libbsp/sparc/shared/pci/pcifinddevice.c new file mode 100644 index 0000000000..f5a21fc07e --- /dev/null +++ b/c/src/lib/libbsp/sparc/shared/pci/pcifinddevice.c @@ -0,0 +1,57 @@ + +/* Author: Till Straumann <strauman@slac.stanford.edu>, 2001 */ + +/* find a particular PCI device + * (we assume, the firmware configured the PCI bus[es] for us) + * + * pcifinddevice.c,v 1.1.4.2 2003/07/18 15:48:54 joel Exp + */ + +#define PCI_INVALID_VENDORDEVICEID 0xffffffff +#define PCI_MULTI_FUNCTION 0x80 + +#include <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 %d/%d/%d\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; +} + +/* eof */ |