[SeaBIOS] [PATCH] EHCI: Add support for 64 bit capability

[Sven Schnelle]

Hi Kevin,
Sven Schnelle <svens at stackframe.org> writes:

> Kevin O'Connor <kevin at koconnor.net> writes:
>> On Mon, Jun 11, 2012 at 10:57:30PM +0200, Sven Schnelle wrote:
>>> Signed-off-by: Sven Schnelle <svens at stackframe.org>
>>
>> Thanks.  See my comments below.
>> [..]
> Thanks Kevin. I've updated my patch according to your suggestion.

That patch wasn't complete, sorry. I've attached another version ;)

commit 4b16e4f24a5ff99aa3169e59c233f700223c5b51
Author: Sven Schnelle <svens at stackframe.org>
Date:   Mon Jun 11 22:57:17 2012 +0200

    EHCI: Add support for 64 bit capability

    Signed-off-by: Sven Schnelle <svens at stackframe.org>

diff --git a/src/usb-ehci.c b/src/usb-ehci.c
index 4cb3e6a..3c0be13 100644
--- a/src/usb-ehci.c
+++ b/src/usb-ehci.c
@@ -334,10 +334,6 @@ ehci_init(struct pci_device *pci, int busid, struct pci_device *comppci)
     u32 baseaddr = pci_config_readl(bdf, PCI_BASE_ADDRESS_0);
     struct ehci_caps *caps = (void*)(baseaddr & PCI_BASE_ADDRESS_MEM_MASK);
     u32 hcc_params = readl(&caps->hccparams);
-    if (hcc_params & HCC_64BIT_ADDR) {
-        dprintf(1, "No support for 64bit EHCI\n");
-        return -1;
-    }

     struct usb_ehci_s *cntl = malloc_tmphigh(sizeof(*cntl));
     if (!cntl) {
@@ -349,6 +345,8 @@ ehci_init(struct pci_device *pci, int busid, struct pci_device *comppci)
     cntl->usb.pci = pci;
     cntl->usb.type = USB_TYPE_EHCI;
     cntl->caps = caps;
+    if (hcc_params & HCC_64BIT_ADDR)
+        cntl->regs->ctrldssegment = 0;
     cntl->regs = (void*)caps + readb(&caps->caplength);

     dprintf(1, "EHCI init on dev %02x:%02x.%x (regs=%p)\n"
diff --git a/src/usb-ehci.h b/src/usb-ehci.h
index b295c78..9baec98 100644
--- a/src/usb-ehci.h
+++ b/src/usb-ehci.h
@@ -90,7 +90,7 @@ struct ehci_regs {
 #define PORT_RWC_BITS   (PORT_CSC | PORT_PEC | PORT_OCC)


-#define EHCI_QH_ALIGN 64 // Can't span a 4K boundary, so increase to 64
+#define EHCI_QH_ALIGN 128 // Can't span a 4K boundary, so increase to 128

 struct ehci_qh {
     u32 next;
@@ -102,8 +102,8 @@ struct ehci_qh {
     u32 alt_next;
     u32 token;
     u32 buf[5];
-    // u32 buf_hi[5];
-} PACKED;
+    u32 buf_hi[5];
+} PACKED __aligned(EHCI_QH_ALIGN);

 #define QH_CONTROL       (1 << 27)
 #define QH_MAXPACKET_SHIFT 16
@@ -133,15 +133,18 @@ struct ehci_qh {
 #define EHCI_PTR_QH             0x0002


-#define EHCI_QTD_ALIGN 32
+#define EHCI_QTD_ALIGN 64

 struct ehci_qtd {
     u32 qtd_next;
     u32 alt_next;
     u32 token;
     u32 buf[5];
-    //u32 buf_hi[5];
-} PACKED;
+    u32 buf_hi[5];
+    /* keep struct size a multiple of 32 Bytes, as we're allocating
+       arrays. Without this padding, the second qtd would have the
+       wrong alignment. */
+} PACKED __aligned(EHCI_QTD_ALIGN);

 #define QTD_TOGGLE      (1 << 31)
 #define QTD_LENGTH_SHIFT 16

--
Sven Schnelle <sschnelle at astaro.com> | Software Architect
Astaro GmbH & Co. KG | http://www.astaro.com | Phone +49-721-25516-0 | Fax -200