123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327 |
- #include "etherboot.h"
- #include "pci.h"
-
- /*
- * Ensure that there is sufficient space in the shared dev_bus
- * structure for a struct pci_device.
- *
- */
- DEV_BUS( struct pci_device, pci_dev );
- static char pci_magic[0]; /* guaranteed unique symbol */
-
- /*
- * pci_io.c may know how many buses we have, in which case it can
- * overwrite this value.
- *
- */
- unsigned int pci_max_bus = 0xff;
-
- /*
- * Fill in parameters (vendor & device ids, class, membase etc.) for a
- * PCI device based on bus & devfn.
- *
- * Returns 1 if a device was found, 0 for no device present.
- */
- static int fill_pci_device ( struct pci_device *pci ) {
- uint32_t l;
- int reg;
-
- /* Check bus is within range */
- if ( PCI_BUS ( pci->busdevfn ) > pci_max_bus )
- return 0;
-
- /* Check to see if there's anything physically present.
- */
- pci_read_config_dword ( pci, PCI_VENDOR_ID, &l );
- /* some broken boards return 0 if a slot is empty: */
- if ( ( l == 0xffffffff ) || ( l == 0x00000000 ) ) {
- return 0;
- }
- pci->vendor = l & 0xffff;
- pci->dev_id = ( l >> 16 ) & 0xffff;
-
- /* Check that we're not a duplicate function on a
- * non-multifunction device.
- */
- if ( PCI_FUNC ( pci->busdevfn ) != 0 ) {
- uint16_t save_busdevfn = pci->busdevfn;
- uint8_t header_type;
-
- pci->busdevfn &= ~PCI_FUNC ( 0xffff );
- pci_read_config_byte ( pci, PCI_HEADER_TYPE, &header_type );
- pci->busdevfn = save_busdevfn;
-
- if ( ! ( header_type & 0x80 ) ) {
- return 0;
- }
- }
-
- /* Get device class */
- pci_read_config_word ( pci, PCI_SUBCLASS_CODE, &pci->class );
-
- /* Get revision */
- pci_read_config_byte ( pci, PCI_REVISION, &pci->revision );
-
- /* Get the "membase" */
- pci_read_config_dword ( pci, PCI_BASE_ADDRESS_1, &pci->membase );
-
- /* Get the "ioaddr" */
- pci->ioaddr = 0;
- for ( reg = PCI_BASE_ADDRESS_0; reg <= PCI_BASE_ADDRESS_5; reg += 4 ) {
- pci_read_config_dword ( pci, reg, &pci->ioaddr );
- if ( pci->ioaddr & PCI_BASE_ADDRESS_SPACE_IO ) {
- pci->ioaddr &= PCI_BASE_ADDRESS_IO_MASK;
- if ( pci->ioaddr ) {
- break;
- }
- }
- pci->ioaddr = 0;
- }
-
- /* Get the irq */
- pci_read_config_byte ( pci, PCI_INTERRUPT_PIN, &pci->irq );
- if ( pci->irq ) {
- pci_read_config_byte ( pci, PCI_INTERRUPT_LINE, &pci->irq );
- }
-
- DBG ( "PCI found device %hhx:%hhx.%d Class %hx: %hx:%hx (rev %hhx)\n",
- PCI_BUS ( pci->busdevfn ), PCI_DEV ( pci->busdevfn ),
- PCI_FUNC ( pci->busdevfn ), pci->class, pci->vendor, pci->dev_id,
- pci->revision );
-
- return 1;
- }
-
- /*
- * Set device to be a busmaster in case BIOS neglected to do so. Also
- * adjust PCI latency timer to a reasonable value, 32.
- */
- void adjust_pci_device ( struct pci_device *pci ) {
- unsigned short new_command, pci_command;
- unsigned char pci_latency;
-
- pci_read_config_word ( pci, PCI_COMMAND, &pci_command );
- new_command = pci_command | PCI_COMMAND_MASTER | PCI_COMMAND_IO;
- if ( pci_command != new_command ) {
- DBG ( "PCI BIOS has not enabled device %hhx:%hhx.%d! "
- "Updating PCI command %hX->%hX\n",
- PCI_BUS ( pci->busdevfn ), PCI_DEV ( pci->busdevfn ),
- PCI_FUNC ( pci->busdevfn ), pci_command, new_command );
- pci_write_config_word ( pci, PCI_COMMAND, new_command );
- }
- pci_read_config_byte ( pci, PCI_LATENCY_TIMER, &pci_latency);
- if ( pci_latency < 32 ) {
- DBG ( "PCI device %hhx:%hhx.%d latency timer is "
- "unreasonably low at %d. Setting to 32.\n",
- PCI_BUS ( pci->busdevfn ), PCI_DEV ( pci->busdevfn ),
- PCI_FUNC ( pci->busdevfn ), pci_latency );
- pci_write_config_byte ( pci, PCI_LATENCY_TIMER, 32);
- }
- }
-
- /*
- * Set PCI device to use.
- *
- * This routine can be called by e.g. the ROM prefix to specify that
- * the first device to be tried should be the device on which the ROM
- * was physically located.
- *
- */
- void set_pci_device ( uint16_t busdevfn ) {
- pci_dev.magic = pci_magic;
- pci_dev.busdevfn = busdevfn;
- pci_dev.already_tried = 0;
- }
-
- /*
- * Find a PCI device matching the specified driver
- *
- */
- int find_pci_device ( struct pci_device *pci,
- struct pci_driver *driver ) {
- int i;
-
- /* Initialise struct pci if it's the first time it's been used. */
- if ( pci->magic != pci_magic ) {
- memset ( pci, 0, sizeof ( *pci ) );
- pci->magic = pci_magic;
- }
-
- /* Iterate through all possible PCI bus:dev.fn combinations,
- * starting where we left off.
- */
- DBG ( "PCI searching for device matching driver %s\n", driver->name );
- do {
- /* If we've already used this device, skip it */
- if ( pci->already_tried ) {
- pci->already_tried = 0;
- continue;
- }
-
- /* Fill in device parameters, if device present */
- if ( ! fill_pci_device ( pci ) ) {
- continue;
- }
-
- /* Fix up PCI device */
- adjust_pci_device ( pci );
-
- /* If driver has a class, and class matches, use it */
- if ( driver->class &&
- ( driver->class == pci->class ) ) {
- DBG ( "PCI found class %hx matching driver %s\n",
- driver->class, driver->name );
- pci->name = driver->name;
- pci->already_tried = 1;
- return 1;
- }
-
- /* If any of driver's IDs match, use it */
- for ( i = 0 ; i < driver->id_count; i++ ) {
- struct pci_id *id = &driver->ids[i];
-
- if ( ( pci->vendor == id->vendor ) &&
- ( pci->dev_id == id->dev_id ) ) {
- DBG ( "PCI found ID %hx:%hx (device %s) "
- "matching driver %s\n", id->vendor,
- id->dev_id, id->name, driver->name );
- pci->name = id->name;
- pci->already_tried = 1;
- return 1;
- }
- }
- } while ( ++pci->busdevfn );
-
- /* No device found */
- DBG ( "PCI found no device matching driver %s\n", driver->name );
- return 0;
- }
-
- /*
- * Find the next PCI device that can be used to boot using the
- * specified driver.
- *
- */
- int find_pci_boot_device ( struct dev *dev, struct pci_driver *driver ) {
- struct pci_device *pci = ( struct pci_device * )dev->bus;
-
- if ( ! find_pci_device ( pci, driver ) )
- return 0;
-
- dev->name = pci->name;
- dev->devid.bus_type = PCI_BUS_TYPE;
- dev->devid.vendor_id = pci->vendor;
- dev->devid.device_id = pci->dev_id;
-
- return 1;
- }
-
- /*
- * Find the start of a pci resource.
- */
- unsigned long pci_bar_start ( struct pci_device *pci, unsigned int index ) {
- uint32_t lo, hi;
- unsigned long bar;
-
- pci_read_config_dword ( pci, index, &lo );
- if ( lo & PCI_BASE_ADDRESS_SPACE_IO ) {
- bar = lo & PCI_BASE_ADDRESS_IO_MASK;
- } else {
- bar = 0;
- if ( ( lo & PCI_BASE_ADDRESS_MEM_TYPE_MASK ) ==
- PCI_BASE_ADDRESS_MEM_TYPE_64) {
- pci_read_config_dword ( pci, index + 4, &hi );
- if ( hi ) {
- #if ULONG_MAX > 0xffffffff
- bar = hi;
- bar <<= 32;
- #else
- printf ( "Unhandled 64bit BAR\n" );
- return -1UL;
- #endif
- }
- }
- bar |= lo & PCI_BASE_ADDRESS_MEM_MASK;
- }
- return bar + pci_bus_base ( pci );
- }
-
- /*
- * Find the size of a pci resource.
- */
- unsigned long pci_bar_size ( struct pci_device *pci, unsigned int bar ) {
- uint32_t start, size;
-
- /* Save the original bar */
- pci_read_config_dword ( pci, bar, &start );
- /* Compute which bits can be set */
- pci_write_config_dword ( pci, bar, ~0 );
- pci_read_config_dword ( pci, bar, &size );
- /* Restore the original size */
- pci_write_config_dword ( pci, bar, start );
- /* Find the significant bits */
- if ( start & PCI_BASE_ADDRESS_SPACE_IO ) {
- size &= PCI_BASE_ADDRESS_IO_MASK;
- } else {
- size &= PCI_BASE_ADDRESS_MEM_MASK;
- }
- /* Find the lowest bit set */
- size = size & ~( size - 1 );
- return size;
- }
-
- /**
- * pci_find_capability - query for devices' capabilities
- * @pci: PCI device to query
- * @cap: capability code
- *
- * Tell if a device supports a given PCI capability.
- * Returns the address of the requested capability structure within the
- * device's PCI configuration space or 0 in case the device does not
- * support it. Possible values for @cap:
- *
- * %PCI_CAP_ID_PM Power Management
- *
- * %PCI_CAP_ID_AGP Accelerated Graphics Port
- *
- * %PCI_CAP_ID_VPD Vital Product Data
- *
- * %PCI_CAP_ID_SLOTID Slot Identification
- *
- * %PCI_CAP_ID_MSI Message Signalled Interrupts
- *
- * %PCI_CAP_ID_CHSWP CompactPCI HotSwap
- */
- int pci_find_capability ( struct pci_device *pci, int cap ) {
- uint16_t status;
- uint8_t pos, id;
- uint8_t hdr_type;
- int ttl = 48;
-
- pci_read_config_word ( pci, PCI_STATUS, &status );
- if ( ! ( status & PCI_STATUS_CAP_LIST ) )
- return 0;
-
- pci_read_config_byte ( pci, PCI_HEADER_TYPE, &hdr_type );
- switch ( hdr_type & 0x7F ) {
- case PCI_HEADER_TYPE_NORMAL:
- case PCI_HEADER_TYPE_BRIDGE:
- default:
- pci_read_config_byte ( pci, PCI_CAPABILITY_LIST, &pos );
- break;
- case PCI_HEADER_TYPE_CARDBUS:
- pci_read_config_byte ( pci, PCI_CB_CAPABILITY_LIST, &pos );
- break;
- }
- while ( ttl-- && pos >= 0x40 ) {
- pos &= ~3;
- pci_read_config_byte ( pci, pos + PCI_CAP_LIST_ID, &id );
- DBG ( "Capability: %d\n", id );
- if ( id == 0xff )
- break;
- if ( id == cap )
- return pos;
- pci_read_config_byte ( pci, pos + PCI_CAP_LIST_NEXT, &pos );
- }
- return 0;
- }
|