On Thu, Dec 05, 2013 at 09:44:25PM +0000, David Woodhouse wrote: > On Thu, 2013-12-05 at 21:26 +0000, David Woodhouse wrote: > > > > I think this is because the EHCI device has a lower PCI function > > (0:14.3) than its corresponding OHCI device (0:14.4)? > > It is indeed. And reading the EHCI spec, I see that the companion > controllers *must* have a lower function number than the EHCI. This > appears to be a hardware bug. Will chase internally, but may need a > quirk for this.
Right. It occurred to me that we could actually simplify the code by initializing all the ehci controllers and then init all the ohci/uhci controllers. The current complex interactions between the PCI walking and EHCI setup is really hard to understand. I put together a sample patch - see attached and at: https://github.com/KevinOConnor/seabios/tree/testing I've only lightly tested it. I think something like this would have to wait until after v1.7.4. -Kevin
>From 3aa68c32da6236728d3f20040ce7c9d33b89c991 Mon Sep 17 00:00:00 2001 Message-Id: <3aa68c32da6236728d3f20040ce7c9d33b89c991.1386287376.git.ke...@koconnor.net> From: Kevin O'Connor <[email protected]> Date: Thu, 5 Dec 2013 18:43:20 -0500 Subject: [PATCH] usb: Replace EHCI to UHCI/OHCI synchronization with new scheme. To: [email protected] The previous code attempts to correlate which UHCI and OHCI controllers correlate with which EHCI controllers so that it can ensure high speed devices are handled by the EHCI code while low/full speed devices are handled by the UHCI/OHCI code. Replace this logic by initializing all EHCI controllers first, and then initializing all UHCI and OHCI controllers. This simplifies the code and improves support for some hardware devices that don't follow the OHCI/UHCI to EHCI correlation standard. Also, remove the unused usb->busid field. Signed-off-by: Kevin O'Connor <[email protected]> --- src/hw/usb-ehci.c | 83 ++++++++++++++++++------------------------------------- src/hw/usb-ehci.h | 2 +- src/hw/usb-ohci.c | 21 ++++++++++---- src/hw/usb-ohci.h | 2 +- src/hw/usb-uhci.c | 21 ++++++++++---- src/hw/usb-uhci.h | 2 +- src/hw/usb-xhci.c | 26 +++++++++++------ src/hw/usb-xhci.h | 2 +- src/hw/usb.c | 59 ++++++++------------------------------- src/hw/usb.h | 1 - 10 files changed, 92 insertions(+), 127 deletions(-) diff --git a/src/hw/usb-ehci.c b/src/hw/usb-ehci.c index b495d6c..10c92fe 100644 --- a/src/hw/usb-ehci.c +++ b/src/hw/usb-ehci.c @@ -1,6 +1,6 @@ // Code for handling EHCI USB controllers. // -// Copyright (C) 2010 Kevin O'Connor <[email protected]> +// Copyright (C) 2010-2013 Kevin O'Connor <[email protected]> // // This file may be distributed under the terms of the GNU LGPLv3 license. @@ -14,8 +14,6 @@ #include "string.h" // memset #include "usb.h" // struct usb_s #include "usb-ehci.h" // struct ehci_qh -#include "usb-ohci.h" // ohci_setup -#include "usb-uhci.h" // uhci_setup #include "util.h" // msleep #include "x86.h" // readl @@ -24,9 +22,7 @@ struct usb_ehci_s { struct ehci_caps *caps; struct ehci_regs *regs; struct ehci_qh *async_qh; - struct pci_device *companion[8]; int checkports; - int legacycount; }; struct ehci_pipe { @@ -36,6 +32,8 @@ struct ehci_pipe { struct usb_pipe pipe; }; +static int PendingEHCIPorts; + /**************************************************************** * Root hub @@ -44,33 +42,6 @@ struct ehci_pipe { #define EHCI_TIME_POSTPOWER 20 #define EHCI_TIME_POSTRESET 2 -// Check if need companion controllers for full/low speed devices -static void -ehci_note_port(struct usb_ehci_s *cntl) -{ - if (--cntl->checkports) - // Ports still being detected. - return; - if (! cntl->legacycount) - // No full/low speed devices found. - return; - // Start companion controllers. - int i; - for (i=0; i<ARRAY_SIZE(cntl->companion); i++) { - struct pci_device *pci = cntl->companion[i]; - if (!pci) - break; - - // ohci/uhci_setup call pci_config_X - don't run from irq handler. - wait_preempt(); - - if (pci_classprog(pci) == PCI_CLASS_SERIAL_USB_UHCI) - uhci_setup(pci, cntl->usb.busid + i); - else if (pci_classprog(pci) == PCI_CLASS_SERIAL_USB_OHCI) - ohci_setup(pci, cntl->usb.busid + i); - } -} - // Check if device attached to port static int ehci_hub_detect(struct usbhub_s *hub, u32 port) @@ -97,7 +68,6 @@ ehci_hub_detect(struct usbhub_s *hub, u32 port) if ((portsc & PORT_LINESTATUS_MASK) == PORT_LINESTATUS_KSTATE) { // low speed device - cntl->legacycount++; writel(portreg, portsc | PORT_OWNER); goto doneearly; } @@ -111,7 +81,7 @@ ehci_hub_detect(struct usbhub_s *hub, u32 port) return 0; doneearly: - ehci_note_port(cntl); + PendingEHCIPorts--; return -1; } @@ -135,14 +105,13 @@ ehci_hub_reset(struct usbhub_s *hub, u32 port) goto resetfail; if (!(portsc & PORT_PE)) { // full speed device - cntl->legacycount++; writel(portreg, portsc | PORT_OWNER); goto resetfail; } rv = USB_HIGHSPEED; resetfail: - ehci_note_port(cntl); + PendingEHCIPorts--; return rv; } @@ -310,7 +279,6 @@ configure_ehci(void *data) // Set default of high speed for root hub. writel(&cntl->regs->configflag, 1); - cntl->checkports = readl(&cntl->caps->hcsparams) & HCS_N_PORTS_MASK; // Find devices int count = check_ehci_ports(cntl); @@ -329,12 +297,10 @@ fail: free(cntl); } -int -ehci_setup(struct pci_device *pci, int busid, struct pci_device *comppci) +static void +ehci_controller_setup(struct pci_device *pci) { - if (! CONFIG_USB_EHCI) - return -1; - + wait_preempt(); // Avoid pci_config_readl when preempting u16 bdf = pci->bdf; u32 baseaddr = pci_config_readl(bdf, PCI_BASE_ADDRESS_0); struct ehci_caps *caps = (void*)(baseaddr & PCI_BASE_ADDRESS_MEM_MASK); @@ -343,16 +309,17 @@ ehci_setup(struct pci_device *pci, int busid, struct pci_device *comppci) struct usb_ehci_s *cntl = malloc_tmphigh(sizeof(*cntl)); if (!cntl) { warn_noalloc(); - return -1; + return; } memset(cntl, 0, sizeof(*cntl)); - cntl->usb.busid = busid; cntl->usb.pci = pci; cntl->usb.type = USB_TYPE_EHCI; cntl->caps = caps; + cntl->checkports = readl(&cntl->caps->hcsparams) & HCS_N_PORTS_MASK; cntl->regs = (void*)caps + readb(&caps->caplength); if (hcc_params & HCC_64BIT_ADDR) cntl->regs->ctrldssegment = 0; + PendingEHCIPorts += cntl->checkports; dprintf(1, "EHCI init on dev %02x:%02x.%x (regs=%p)\n" , pci_bdf_to_bus(bdf), pci_bdf_to_dev(bdf) @@ -362,20 +329,24 @@ ehci_setup(struct pci_device *pci, int busid, struct pci_device *comppci) // XXX - check for and disable SMM control? - // Find companion controllers. - int count = 0; - for (;;) { - if (!comppci || comppci == pci) - break; - if (pci_classprog(comppci) == PCI_CLASS_SERIAL_USB_UHCI) - cntl->companion[count++] = comppci; - else if (pci_classprog(comppci) == PCI_CLASS_SERIAL_USB_OHCI) - cntl->companion[count++] = comppci; - comppci = container_of(comppci->node.next, struct pci_device, node); + run_thread(configure_ehci, cntl); +} + +void +ehci_setup(void) +{ + if (! CONFIG_USB_EHCI) + return; + struct pci_device *pci; + foreachpci(pci) { + if (pci_classprog(pci) == PCI_CLASS_SERIAL_USB_EHCI) + ehci_controller_setup(pci); } - run_thread(configure_ehci, cntl); - return 0; + // Wait for all EHCI ports to initialize. This forces OHCI/UHCI + // setup to always be after any EHCI ports are set to low speed. + while (PendingEHCIPorts) + yield(); } diff --git a/src/hw/usb-ehci.h b/src/hw/usb-ehci.h index 5672033..fcb8d94 100644 --- a/src/hw/usb-ehci.h +++ b/src/hw/usb-ehci.h @@ -2,7 +2,7 @@ #define __USB_EHCI_H // usb-ehci.c -int ehci_setup(struct pci_device *pci, int busid, struct pci_device *comppci); +void ehci_setup(void); struct usbdevice_s; struct usb_endpoint_descriptor; struct usb_pipe *ehci_alloc_pipe(struct usbdevice_s *usbdev diff --git a/src/hw/usb-ohci.c b/src/hw/usb-ohci.c index 313e3fd..d55b64a 100644 --- a/src/hw/usb-ohci.c +++ b/src/hw/usb-ohci.c @@ -9,6 +9,7 @@ #include "malloc.h" // free #include "output.h" // dprintf #include "pci.h" // pci_bdf_to_bus +#include "pci_ids.h" // PCI_CLASS_SERIAL_USB_OHCI #include "pci_regs.h" // PCI_BASE_ADDRESS_0 #include "string.h" // memset #include "usb.h" // struct usb_s @@ -265,21 +266,19 @@ free: free(intr_ed); } -void -ohci_setup(struct pci_device *pci, int busid) +static void +ohci_controller_setup(struct pci_device *pci) { - if (! CONFIG_USB_OHCI) - return; struct usb_ohci_s *cntl = malloc_tmphigh(sizeof(*cntl)); if (!cntl) { warn_noalloc(); return; } memset(cntl, 0, sizeof(*cntl)); - cntl->usb.busid = busid; cntl->usb.pci = pci; cntl->usb.type = USB_TYPE_OHCI; + wait_preempt(); // Avoid pci_config_readl when preempting u16 bdf = pci->bdf; u32 baseaddr = pci_config_readl(bdf, PCI_BASE_ADDRESS_0); cntl->regs = (void*)(baseaddr & PCI_BASE_ADDRESS_MEM_MASK); @@ -301,6 +300,18 @@ ohci_setup(struct pci_device *pci, int busid) run_thread(configure_ohci, cntl); } +void +ohci_setup(void) +{ + if (! CONFIG_USB_OHCI) + return; + struct pci_device *pci; + foreachpci(pci) { + if (pci_classprog(pci) == PCI_CLASS_SERIAL_USB_OHCI) + ohci_controller_setup(pci); + } +} + /**************************************************************** * End point communication diff --git a/src/hw/usb-ohci.h b/src/hw/usb-ohci.h index ad0ffec..3cae21f 100644 --- a/src/hw/usb-ohci.h +++ b/src/hw/usb-ohci.h @@ -2,7 +2,7 @@ #define __USB_OHCI_H // usb-ohci.c -void ohci_setup(struct pci_device *pci, int busid); +void ohci_setup(void); struct usbdevice_s; struct usb_endpoint_descriptor; struct usb_pipe *ohci_alloc_pipe(struct usbdevice_s *usbdev diff --git a/src/hw/usb-uhci.c b/src/hw/usb-uhci.c index 03eb5e1..2321e21 100644 --- a/src/hw/usb-uhci.c +++ b/src/hw/usb-uhci.c @@ -9,6 +9,7 @@ #include "malloc.h" // free #include "output.h" // dprintf #include "pci.h" // pci_bdf_to_bus +#include "pci_ids.h" // PCI_CLASS_SERIAL_USB_UHCI #include "pci_regs.h" // PCI_BASE_ADDRESS_4 #include "string.h" // memset #include "usb.h" // struct usb_s @@ -237,19 +238,17 @@ fail: free(cntl); } -void -uhci_setup(struct pci_device *pci, int busid) +static void +uhci_controller_setup(struct pci_device *pci) { - if (! CONFIG_USB_UHCI) - return; u16 bdf = pci->bdf; struct usb_uhci_s *cntl = malloc_tmphigh(sizeof(*cntl)); if (!cntl) { warn_noalloc(); return; } + wait_preempt(); // Avoid pci_config_readl when preempting memset(cntl, 0, sizeof(*cntl)); - cntl->usb.busid = busid; cntl->usb.pci = pci; cntl->usb.type = USB_TYPE_UHCI; cntl->iobase = (pci_config_readl(bdf, PCI_BASE_ADDRESS_4) @@ -266,6 +265,18 @@ uhci_setup(struct pci_device *pci, int busid) run_thread(configure_uhci, cntl); } +void +uhci_setup(void) +{ + if (! CONFIG_USB_UHCI) + return; + struct pci_device *pci; + foreachpci(pci) { + if (pci_classprog(pci) == PCI_CLASS_SERIAL_USB_UHCI) + uhci_controller_setup(pci); + } +} + /**************************************************************** * End point communication diff --git a/src/hw/usb-uhci.h b/src/hw/usb-uhci.h index b83c487..2916465 100644 --- a/src/hw/usb-uhci.h +++ b/src/hw/usb-uhci.h @@ -2,7 +2,7 @@ #define __USB_UHCI_H // usb-uhci.c -void uhci_setup(struct pci_device *pci, int busid); +void uhci_setup(void); struct usbdevice_s; struct usb_endpoint_descriptor; struct usb_pipe *uhci_alloc_pipe(struct usbdevice_s *usbdev diff --git a/src/hw/usb-xhci.c b/src/hw/usb-xhci.c index 66ce3c4..14f243c 100644 --- a/src/hw/usb-xhci.c +++ b/src/hw/usb-xhci.c @@ -5,6 +5,7 @@ #include "x86.h" // readl #include "malloc.h" // memalign_low #include "pci.h" // pci_bdf_to_bus +#include "pci_ids.h" // PCI_CLASS_SERIAL_USB_XHCI #include "pci_regs.h" // PCI_BASE_ADDRESS_0 #include "usb.h" // struct usb_s #include "usb-xhci.h" // struct ehci_qh @@ -1054,20 +1055,17 @@ xhci_poll_intr(struct usb_pipe *p, void *data) return 0; } -int -xhci_setup(struct pci_device *pci, int busid) +static void +xhci_controller_setup(struct pci_device *pci) { - ASSERT32FLAT(); - if (!CONFIG_USB_XHCI) - return -1; - struct usb_xhci_s *xhci = malloc_low(sizeof(*xhci)); if (!xhci) { warn_noalloc(); - return -1; + return; } memset(xhci, 0, sizeof(*xhci)); + wait_preempt(); // Avoid pci_config_readl when preempting xhci->baseaddr = pci_config_readl(pci->bdf, PCI_BASE_ADDRESS_0) & PCI_BASE_ADDRESS_MEM_MASK; xhci->caps = (void*)(xhci->baseaddr); @@ -1082,7 +1080,6 @@ xhci_setup(struct pci_device *pci, int busid) xhci->slots = hcs1 & 0xff; xhci->xcap = ((hcc >> 16) & 0xffff) << 2; - xhci->usb.busid = busid; xhci->usb.pci = pci; xhci->usb.type = USB_TYPE_XHCI; xhci->hub.cntl = &xhci->usb; @@ -1125,5 +1122,16 @@ xhci_setup(struct pci_device *pci, int busid) pci_config_maskw(pci->bdf, PCI_COMMAND, 0, PCI_COMMAND_MASTER); run_thread(configure_xhci, xhci); - return 0; +} + +void +xhci_setup(void) +{ + if (! CONFIG_USB_XHCI) + return; + struct pci_device *pci; + foreachpci(pci) { + if (pci_classprog(pci) == PCI_CLASS_SERIAL_USB_XHCI) + xhci_controller_setup(pci); + } } diff --git a/src/hw/usb-xhci.h b/src/hw/usb-xhci.h index 64ee82c..be6094c 100644 --- a/src/hw/usb-xhci.h +++ b/src/hw/usb-xhci.h @@ -8,7 +8,7 @@ struct usb_pipe; // -------------------------------------------------------------- // usb-xhci.c -int xhci_setup(struct pci_device *pci, int busid); +void xhci_setup(void); struct usb_pipe *xhci_alloc_pipe(struct usbdevice_s *usbdev , struct usb_endpoint_descriptor *epdesc); struct usb_pipe *xhci_update_pipe(struct usbdevice_s *usbdev diff --git a/src/hw/usb.c b/src/hw/usb.c index 8fe741f..8430e50 100644 --- a/src/hw/usb.c +++ b/src/hw/usb.c @@ -1,6 +1,6 @@ // Main code for handling USB controllers and devices. // -// Copyright (C) 2009 Kevin O'Connor <[email protected]> +// Copyright (C) 2009-2013 Kevin O'Connor <[email protected]> // // This file may be distributed under the terms of the GNU LGPLv3 license. @@ -8,9 +8,6 @@ #include "config.h" // CONFIG_* #include "malloc.h" // free #include "output.h" // dprintf -#include "pci.h" // foreachpci -#include "pci_ids.h" // PCI_CLASS_SERIAL_USB_UHCI -#include "pci_regs.h" // PCI_CLASS_REVISION #include "string.h" // memset #include "usb.h" // struct usb_s #include "usb-ehci.h" // ehci_setup @@ -439,52 +436,20 @@ usb_enumerate(struct usbhub_s *hub) } void +__usb_setup(void *data) +{ + dprintf(3, "init usb\n"); + xhci_setup(); + ehci_setup(); + uhci_setup(); + ohci_setup(); +} + +void usb_setup(void) { ASSERT32FLAT(); if (! CONFIG_USB) return; - - dprintf(3, "init usb\n"); - - // Look for USB controllers - int count = 0; - struct pci_device *pci, *ehcipci = NULL; - foreachpci(pci) { - if (pci->class != PCI_CLASS_SERIAL_USB) - continue; - - if (!ehcipci || pci->bdf >= ehcipci->bdf) { - // Check to see if this device has an ehci controller - int found = 0; - ehcipci = pci; - for (;;) { - if (pci_classprog(ehcipci) == PCI_CLASS_SERIAL_USB_EHCI) { - // Found an ehci controller. - int ret = ehci_setup(ehcipci, count++, pci); - if (ret) - // Error - break; - count += found; - pci = ehcipci; - break; - } - if (ehcipci->class == PCI_CLASS_SERIAL_USB) - found++; - ehcipci = container_of_or_null( - ehcipci->node.next, struct pci_device, node); - if (!ehcipci || (pci_bdf_to_busdev(ehcipci->bdf) - != pci_bdf_to_busdev(pci->bdf))) - // No ehci controller found. - break; - } - } - - if (pci_classprog(pci) == PCI_CLASS_SERIAL_USB_UHCI) - uhci_setup(pci, count++); - else if (pci_classprog(pci) == PCI_CLASS_SERIAL_USB_OHCI) - ohci_setup(pci, count++); - else if (pci_classprog(pci) == PCI_CLASS_SERIAL_USB_XHCI) - xhci_setup(pci, count++); - } + run_thread(__usb_setup, NULL); } diff --git a/src/hw/usb.h b/src/hw/usb.h index 22173fb..883c608 100644 --- a/src/hw/usb.h +++ b/src/hw/usb.h @@ -35,7 +35,6 @@ struct usb_s { struct usb_pipe *freelist; struct mutex_s resetlock; struct pci_device *pci; - int busid; u8 type; u8 maxaddr; }; -- 1.8.3.1
_______________________________________________ SeaBIOS mailing list [email protected] http://www.seabios.org/mailman/listinfo/seabios
