libpayload: Make usb_initialize more efficient and fix style problems.
The usb_initialize function would scan for USB host controllers by brute force iterating over all possible busses, devices, and functions. This change makes it recursively scan busses only if it finds them on the other side of a bridge, and only scan for functions beyond function 0 if the device claims to be multifunction. This change also takes the opportunity to clean up some style problems throughout the file. Change-Id: I0f5e8b9a454a42a76d30bccca898c8e1af770b2b Signed-off-by: Gabe Black <gabeblack@google.com> Reviewed-on: http://review.coreboot.org/1736 Reviewed-by: Patrick Georgi <patrick@georgi-clan.de> Tested-by: build bot (Jenkins)
This commit is contained in:
parent
78e15a31f2
commit
1b33c31cf3
|
@ -42,8 +42,7 @@
|
||||||
* @param dev PCI device id at bus
|
* @param dev PCI device id at bus
|
||||||
* @param func function id of the controller
|
* @param func function id of the controller
|
||||||
*/
|
*/
|
||||||
int
|
int usb_controller_initialize(int bus, int dev, int func)
|
||||||
usb_controller_initialize (int bus, int dev, int func)
|
|
||||||
{
|
{
|
||||||
u32 class;
|
u32 class;
|
||||||
u32 devclass;
|
u32 devclass;
|
||||||
|
@ -117,25 +116,45 @@ usb_controller_initialize (int bus, int dev, int func)
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static void usb_scan_pci_bus(int bus)
|
||||||
|
{
|
||||||
|
int dev, func;
|
||||||
|
for (dev = 0; dev < 32; dev++) {
|
||||||
|
u8 header_type;
|
||||||
|
pcidev_t addr = PCI_DEV(bus, dev, 0);
|
||||||
|
/* Check if there's a device here at all. */
|
||||||
|
if (pci_read_config32(addr, REG_VENDOR_ID) == 0xffff)
|
||||||
|
continue;
|
||||||
|
header_type = pci_read_config8(addr, REG_HEADER_TYPE);
|
||||||
|
/* If this is a bridge, scan the bus on the other side. */
|
||||||
|
if ((header_type & ~HEADER_TYPE_MULTIFUNCTION) ==
|
||||||
|
HEADER_TYPE_BRIDGE) {
|
||||||
|
int sub_bus =
|
||||||
|
pci_read_config8(addr, REG_SECONDARY_BUS);
|
||||||
|
usb_scan_pci_bus(sub_bus);
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
/*
|
||||||
|
* EHCI is defined by standards to be at a higher function
|
||||||
|
* than the USB1 controllers. We don't want to init USB1 +
|
||||||
|
* devices just to "steal" those for USB2, so make sure USB2
|
||||||
|
* comes first.
|
||||||
|
*/
|
||||||
|
/* Check for a multifunction device. */
|
||||||
|
if (header_type & HEADER_TYPE_MULTIFUNCTION)
|
||||||
|
for (func = 7; func > 0; func--)
|
||||||
|
usb_controller_initialize(bus, dev, func);
|
||||||
|
/* Initialize function 0. */
|
||||||
|
usb_controller_initialize(bus, dev, 0);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
/**
|
/**
|
||||||
* Initialize all USB controllers attached to PCI.
|
* Initialize all USB controllers attached to PCI.
|
||||||
*/
|
*/
|
||||||
int
|
int usb_initialize(void)
|
||||||
usb_initialize (void)
|
|
||||||
{
|
{
|
||||||
int bus, dev, func;
|
usb_scan_pci_bus(0);
|
||||||
/* EHCI is defined by standards to be at a
|
|
||||||
* higher function than the USB1 controllers.
|
|
||||||
* We don't want to init USB1 + devices just to
|
|
||||||
* "steal" those for USB2, so make sure USB2
|
|
||||||
* comes first.
|
|
||||||
*/
|
|
||||||
for (bus = 0; bus < 256; bus++)
|
|
||||||
for (dev = 0; dev < 32; dev++)
|
|
||||||
if (pci_read_config32 (PCI_DEV(bus, dev, 0), 8) >> 16 != 0xffff)
|
|
||||||
for (func = 7; func >= 0 ; func--)
|
|
||||||
usb_controller_initialize (bus, dev, func);
|
|
||||||
usb_poll();
|
usb_poll();
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
Loading…
Reference in New Issue