[PATCH] libpayload: Fix the PCI search function

Remove a possiblity for evil recusion and fix the function and slot
definition in the PCI search loop

Signed-off-by: Jordan Crouse <jordan.crouse@amd.com>
Acked-by: Patrick Georgi <patrick.georgi@coresystems.de>


git-svn-id: svn://svn.coreboot.org/coreboot/trunk@3674 2b7e53f0-3cfb-0310-b3e9-8179ed1497e1
This commit is contained in:
Jordan Crouse 2008-10-20 16:52:06 +00:00
parent 20c9cf12a4
commit 6744231197

View file

@ -75,27 +75,36 @@ static int find_on_bus(int bus, unsigned short vid, unsigned short did,
unsigned char hdr; unsigned char hdr;
for (devfn = 0; devfn < 0x100; devfn++) { for (devfn = 0; devfn < 0x100; devfn++) {
val = pci_read_config32(PCI_DEV(bus, PCI_SLOT(devfn), int func = devfn & 0x7;
PCI_FUNC(devfn)), REG_VENDOR_ID); int slot = (devfn >> 3) & 0x1f;
val = pci_read_config32(PCI_DEV(bus, slot, func),
REG_VENDOR_ID);
if (val == 0xffffffff || val == 0x00000000 || if (val == 0xffffffff || val == 0x00000000 ||
val == 0x0000ffff || val == 0xffff0000) val == 0x0000ffff || val == 0xffff0000)
continue; continue;
if (val == ((did << 16) | vid)) { if (val == ((did << 16) | vid)) {
*dev = PCI_DEV(bus, PCI_SLOT(devfn), PCI_FUNC(devfn)); *dev = PCI_DEV(bus, slot, func);
return 1; return 1;
} }
hdr = pci_read_config8(PCI_DEV(bus, PCI_SLOT(devfn), hdr = pci_read_config8(PCI_DEV(bus, slot, func),
PCI_FUNC(devfn)), REG_HEADER_TYPE); REG_HEADER_TYPE);
hdr &= 0x7F; hdr &= 0x7F;
if (hdr == HEADER_TYPE_BRIDGE || hdr == HEADER_TYPE_CARDBUS) { if (hdr == HEADER_TYPE_BRIDGE || hdr == HEADER_TYPE_CARDBUS) {
unsigned int busses; unsigned int busses;
busses = pci_read_config32(PCI_DEV(bus, PCI_SLOT(devfn), busses = pci_read_config32(PCI_DEV(bus, slot, func),
PCI_FUNC(devfn)), REG_PRIMARY_BUS); REG_PRIMARY_BUS);
if (find_on_bus((busses >> 8) & 0xFF, vid, did, dev)) busses = (busses >> 8) & 0xFF;
/* Avoid recursion if the new bus is the same as
* the old bus (insert lame The Who joke here) */
if ((busses != bus) &&
find_on_bus(busses, vid, did, dev))
return 1; return 1;
} }
} }