v86 0.3.7 → 0.5.10

package/bios/seabios/src/hw/usb-xhci.c

@@ -1,1161 +0,0 @@
-// Code for handling XHCI "Super speed" USB controllers.
-//
-// Copyright (C) 2013  Gerd Hoffmann <kraxel@redhat.com>
-// Copyright (C) 2014  Kevin O'Connor <kevin@koconnor.net>
-//
-// This file may be distributed under the terms of the GNU LGPLv3 license.
-
-#include "config.h" // CONFIG_*
-#include "malloc.h" // memalign_low
-#include "memmap.h" // PAGE_SIZE
-#include "output.h" // dprintf
-#include "pcidevice.h" // foreachpci
-#include "pci_ids.h" // PCI_CLASS_SERIAL_USB_XHCI
-#include "pci_regs.h" // PCI_BASE_ADDRESS_0
-#include "string.h" // memcpy
-#include "usb.h" // struct usb_s
-#include "usb-xhci.h" // struct ehci_qh
-#include "util.h" // timer_calc
-#include "x86.h" // readl
-
-// --------------------------------------------------------------
-// configuration
-
-#define XHCI_RING_ITEMS          16
-#define XHCI_RING_SIZE           (XHCI_RING_ITEMS*sizeof(struct xhci_trb))
-
-/*
- *  xhci_ring structs are allocated with XHCI_RING_SIZE alignment,
- *  then we can get it from a trb pointer (provided by evt ring).
- */
-#define XHCI_RING(_trb)          \
-    ((struct xhci_ring*)((u32)(_trb) & ~(XHCI_RING_SIZE-1)))
-
-// --------------------------------------------------------------
-// bit definitions
-
-#define XHCI_CMD_RS              (1<<0)
-#define XHCI_CMD_HCRST           (1<<1)
-#define XHCI_CMD_INTE            (1<<2)
-#define XHCI_CMD_HSEE            (1<<3)
-#define XHCI_CMD_LHCRST          (1<<7)
-#define XHCI_CMD_CSS             (1<<8)
-#define XHCI_CMD_CRS             (1<<9)
-#define XHCI_CMD_EWE             (1<<10)
-#define XHCI_CMD_EU3S            (1<<11)
-
-#define XHCI_STS_HCH             (1<<0)
-#define XHCI_STS_HSE             (1<<2)
-#define XHCI_STS_EINT            (1<<3)
-#define XHCI_STS_PCD             (1<<4)
-#define XHCI_STS_SSS             (1<<8)
-#define XHCI_STS_RSS             (1<<9)
-#define XHCI_STS_SRE             (1<<10)
-#define XHCI_STS_CNR             (1<<11)
-#define XHCI_STS_HCE             (1<<12)
-
-#define XHCI_PORTSC_CCS          (1<<0)
-#define XHCI_PORTSC_PED          (1<<1)
-#define XHCI_PORTSC_OCA          (1<<3)
-#define XHCI_PORTSC_PR           (1<<4)
-#define XHCI_PORTSC_PLS_SHIFT        5
-#define XHCI_PORTSC_PLS_MASK     0xf
-#define XHCI_PORTSC_PP           (1<<9)
-#define XHCI_PORTSC_SPEED_SHIFT      10
-#define XHCI_PORTSC_SPEED_MASK   0xf
-#define XHCI_PORTSC_SPEED_FULL   (1<<10)
-#define XHCI_PORTSC_SPEED_LOW    (2<<10)
-#define XHCI_PORTSC_SPEED_HIGH   (3<<10)
-#define XHCI_PORTSC_SPEED_SUPER  (4<<10)
-#define XHCI_PORTSC_PIC_SHIFT        14
-#define XHCI_PORTSC_PIC_MASK     0x3
-#define XHCI_PORTSC_LWS          (1<<16)
-#define XHCI_PORTSC_CSC          (1<<17)
-#define XHCI_PORTSC_PEC          (1<<18)
-#define XHCI_PORTSC_WRC          (1<<19)
-#define XHCI_PORTSC_OCC          (1<<20)
-#define XHCI_PORTSC_PRC          (1<<21)
-#define XHCI_PORTSC_PLC          (1<<22)
-#define XHCI_PORTSC_CEC          (1<<23)
-#define XHCI_PORTSC_CAS          (1<<24)
-#define XHCI_PORTSC_WCE          (1<<25)
-#define XHCI_PORTSC_WDE          (1<<26)
-#define XHCI_PORTSC_WOE          (1<<27)
-#define XHCI_PORTSC_DR           (1<<30)
-#define XHCI_PORTSC_WPR          (1<<31)
-
-#define TRB_C               (1<<0)
-#define TRB_TYPE_SHIFT          10
-#define TRB_TYPE_MASK       0x3f
-#define TRB_TYPE(t)         (((t) >> TRB_TYPE_SHIFT) & TRB_TYPE_MASK)
-
-#define TRB_EV_ED           (1<<2)
-
-#define TRB_TR_ENT          (1<<1)
-#define TRB_TR_ISP          (1<<2)
-#define TRB_TR_NS           (1<<3)
-#define TRB_TR_CH           (1<<4)
-#define TRB_TR_IOC          (1<<5)
-#define TRB_TR_IDT          (1<<6)
-#define TRB_TR_TBC_SHIFT        7
-#define TRB_TR_TBC_MASK     0x3
-#define TRB_TR_BEI          (1<<9)
-#define TRB_TR_TLBPC_SHIFT      16
-#define TRB_TR_TLBPC_MASK   0xf
-#define TRB_TR_FRAMEID_SHIFT    20
-#define TRB_TR_FRAMEID_MASK 0x7ff
-#define TRB_TR_SIA          (1<<31)
-
-#define TRB_TR_DIR          (1<<16)
-
-#define TRB_CR_SLOTID_SHIFT     24
-#define TRB_CR_SLOTID_MASK  0xff
-#define TRB_CR_EPID_SHIFT       16
-#define TRB_CR_EPID_MASK    0x1f
-
-#define TRB_CR_BSR          (1<<9)
-#define TRB_CR_DC           (1<<9)
-
-#define TRB_LK_TC           (1<<1)
-
-#define TRB_INTR_SHIFT          22
-#define TRB_INTR_MASK       0x3ff
-#define TRB_INTR(t)         (((t).status >> TRB_INTR_SHIFT) & TRB_INTR_MASK)
-
-typedef enum TRBType {
-    TRB_RESERVED = 0,
-    TR_NORMAL,
-    TR_SETUP,
-    TR_DATA,
-    TR_STATUS,
-    TR_ISOCH,
-    TR_LINK,
-    TR_EVDATA,
-    TR_NOOP,
-    CR_ENABLE_SLOT,
-    CR_DISABLE_SLOT,
-    CR_ADDRESS_DEVICE,
-    CR_CONFIGURE_ENDPOINT,
-    CR_EVALUATE_CONTEXT,
-    CR_RESET_ENDPOINT,
-    CR_STOP_ENDPOINT,
-    CR_SET_TR_DEQUEUE,
-    CR_RESET_DEVICE,
-    CR_FORCE_EVENT,
-    CR_NEGOTIATE_BW,
-    CR_SET_LATENCY_TOLERANCE,
-    CR_GET_PORT_BANDWIDTH,
-    CR_FORCE_HEADER,
-    CR_NOOP,
-    ER_TRANSFER = 32,
-    ER_COMMAND_COMPLETE,
-    ER_PORT_STATUS_CHANGE,
-    ER_BANDWIDTH_REQUEST,
-    ER_DOORBELL,
-    ER_HOST_CONTROLLER,
-    ER_DEVICE_NOTIFICATION,
-    ER_MFINDEX_WRAP,
-} TRBType;
-
-typedef enum TRBCCode {
-    CC_INVALID = 0,
-    CC_SUCCESS,
-    CC_DATA_BUFFER_ERROR,
-    CC_BABBLE_DETECTED,
-    CC_USB_TRANSACTION_ERROR,
-    CC_TRB_ERROR,
-    CC_STALL_ERROR,
-    CC_RESOURCE_ERROR,
-    CC_BANDWIDTH_ERROR,
-    CC_NO_SLOTS_ERROR,
-    CC_INVALID_STREAM_TYPE_ERROR,
-    CC_SLOT_NOT_ENABLED_ERROR,
-    CC_EP_NOT_ENABLED_ERROR,
-    CC_SHORT_PACKET,
-    CC_RING_UNDERRUN,
-    CC_RING_OVERRUN,
-    CC_VF_ER_FULL,
-    CC_PARAMETER_ERROR,
-    CC_BANDWIDTH_OVERRUN,
-    CC_CONTEXT_STATE_ERROR,
-    CC_NO_PING_RESPONSE_ERROR,
-    CC_EVENT_RING_FULL_ERROR,
-    CC_INCOMPATIBLE_DEVICE_ERROR,
-    CC_MISSED_SERVICE_ERROR,
-    CC_COMMAND_RING_STOPPED,
-    CC_COMMAND_ABORTED,
-    CC_STOPPED,
-    CC_STOPPED_LENGTH_INVALID,
-    CC_MAX_EXIT_LATENCY_TOO_LARGE_ERROR = 29,
-    CC_ISOCH_BUFFER_OVERRUN = 31,
-    CC_EVENT_LOST_ERROR,
-    CC_UNDEFINED_ERROR,
-    CC_INVALID_STREAM_ID_ERROR,
-    CC_SECONDARY_BANDWIDTH_ERROR,
-    CC_SPLIT_TRANSACTION_ERROR
-} TRBCCode;
-
-enum {
-    PLS_U0              =  0,
-    PLS_U1              =  1,
-    PLS_U2              =  2,
-    PLS_U3              =  3,
-    PLS_DISABLED        =  4,
-    PLS_RX_DETECT       =  5,
-    PLS_INACTIVE        =  6,
-    PLS_POLLING         =  7,
-    PLS_RECOVERY        =  8,
-    PLS_HOT_RESET       =  9,
-    PLS_COMPILANCE_MODE = 10,
-    PLS_TEST_MODE       = 11,
-    PLS_RESUME          = 15,
-};
-
-#define xhci_get_field(data, field)             \
-    (((data) >> field##_SHIFT) & field##_MASK)
-
-// --------------------------------------------------------------
-// state structs
-
-struct xhci_ring {
-    struct xhci_trb      ring[XHCI_RING_ITEMS];
-    struct xhci_trb      evt;
-    u32                  eidx;
-    u32                  nidx;
-    u32                  cs;
-    struct mutex_s       lock;
-};
-
-struct xhci_portmap {
-    u8 start;
-    u8 count;
-};
-
-struct usb_xhci_s {
-    struct usb_s         usb;
-
-    /* devinfo */
-    u32                  xcap;
-    u32                  ports;
-    u32                  slots;
-    u8                   context64;
-    struct xhci_portmap  usb2;
-    struct xhci_portmap  usb3;
-
-    /* xhci registers */
-    struct xhci_caps     *caps;
-    struct xhci_op       *op;
-    struct xhci_pr       *pr;
-    struct xhci_ir       *ir;
-    struct xhci_db       *db;
-
-    /* xhci data structures */
-    struct xhci_devlist  *devs;
-    struct xhci_ring     *cmds;
-    struct xhci_ring     *evts;
-    struct xhci_er_seg   *eseg;
-};
-
-struct xhci_pipe {
-    struct xhci_ring     reqs;
-
-    struct usb_pipe      pipe;
-    u32                  slotid;
-    u32                  epid;
-    void                 *buf;
-    int                  bufused;
-};
-
-// --------------------------------------------------------------
-// tables
-
-static const char *speed_name[16] = {
-    [ 0 ] = " - ",
-    [ 1 ] = "Full",
-    [ 2 ] = "Low",
-    [ 3 ] = "High",
-    [ 4 ] = "Super",
-};
-
-static const int speed_from_xhci[16] = {
-    [ 0 ] = -1,
-    [ 1 ] = USB_FULLSPEED,
-    [ 2 ] = USB_LOWSPEED,
-    [ 3 ] = USB_HIGHSPEED,
-    [ 4 ] = USB_SUPERSPEED,
-    [ 5 ... 15 ] = -1,
-};
-
-static const int speed_to_xhci[] = {
-    [ USB_FULLSPEED  ] = 1,
-    [ USB_LOWSPEED   ] = 2,
-    [ USB_HIGHSPEED  ] = 3,
-    [ USB_SUPERSPEED ] = 4,
-};
-
-static int wait_bit(u32 *reg, u32 mask, int value, u32 timeout)
-{
-    u32 end = timer_calc(timeout);
-
-    while ((readl(reg) & mask) != value) {
-        if (timer_check(end)) {
-            warn_timeout();
-            return -1;
-        }
-        yield();
-    }
-    return 0;
-}
-
-
-/****************************************************************
- * Root hub
- ****************************************************************/
-
-#define XHCI_TIME_POSTPOWER 20
-
-// Check if device attached to port
-static void
-xhci_print_port_state(int loglevel, const char *prefix, u32 port, u32 portsc)
-{
-    u32 pls = xhci_get_field(portsc, XHCI_PORTSC_PLS);
-    u32 speed = xhci_get_field(portsc, XHCI_PORTSC_SPEED);
-
-    dprintf(loglevel, "%s port #%d: 0x%08x,%s%s pls %d, speed %d [%s]\n",
-            prefix, port + 1, portsc,
-            (portsc & XHCI_PORTSC_PP)  ? " powered," : "",
-            (portsc & XHCI_PORTSC_PED) ? " enabled," : "",
-            pls, speed, speed_name[speed]);
-}
-
-static int
-xhci_hub_detect(struct usbhub_s *hub, u32 port)
-{
-    struct usb_xhci_s *xhci = container_of(hub->cntl, struct usb_xhci_s, usb);
-    u32 portsc = readl(&xhci->pr[port].portsc);
-    return (portsc & XHCI_PORTSC_CCS) ? 1 : 0;
-}
-
-// Reset device on port
-static int
-xhci_hub_reset(struct usbhub_s *hub, u32 port)
-{
-    struct usb_xhci_s *xhci = container_of(hub->cntl, struct usb_xhci_s, usb);
-    u32 portsc = readl(&xhci->pr[port].portsc);
-    if (!(portsc & XHCI_PORTSC_CCS))
-        // Device no longer connected?!
-        return -1;
-
-    switch (xhci_get_field(portsc, XHCI_PORTSC_PLS)) {
-    case PLS_U0:
-        // A USB3 port - controller automatically performs reset
-        break;
-    case PLS_POLLING:
-        // A USB2 port - perform device reset
-        xhci_print_port_state(3, __func__, port, portsc);
-        writel(&xhci->pr[port].portsc, portsc | XHCI_PORTSC_PR);
-        break;
-    default:
-        return -1;
-    }
-
-    // Wait for device to complete reset and be enabled
-    u32 end = timer_calc(100);
-    for (;;) {
-        portsc = readl(&xhci->pr[port].portsc);
-        if (!(portsc & XHCI_PORTSC_CCS))
-            // Device disconnected during reset
-            return -1;
-        if (portsc & XHCI_PORTSC_PED)
-            // Reset complete
-            break;
-        if (timer_check(end)) {
-            warn_timeout();
-            return -1;
-        }
-        yield();
-    }
-
-    int rc = speed_from_xhci[xhci_get_field(portsc, XHCI_PORTSC_SPEED)];
-    xhci_print_port_state(1, "XHCI", port, portsc);
-    return rc;
-}
-
-static int
-xhci_hub_portmap(struct usbhub_s *hub, u32 vport)
-{
-    struct usb_xhci_s *xhci = container_of(hub->cntl, struct usb_xhci_s, usb);
-    u32 pport = vport + 1;
-
-    if (vport + 1 >= xhci->usb3.start &&
-        vport + 1 < xhci->usb3.start + xhci->usb3.count)
-        pport = vport + 2 - xhci->usb3.start;
-
-    if (vport + 1 >= xhci->usb2.start &&
-        vport + 1 < xhci->usb2.start + xhci->usb2.count)
-        pport = vport + 2 - xhci->usb2.start;
-
-    return pport;
-}
-
-static void
-xhci_hub_disconnect(struct usbhub_s *hub, u32 port)
-{
-    // XXX - should turn the port power off.
-}
-
-static struct usbhub_op_s xhci_hub_ops = {
-    .detect = xhci_hub_detect,
-    .reset = xhci_hub_reset,
-    .portmap = xhci_hub_portmap,
-    .disconnect = xhci_hub_disconnect,
-};
-
-// Find any devices connected to the root hub.
-static int
-xhci_check_ports(struct usb_xhci_s *xhci)
-{
-    // Wait for port power to stabilize.
-    msleep(XHCI_TIME_POSTPOWER);
-
-    struct usbhub_s hub;
-    memset(&hub, 0, sizeof(hub));
-    hub.cntl = &xhci->usb;
-    hub.portcount = xhci->ports;
-    hub.op = &xhci_hub_ops;
-    usb_enumerate(&hub);
-    return hub.devcount;
-}
-
-
-/****************************************************************
- * Setup
- ****************************************************************/
-
-static void
-xhci_free_pipes(struct usb_xhci_s *xhci)
-{
-    // XXX - should walk list of pipes and free unused pipes.
-}
-
-static void
-configure_xhci(void *data)
-{
-    struct usb_xhci_s *xhci = data;
-    u32 reg;
-
-    xhci->devs = memalign_high(64, sizeof(*xhci->devs) * (xhci->slots + 1));
-    xhci->eseg = memalign_high(64, sizeof(*xhci->eseg));
-    xhci->cmds = memalign_high(XHCI_RING_SIZE, sizeof(*xhci->cmds));
-    xhci->evts = memalign_high(XHCI_RING_SIZE, sizeof(*xhci->evts));
-    if (!xhci->devs || !xhci->cmds || !xhci->evts || !xhci->eseg) {
-        warn_noalloc();
-        goto fail;
-    }
-    memset(xhci->devs, 0, sizeof(*xhci->devs) * (xhci->slots + 1));
-    memset(xhci->cmds, 0, sizeof(*xhci->cmds));
-    memset(xhci->evts, 0, sizeof(*xhci->evts));
-    memset(xhci->eseg, 0, sizeof(*xhci->eseg));
-
-    reg = readl(&xhci->op->usbcmd);
-    if (reg & XHCI_CMD_RS) {
-        reg &= ~XHCI_CMD_RS;
-        writel(&xhci->op->usbcmd, reg);
-        if (wait_bit(&xhci->op->usbsts, XHCI_STS_HCH, XHCI_STS_HCH, 32) != 0)
-            goto fail;
-    }
-
-    dprintf(3, "%s: resetting\n", __func__);
-    writel(&xhci->op->usbcmd, XHCI_CMD_HCRST);
-    if (wait_bit(&xhci->op->usbcmd, XHCI_CMD_HCRST, 0, 100) != 0)
-        goto fail;
-    if (wait_bit(&xhci->op->usbsts, XHCI_STS_CNR, 0, 100) != 0)
-        goto fail;
-
-    writel(&xhci->op->config, xhci->slots);
-    writel(&xhci->op->dcbaap_low, (u32)xhci->devs);
-    writel(&xhci->op->dcbaap_high, 0);
-    writel(&xhci->op->crcr_low, (u32)xhci->cmds | 1);
-    writel(&xhci->op->crcr_high, 0);
-    xhci->cmds->cs = 1;
-
-    xhci->eseg->ptr_low = (u32)xhci->evts;
-    xhci->eseg->ptr_high = 0;
-    xhci->eseg->size = XHCI_RING_ITEMS;
-    writel(&xhci->ir->erstsz, 1);
-    writel(&xhci->ir->erdp_low, (u32)xhci->evts);
-    writel(&xhci->ir->erdp_high, 0);
-    writel(&xhci->ir->erstba_low, (u32)xhci->eseg);
-    writel(&xhci->ir->erstba_high, 0);
-    xhci->evts->cs = 1;
-
-    reg = readl(&xhci->caps->hcsparams2);
-    u32 spb = (reg >> 21 & 0x1f) << 5 | reg >> 27;
-    if (spb) {
-        dprintf(3, "%s: setup %d scratch pad buffers\n", __func__, spb);
-        u64 *spba = memalign_high(64, sizeof(*spba) * spb);
-        void *pad = memalign_high(PAGE_SIZE, PAGE_SIZE * spb);
-        if (!spba || !pad) {
-            warn_noalloc();
-            free(spba);
-            free(pad);
-            goto fail;
-        }
-        int i;
-        for (i = 0; i < spb; i++)
-            spba[i] = (u32)pad + (i * PAGE_SIZE);
-        xhci->devs[0].ptr_low = (u32)spba;
-        xhci->devs[0].ptr_high = 0;
-    }
-
-    reg = readl(&xhci->op->usbcmd);
-    reg |= XHCI_CMD_RS;
-    writel(&xhci->op->usbcmd, reg);
-
-    // Find devices
-    int count = xhci_check_ports(xhci);
-    xhci_free_pipes(xhci);
-    if (count)
-        // Success
-        return;
-
-    // No devices found - shutdown and free controller.
-    dprintf(1, "XHCI no devices found\n");
-    reg = readl(&xhci->op->usbcmd);
-    reg &= ~XHCI_CMD_RS;
-    writel(&xhci->op->usbcmd, reg);
-    wait_bit(&xhci->op->usbsts, XHCI_STS_HCH, XHCI_STS_HCH, 32);
-
-fail:
-    free(xhci->eseg);
-    free(xhci->evts);
-    free(xhci->cmds);
-    free(xhci->devs);
-    free(xhci);
-}
-
-static void
-xhci_controller_setup(struct pci_device *pci)
-{
-    void *baseaddr = pci_enable_membar(pci, PCI_BASE_ADDRESS_0);
-    if (!baseaddr)
-        return;
-
-    struct usb_xhci_s *xhci = malloc_high(sizeof(*xhci));
-    if (!xhci) {
-        warn_noalloc();
-        return;
-    }
-    memset(xhci, 0, sizeof(*xhci));
-    xhci->caps  = baseaddr;
-    xhci->op    = baseaddr + readb(&xhci->caps->caplength);
-    xhci->pr    = baseaddr + readb(&xhci->caps->caplength) + 0x400;
-    xhci->db    = baseaddr + readl(&xhci->caps->dboff);
-    xhci->ir    = baseaddr + readl(&xhci->caps->rtsoff) + 0x20;
-
-    u32 hcs1 = readl(&xhci->caps->hcsparams1);
-    u32 hcc  = readl(&xhci->caps->hccparams);
-    xhci->ports = (hcs1 >> 24) & 0xff;
-    xhci->slots = hcs1         & 0xff;
-    xhci->xcap  = ((hcc >> 16) & 0xffff) << 2;
-    xhci->context64 = (hcc & 0x04) ? 1 : 0;
-
-    xhci->usb.pci = pci;
-    xhci->usb.type = USB_TYPE_XHCI;
-
-    dprintf(1, "XHCI init on dev %pP: regs @ %p, %d ports, %d slots"
-            ", %d byte contexts\n"
-            , pci, xhci->caps, xhci->ports, xhci->slots
-            , xhci->context64 ? 64 : 32);
-
-    if (xhci->xcap) {
-        u32 off;
-        void *addr = baseaddr + xhci->xcap;
-        do {
-            struct xhci_xcap *xcap = addr;
-            u32 ports, name, cap = readl(&xcap->cap);
-            switch (cap & 0xff) {
-            case 0x02:
-                name  = readl(&xcap->data[0]);
-                ports = readl(&xcap->data[1]);
-                u8 major = (cap >> 24) & 0xff;
-                u8 minor = (cap >> 16) & 0xff;
-                u8 count = (ports >> 8) & 0xff;
-                u8 start = (ports >> 0) & 0xff;
-                dprintf(1, "XHCI    protocol %c%c%c%c %x.%02x"
-                        ", %d ports (offset %d), def %x\n"
-                        , (name >>  0) & 0xff
-                        , (name >>  8) & 0xff
-                        , (name >> 16) & 0xff
-                        , (name >> 24) & 0xff
-                        , major, minor
-                        , count, start
-                        , ports >> 16);
-                if (name == 0x20425355 /* "USB " */) {
-                    if (major == 2) {
-                        xhci->usb2.start = start;
-                        xhci->usb2.count = count;
-                    }
-                    if (major == 3) {
-                        xhci->usb3.start = start;
-                        xhci->usb3.count = count;
-                    }
-                }
-                break;
-            default:
-                dprintf(1, "XHCI    extcap 0x%x @ %p\n", cap & 0xff, addr);
-                break;
-            }
-            off = (cap >> 8) & 0xff;
-            addr += off << 2;
-        } while (off > 0);
-    }
-
-    u32 pagesize = readl(&xhci->op->pagesize);
-    if (PAGE_SIZE != (pagesize<<12)) {
-        dprintf(1, "XHCI driver does not support page size code %d\n"
-                , pagesize<<12);
-        free(xhci);
-        return;
-    }
-
-    pci_enable_busmaster(pci);
-
-    run_thread(configure_xhci, xhci);
-}
-
-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);
-    }
-}
-
-
-/****************************************************************
- * End point communication
- ****************************************************************/
-
-// Signal the hardware to process events on a TRB ring
-static void xhci_doorbell(struct usb_xhci_s *xhci, u32 slotid, u32 value)
-{
-    dprintf(5, "%s: slotid %d, epid %d\n", __func__, slotid, value);
-    struct xhci_db *db = xhci->db;
-    void *addr = &db[slotid].doorbell;
-    writel(addr, value);
-}
-
-// Dequeue events on the XHCI command ring generated by the hardware
-static void xhci_process_events(struct usb_xhci_s *xhci)
-{
-    struct xhci_ring *evts = xhci->evts;
-
-    for (;;) {
-        /* check for event */
-        u32 nidx = evts->nidx;
-        u32 cs = evts->cs;
-        struct xhci_trb *etrb = evts->ring + nidx;
-        u32 control = etrb->control;
-        if ((control & TRB_C) != (cs ? 1 : 0))
-            return;
-
-        /* process event */
-        u32 evt_type = TRB_TYPE(control);
-        u32 evt_cc = (etrb->status >> 24) & 0xff;
-        switch (evt_type) {
-        case ER_TRANSFER:
-        case ER_COMMAND_COMPLETE:
-        {
-            struct xhci_trb  *rtrb = (void*)etrb->ptr_low;
-            struct xhci_ring *ring = XHCI_RING(rtrb);
-            struct xhci_trb  *evt = &ring->evt;
-            u32 eidx = rtrb - ring->ring + 1;
-            dprintf(5, "%s: ring %p [trb %p, evt %p, type %d, eidx %d, cc %d]\n",
-                    __func__, ring, rtrb, evt, evt_type, eidx, evt_cc);
-            memcpy(evt, etrb, sizeof(*etrb));
-            ring->eidx = eidx;
-            break;
-        }
-        case ER_PORT_STATUS_CHANGE:
-        {
-            u32 port = ((etrb->ptr_low >> 24) & 0xff) - 1;
-            // Read status, and clear port status change bits
-            u32 portsc = readl(&xhci->pr[port].portsc);
-            u32 pclear = (((portsc & ~(XHCI_PORTSC_PED|XHCI_PORTSC_PR))
-                           & ~(XHCI_PORTSC_PLS_MASK<<XHCI_PORTSC_PLS_SHIFT))
-                          | (1<<XHCI_PORTSC_PLS_SHIFT));
-            writel(&xhci->pr[port].portsc, pclear);
-
-            xhci_print_port_state(3, __func__, port, portsc);
-            break;
-        }
-        default:
-            dprintf(1, "%s: unknown event, type %d, cc %d\n",
-                    __func__, evt_type, evt_cc);
-            break;
-        }
-
-        /* move ring index, notify xhci */
-        nidx++;
-        if (nidx == XHCI_RING_ITEMS) {
-            nidx = 0;
-            cs = cs ? 0 : 1;
-            evts->cs = cs;
-        }
-        evts->nidx = nidx;
-        struct xhci_ir *ir = xhci->ir;
-        u32 erdp = (u32)(evts->ring + nidx);
-        writel(&ir->erdp_low, erdp);
-        writel(&ir->erdp_high, 0);
-    }
-}
-
-// Check if a ring has any pending TRBs
-static int xhci_ring_busy(struct xhci_ring *ring)
-{
-    u32 eidx = ring->eidx;
-    u32 nidx = ring->nidx;
-    return (eidx != nidx);
-}
-
-// Wait for a ring to empty (all TRBs processed by hardware)
-static int xhci_event_wait(struct usb_xhci_s *xhci,
-                           struct xhci_ring *ring,
-                           u32 timeout)
-{
-    u32 end = timer_calc(timeout);
-
-    for (;;) {
-        xhci_process_events(xhci);
-        if (!xhci_ring_busy(ring)) {
-            u32 status = ring->evt.status;
-            return (status >> 24) & 0xff;
-        }
-        if (timer_check(end)) {
-            warn_timeout();
-            return -1;
-        }
-        yield();
-    }
-}
-
-// Add a TRB to the given ring
-static void xhci_trb_fill(struct xhci_ring *ring
-                          , void *data, u32 xferlen, u32 flags)
-{
-    struct xhci_trb *dst = &ring->ring[ring->nidx];
-    if (flags & TRB_TR_IDT) {
-        memcpy(&dst->ptr_low, data, xferlen);
-    } else {
-        dst->ptr_low = (u32)data;
-        dst->ptr_high = 0;
-    }
-    dst->status = xferlen;
-    dst->control = flags | (ring->cs ? TRB_C : 0);
-}
-
-// Queue a TRB onto a ring, wrapping ring as needed
-static void xhci_trb_queue(struct xhci_ring *ring,
-                           void *data, u32 xferlen, u32 flags)
-{
-    if (ring->nidx >= ARRAY_SIZE(ring->ring) - 1) {
-        xhci_trb_fill(ring, ring->ring, 0, (TR_LINK << 10) | TRB_LK_TC);
-        ring->nidx = 0;
-        ring->cs ^= 1;
-        dprintf(5, "%s: ring %p [linked]\n", __func__, ring);
-    }
-
-    xhci_trb_fill(ring, data, xferlen, flags);
-    ring->nidx++;
-    dprintf(5, "%s: ring %p [nidx %d, len %d]\n",
-            __func__, ring, ring->nidx, xferlen);
-}
-
-// Submit a command to the xhci controller ring
-static int xhci_cmd_submit(struct usb_xhci_s *xhci, struct xhci_inctx *inctx
-                           , u32 flags)
-{
-    if (inctx) {
-        struct xhci_slotctx *slot = (void*)&inctx[1 << xhci->context64];
-        u32 port = ((slot->ctx[1] >> 16) & 0xff) - 1;
-        u32 portsc = readl(&xhci->pr[port].portsc);
-        if (!(portsc & XHCI_PORTSC_CCS)) {
-            // Device no longer connected?!
-            xhci_print_port_state(1, __func__, port, portsc);
-            return -1;
-        }
-    }
-
-    mutex_lock(&xhci->cmds->lock);
-    xhci_trb_queue(xhci->cmds, inctx, 0, flags);
-    xhci_doorbell(xhci, 0, 0);
-    int rc = xhci_event_wait(xhci, xhci->cmds, 1000);
-    mutex_unlock(&xhci->cmds->lock);
-    return rc;
-}
-
-static int xhci_cmd_enable_slot(struct usb_xhci_s *xhci)
-{
-    dprintf(3, "%s:\n", __func__);
-    int cc = xhci_cmd_submit(xhci, NULL, CR_ENABLE_SLOT << 10);
-    if (cc != CC_SUCCESS)
-        return -1;
-    return (xhci->cmds->evt.control >> 24) & 0xff;
-}
-
-static int xhci_cmd_disable_slot(struct usb_xhci_s *xhci, u32 slotid)
-{
-    dprintf(3, "%s: slotid %d\n", __func__, slotid);
-    return xhci_cmd_submit(xhci, NULL, (CR_DISABLE_SLOT << 10) | (slotid << 24));
-}
-
-static int xhci_cmd_address_device(struct usb_xhci_s *xhci, u32 slotid
-                                   , struct xhci_inctx *inctx)
-{
-    dprintf(3, "%s: slotid %d\n", __func__, slotid);
-    return xhci_cmd_submit(xhci, inctx
-                           , (CR_ADDRESS_DEVICE << 10) | (slotid << 24));
-}
-
-static int xhci_cmd_configure_endpoint(struct usb_xhci_s *xhci, u32 slotid
-                                       , struct xhci_inctx *inctx)
-{
-    dprintf(3, "%s: slotid %d, add 0x%x, del 0x%x\n", __func__,
-            slotid, inctx->add, inctx->del);
-    return xhci_cmd_submit(xhci, inctx
-                           , (CR_CONFIGURE_ENDPOINT << 10) | (slotid << 24));
-}
-
-static int xhci_cmd_evaluate_context(struct usb_xhci_s *xhci, u32 slotid
-                                     , struct xhci_inctx *inctx)
-{
-    dprintf(3, "%s: slotid %d, add 0x%x, del 0x%x\n", __func__,
-            slotid, inctx->add, inctx->del);
-    return xhci_cmd_submit(xhci, inctx
-                           , (CR_EVALUATE_CONTEXT << 10) | (slotid << 24));
-}
-
-static struct xhci_inctx *
-xhci_alloc_inctx(struct usbdevice_s *usbdev, int maxepid)
-{
-    struct usb_xhci_s *xhci = container_of(
-        usbdev->hub->cntl, struct usb_xhci_s, usb);
-    int size = (sizeof(struct xhci_inctx) * 33) << xhci->context64;
-    struct xhci_inctx *in = memalign_tmphigh(2048 << xhci->context64, size);
-    if (!in) {
-        warn_noalloc();
-        return NULL;
-    }
-    memset(in, 0, size);
-
-    struct xhci_slotctx *slot = (void*)&in[1 << xhci->context64];
-    slot->ctx[0]    |= maxepid << 27; // context entries
-    slot->ctx[0]    |= speed_to_xhci[usbdev->speed] << 20;
-
-    // Set high-speed hub flags.
-    struct usbdevice_s *hubdev = usbdev->hub->usbdev;
-    if (hubdev) {
-        if (usbdev->speed == USB_LOWSPEED || usbdev->speed == USB_FULLSPEED) {
-            struct xhci_pipe *hpipe = container_of(
-                hubdev->defpipe, struct xhci_pipe, pipe);
-            if (hubdev->speed == USB_HIGHSPEED) {
-                slot->ctx[2] |= hpipe->slotid;
-                slot->ctx[2] |= (usbdev->port+1) << 8;
-            } else {
-                struct xhci_slotctx *hslot = (void*)xhci->devs[hpipe->slotid].ptr_low;
-                slot->ctx[2] = hslot->ctx[2];
-            }
-        }
-        u32 route = 0;
-        while (usbdev->hub->usbdev) {
-            route <<= 4;
-            route |= (usbdev->port+1) & 0xf;
-            usbdev = usbdev->hub->usbdev;
-        }
-        slot->ctx[0]    |= route;
-    }
-
-    slot->ctx[1]    |= (usbdev->port+1) << 16;
-
-    return in;
-}
-
-static int xhci_config_hub(struct usbhub_s *hub)
-{
-    struct usb_xhci_s *xhci = container_of(
-        hub->cntl, struct usb_xhci_s, usb);
-    struct xhci_pipe *pipe = container_of(
-        hub->usbdev->defpipe, struct xhci_pipe, pipe);
-    struct xhci_slotctx *hdslot = (void*)xhci->devs[pipe->slotid].ptr_low;
-    if ((hdslot->ctx[3] >> 27) == 3)
-        // Already configured
-        return 0;
-    struct xhci_inctx *in = xhci_alloc_inctx(hub->usbdev, 1);
-    if (!in)
-        return -1;
-    in->add = 0x01;
-    struct xhci_slotctx *slot = (void*)&in[1 << xhci->context64];
-    slot->ctx[0] |= 1 << 26;
-    slot->ctx[1] |= hub->portcount << 24;
-
-    int cc = xhci_cmd_configure_endpoint(xhci, pipe->slotid, in);
-    free(in);
-    if (cc != CC_SUCCESS) {
-        dprintf(1, "%s: configure hub: failed (cc %d)\n", __func__, cc);
-        return -1;
-    }
-    return 0;
-}
-
-static struct usb_pipe *
-xhci_alloc_pipe(struct usbdevice_s *usbdev
-                , struct usb_endpoint_descriptor *epdesc)
-{
-    u8 eptype = epdesc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK;
-    struct usb_xhci_s *xhci = container_of(
-        usbdev->hub->cntl, struct usb_xhci_s, usb);
-    struct xhci_pipe *pipe;
-    u32 epid;
-
-    if (epdesc->bEndpointAddress == 0) {
-        epid = 1;
-    } else {
-        epid = (epdesc->bEndpointAddress & 0x0f) * 2;
-        epid += (epdesc->bEndpointAddress & USB_DIR_IN) ? 1 : 0;
-    }
-
-    if (eptype == USB_ENDPOINT_XFER_CONTROL)
-        pipe = memalign_high(XHCI_RING_SIZE, sizeof(*pipe));
-    else
-        pipe = memalign_low(XHCI_RING_SIZE, sizeof(*pipe));
-    if (!pipe) {
-        warn_noalloc();
-        return NULL;
-    }
-    memset(pipe, 0, sizeof(*pipe));
-
-    usb_desc2pipe(&pipe->pipe, usbdev, epdesc);
-    pipe->epid = epid;
-    pipe->reqs.cs = 1;
-    if (eptype == USB_ENDPOINT_XFER_INT) {
-        pipe->buf = malloc_high(pipe->pipe.maxpacket);
-        if (!pipe->buf) {
-            warn_noalloc();
-            free(pipe);
-            return NULL;
-        }
-    }
-
-    // Allocate input context and initialize endpoint info.
-    struct xhci_inctx *in = xhci_alloc_inctx(usbdev, epid);
-    if (!in)
-        goto fail;
-    in->add = 0x01 | (1 << epid);
-    struct xhci_epctx *ep = (void*)&in[(pipe->epid+1) << xhci->context64];
-    if (eptype == USB_ENDPOINT_XFER_INT)
-        ep->ctx[0] = (usb_get_period(usbdev, epdesc) + 3) << 16;
-    ep->ctx[1]   |= eptype << 3;
-    if (epdesc->bEndpointAddress & USB_DIR_IN
-        || eptype == USB_ENDPOINT_XFER_CONTROL)
-        ep->ctx[1] |= 1 << 5;
-    ep->ctx[1]   |= pipe->pipe.maxpacket << 16;
-    ep->deq_low  = (u32)&pipe->reqs.ring[0];
-    ep->deq_low  |= 1;         // dcs
-    ep->length   = pipe->pipe.maxpacket;
-
-    dprintf(3, "%s: usbdev %p, ring %p, slotid %d, epid %d\n", __func__,
-            usbdev, &pipe->reqs, pipe->slotid, pipe->epid);
-    if (pipe->epid == 1) {
-        if (usbdev->hub->usbdev) {
-            // Make sure parent hub is configured.
-            int ret = xhci_config_hub(usbdev->hub);
-            if (ret)
-                goto fail;
-        }
-        // Enable slot.
-        u32 size = (sizeof(struct xhci_slotctx) * 32) << xhci->context64;
-        struct xhci_slotctx *dev = memalign_high(1024 << xhci->context64, size);
-        if (!dev) {
-            warn_noalloc();
-            goto fail;
-        }
-        int slotid = xhci_cmd_enable_slot(xhci);
-        if (slotid < 0) {
-            dprintf(1, "%s: enable slot: failed\n", __func__);
-            free(dev);
-            goto fail;
-        }
-        dprintf(3, "%s: enable slot: got slotid %d\n", __func__, slotid);
-        memset(dev, 0, size);
-        xhci->devs[slotid].ptr_low = (u32)dev;
-        xhci->devs[slotid].ptr_high = 0;
-
-        // Send set_address command.
-        int cc = xhci_cmd_address_device(xhci, slotid, in);
-        if (cc != CC_SUCCESS) {
-            dprintf(1, "%s: address device: failed (cc %d)\n", __func__, cc);
-            cc = xhci_cmd_disable_slot(xhci, slotid);
-            if (cc != CC_SUCCESS) {
-                dprintf(1, "%s: disable failed (cc %d)\n", __func__, cc);
-                goto fail;
-            }
-            xhci->devs[slotid].ptr_low = 0;
-            free(dev);
-            goto fail;
-        }
-        pipe->slotid = slotid;
-    } else {
-        struct xhci_pipe *defpipe = container_of(
-            usbdev->defpipe, struct xhci_pipe, pipe);
-        pipe->slotid = defpipe->slotid;
-        // Send configure command.
-        int cc = xhci_cmd_configure_endpoint(xhci, pipe->slotid, in);
-        if (cc != CC_SUCCESS) {
-            dprintf(1, "%s: configure endpoint: failed (cc %d)\n", __func__, cc);
-            goto fail;
-        }
-    }
-    free(in);
-    return &pipe->pipe;
-
-fail:
-    free(pipe->buf);
-    free(pipe);
-    free(in);
-    return NULL;
-}
-
-struct usb_pipe *
-xhci_realloc_pipe(struct usbdevice_s *usbdev, struct usb_pipe *upipe
-                  , struct usb_endpoint_descriptor *epdesc)
-{
-    if (!CONFIG_USB_XHCI)
-        return NULL;
-    if (!epdesc) {
-        usb_add_freelist(upipe);
-        return NULL;
-    }
-    if (!upipe)
-        return xhci_alloc_pipe(usbdev, epdesc);
-    u8 eptype = epdesc->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK;
-    int oldmaxpacket = upipe->maxpacket;
-    usb_desc2pipe(upipe, usbdev, epdesc);
-    struct xhci_pipe *pipe = container_of(upipe, struct xhci_pipe, pipe);
-    struct usb_xhci_s *xhci = container_of(
-        pipe->pipe.cntl, struct usb_xhci_s, usb);
-    dprintf(3, "%s: usbdev %p, ring %p, slotid %d, epid %d\n", __func__,
-            usbdev, &pipe->reqs, pipe->slotid, pipe->epid);
-    if (eptype != USB_ENDPOINT_XFER_CONTROL || upipe->maxpacket == oldmaxpacket)
-        return upipe;
-
-    // maxpacket has changed on control endpoint - update controller.
-    dprintf(1, "%s: reconf ctl endpoint pkt size: %d -> %d\n",
-            __func__, oldmaxpacket, pipe->pipe.maxpacket);
-    struct xhci_inctx *in = xhci_alloc_inctx(usbdev, 1);
-    if (!in)
-        return upipe;
-    in->add = (1 << 1);
-    struct xhci_epctx *ep = (void*)&in[2 << xhci->context64];
-    ep->ctx[1] |= (pipe->pipe.maxpacket << 16);
-    int cc = xhci_cmd_evaluate_context(xhci, pipe->slotid, in);
-    if (cc != CC_SUCCESS) {
-        dprintf(1, "%s: reconf ctl endpoint: failed (cc %d)\n",
-                __func__, cc);
-    }
-    free(in);
-
-    return upipe;
-}
-
-// Submit a USB "setup" message request to the pipe's ring
-static void xhci_xfer_setup(struct xhci_pipe *pipe, int dir, void *cmd
-                            , void *data, int datalen)
-{
-    struct usb_xhci_s *xhci = container_of(
-        pipe->pipe.cntl, struct usb_xhci_s, usb);
-    xhci_trb_queue(&pipe->reqs, cmd, USB_CONTROL_SETUP_SIZE
-                   , (TR_SETUP << 10) | TRB_TR_IDT
-                   | ((datalen ? (dir ? 3 : 2) : 0) << 16));
-    if (datalen)
-        xhci_trb_queue(&pipe->reqs, data, datalen, (TR_DATA << 10)
-                       | ((dir ? 1 : 0) << 16));
-    xhci_trb_queue(&pipe->reqs, NULL, 0, (TR_STATUS << 10) | TRB_TR_IOC
-                   | ((dir ? 0 : 1) << 16));
-    xhci_doorbell(xhci, pipe->slotid, pipe->epid);
-}
-
-// Submit a USB transfer request to the pipe's ring
-static void xhci_xfer_normal(struct xhci_pipe *pipe,
-                             void *data, int datalen)
-{
-    struct usb_xhci_s *xhci = container_of(
-        pipe->pipe.cntl, struct usb_xhci_s, usb);
-    xhci_trb_queue(&pipe->reqs, data, datalen, (TR_NORMAL << 10) | TRB_TR_IOC);
-    xhci_doorbell(xhci, pipe->slotid, pipe->epid);
-}
-
-int
-xhci_send_pipe(struct usb_pipe *p, int dir, const void *cmd
-               , void *data, int datalen)
-{
-    if (!CONFIG_USB_XHCI)
-        return -1;
-    struct xhci_pipe *pipe = container_of(p, struct xhci_pipe, pipe);
-    struct usb_xhci_s *xhci = container_of(
-        pipe->pipe.cntl, struct usb_xhci_s, usb);
-
-    if (cmd) {
-        const struct usb_ctrlrequest *req = cmd;
-        if (req->bRequest == USB_REQ_SET_ADDRESS)
-            // Set address command sent during xhci_alloc_pipe.
-            return 0;
-        xhci_xfer_setup(pipe, dir, (void*)req, data, datalen);
-    } else {
-        xhci_xfer_normal(pipe, data, datalen);
-    }
-
-    int cc = xhci_event_wait(xhci, &pipe->reqs, usb_xfer_time(p, datalen));
-    if (cc != CC_SUCCESS) {
-        dprintf(1, "%s: xfer failed (cc %d)\n", __func__, cc);
-        return -1;
-    }
-
-    return 0;
-}
-
-int VISIBLE32FLAT
-xhci_poll_intr(struct usb_pipe *p, void *data)
-{
-    if (!CONFIG_USB_XHCI)
-        return -1;
-
-    struct xhci_pipe *pipe = container_of(p, struct xhci_pipe, pipe);
-    struct usb_xhci_s *xhci = container_of(
-        pipe->pipe.cntl, struct usb_xhci_s, usb);
-    u32 len = pipe->pipe.maxpacket;
-    void *buf = pipe->buf;
-    int bufused = pipe->bufused;
-
-    if (!bufused) {
-        xhci_xfer_normal(pipe, buf, len);
-        bufused = 1;
-        pipe->bufused = bufused;
-        return -1;
-    }
-
-    xhci_process_events(xhci);
-    if (xhci_ring_busy(&pipe->reqs))
-        return -1;
-    dprintf(5, "%s: st %x ct %x [ %p <= %p / %d ]\n", __func__,
-            pipe->reqs.evt.status,
-            pipe->reqs.evt.control,
-            data, buf, len);
-    memcpy(data, buf, len);
-    xhci_xfer_normal(pipe, buf, len);
-    return 0;
-}