Skip to content

Q
qemu

openeuler / qemu

通知 10
Star 0
Fork 0
Q
qemu
提交 962d11e1 编写于 作者: G Gerd Hoffmann
浏览文件
操作

xhci: add XHCIInterrupter 

Move all state belonging to the (single) interrupter into a separate
struct.  First step in adding support for multiple interrupters.
Signed-off-by: NGerd Hoffmann <kraxel@redhat.com>
上级 2cae4119
隐藏空白更改
内联 并排
Showing with 161 addition and 148 deletion
hw/usb/hcd-xhci.c
浏览文件 @ 962d11e1
...@@ -378,6 +378,27 @@ typedef struct XHCIEvent { ...@@ -378,6 +378,27 @@ typedef struct XHCIEvent {
uint8_t epid; uint8_t epid;
} XHCIEvent; } XHCIEvent;
typedef struct XHCIInterrupter {
uint32_t iman;
uint32_t imod;
uint32_t erstsz;
uint32_t erstba_low;
uint32_t erstba_high;
uint32_t erdp_low;
uint32_t erdp_high;
bool msix_used, er_pcs, er_full;
dma_addr_t er_start;
uint32_t er_size;
unsigned int er_ep_idx;
XHCIEvent ev_buffer[EV_QUEUE];
unsigned int ev_buffer_put;
unsigned int ev_buffer_get;
} XHCIInterrupter;
struct XHCIState { struct XHCIState {
PCIDevice pci_dev; PCIDevice pci_dev;
USBBus bus; USBBus bus;
...@@ -407,27 +428,9 @@ struct XHCIState { ...@@ -407,27 +428,9 @@ struct XHCIState {
uint32_t numports; uint32_t numports;
/* Runtime Registers */ /* Runtime Registers */
uint32_t iman;
uint32_t imod;
uint32_t erstsz;
uint32_t erstba_low;
uint32_t erstba_high;
uint32_t erdp_low;
uint32_t erdp_high;
bool msix_used;
int64_t mfindex_start; int64_t mfindex_start;
QEMUTimer *mfwrap_timer; QEMUTimer *mfwrap_timer;
XHCIInterrupter intr[MAXINTRS];
dma_addr_t er_start;
uint32_t er_size;
bool er_pcs;
unsigned int er_ep_idx;
bool er_full;
XHCIEvent ev_buffer[EV_QUEUE];
unsigned int ev_buffer_put;
unsigned int ev_buffer_get;
XHCIRing cmd_ring; XHCIRing cmd_ring;
}; };
...@@ -446,8 +449,8 @@ enum xhci_flags { ...@@ -446,8 +449,8 @@ enum xhci_flags {
static void xhci_kick_ep(XHCIState *xhci, unsigned int slotid, static void xhci_kick_ep(XHCIState *xhci, unsigned int slotid,
unsigned int epid); unsigned int epid);
static void xhci_event(XHCIState *xhci, XHCIEvent *event); static void xhci_event(XHCIState *xhci, XHCIEvent *event, int v);
static void xhci_write_event(XHCIState *xhci, XHCIEvent *event); static void xhci_write_event(XHCIState *xhci, XHCIEvent *event, int v);
static const char *TRBType_names[] = { static const char *TRBType_names[] = {
[TRB_RESERVED] = "TRB_RESERVED", [TRB_RESERVED] = "TRB_RESERVED",
...@@ -573,7 +576,7 @@ static void xhci_mfwrap_timer(void *opaque) ...@@ -573,7 +576,7 @@ static void xhci_mfwrap_timer(void *opaque)
XHCIState *xhci = opaque; XHCIState *xhci = opaque;
XHCIEvent wrap = { ER_MFINDEX_WRAP, CC_SUCCESS }; XHCIEvent wrap = { ER_MFINDEX_WRAP, CC_SUCCESS };
xhci_event(xhci, &wrap); xhci_event(xhci, &wrap, 0);
xhci_mfwrap_update(xhci); xhci_mfwrap_update(xhci);
} }
...@@ -626,8 +629,8 @@ static void xhci_intx_update(XHCIState *xhci) ...@@ -626,8 +629,8 @@ static void xhci_intx_update(XHCIState *xhci)
return; return;
} }
if (xhci->iman & IMAN_IP && if (xhci->intr[0].iman & IMAN_IP &&
xhci->iman & IMAN_IE && xhci->intr[0].iman & IMAN_IE &&
xhci->usbcmd & USBCMD_INTE) { xhci->usbcmd & USBCMD_INTE) {
level = 1; level = 1;
} }
...@@ -636,7 +639,7 @@ static void xhci_intx_update(XHCIState *xhci) ...@@ -636,7 +639,7 @@ static void xhci_intx_update(XHCIState *xhci)
qemu_set_irq(xhci->irq, level); qemu_set_irq(xhci->irq, level);
} }
static void xhci_msix_update(XHCIState *xhci) static void xhci_msix_update(XHCIState *xhci, int v)
{ {
bool enabled; bool enabled;
...@@ -644,29 +647,29 @@ static void xhci_msix_update(XHCIState *xhci) ...@@ -644,29 +647,29 @@ static void xhci_msix_update(XHCIState *xhci)
return; return;
} }
enabled = xhci->iman & IMAN_IE; enabled = xhci->intr[v].iman & IMAN_IE;
if (enabled == xhci->msix_used) { if (enabled == xhci->intr[v].msix_used) {
return; return;
} }
if (enabled) { if (enabled) {
trace_usb_xhci_irq_msix_use(0); trace_usb_xhci_irq_msix_use(v);
msix_vector_use(&xhci->pci_dev, 0); msix_vector_use(&xhci->pci_dev, v);
xhci->msix_used = true; xhci->intr[v].msix_used = true;
} else { } else {
trace_usb_xhci_irq_msix_unuse(0); trace_usb_xhci_irq_msix_unuse(v);
msix_vector_unuse(&xhci->pci_dev, 0); msix_vector_unuse(&xhci->pci_dev, v);
xhci->msix_used = false; xhci->intr[v].msix_used = false;
} }
} }
static void xhci_intr_raise(XHCIState *xhci) static void xhci_intr_raise(XHCIState *xhci, int v)
{ {
xhci->erdp_low |= ERDP_EHB; xhci->intr[v].erdp_low |= ERDP_EHB;
xhci->iman |= IMAN_IP; xhci->intr[v].iman |= IMAN_IP;
xhci->usbsts |= USBSTS_EINT; xhci->usbsts |= USBSTS_EINT;
if (!(xhci->iman & IMAN_IE)) { if (!(xhci->intr[v].iman & IMAN_IE)) {
return; return;
} }
...@@ -675,24 +678,26 @@ static void xhci_intr_raise(XHCIState *xhci) ...@@ -675,24 +678,26 @@ static void xhci_intr_raise(XHCIState *xhci)
} }
if (msix_enabled(&xhci->pci_dev)) { if (msix_enabled(&xhci->pci_dev)) {
trace_usb_xhci_irq_msix(0); trace_usb_xhci_irq_msix(v);
msix_notify(&xhci->pci_dev, 0); msix_notify(&xhci->pci_dev, v);
return; return;
} }
if (msi_enabled(&xhci->pci_dev)) { if (msi_enabled(&xhci->pci_dev)) {
trace_usb_xhci_irq_msi(0); trace_usb_xhci_irq_msi(v);
msi_notify(&xhci->pci_dev, 0); msi_notify(&xhci->pci_dev, v);
return; return;
} }
trace_usb_xhci_irq_intx(1); if (v == 0) {
qemu_set_irq(xhci->irq, 1); trace_usb_xhci_irq_intx(1);
qemu_set_irq(xhci->irq, 1);
}
} }
static inline int xhci_running(XHCIState *xhci) static inline int xhci_running(XHCIState *xhci)
{ {
return !(xhci->usbsts & USBSTS_HCH) && !xhci->er_full; return !(xhci->usbsts & USBSTS_HCH) && !xhci->intr[0].er_full;
} }
static void xhci_die(XHCIState *xhci) static void xhci_die(XHCIState *xhci)
...@@ -701,8 +706,9 @@ static void xhci_die(XHCIState *xhci) ...@@ -701,8 +706,9 @@ static void xhci_die(XHCIState *xhci)
fprintf(stderr, "xhci: asserted controller error\n"); fprintf(stderr, "xhci: asserted controller error\n");
} }
static void xhci_write_event(XHCIState *xhci, XHCIEvent *event) static void xhci_write_event(XHCIState *xhci, XHCIEvent *event, int v)
{ {
XHCIInterrupter *intr = &xhci->intr[v];
XHCITRB ev_trb; XHCITRB ev_trb;
dma_addr_t addr; dma_addr_t addr;
...@@ -710,27 +716,28 @@ static void xhci_write_event(XHCIState *xhci, XHCIEvent *event) ...@@ -710,27 +716,28 @@ static void xhci_write_event(XHCIState *xhci, XHCIEvent *event)
ev_trb.status = cpu_to_le32(event->length | (event->ccode << 24)); ev_trb.status = cpu_to_le32(event->length | (event->ccode << 24));
ev_trb.control = (event->slotid << 24) | (event->epid << 16) | ev_trb.control = (event->slotid << 24) | (event->epid << 16) |
event->flags | (event->type << TRB_TYPE_SHIFT); event->flags | (event->type << TRB_TYPE_SHIFT);
if (xhci->er_pcs) { if (intr->er_pcs) {
ev_trb.control |= TRB_C; ev_trb.control |= TRB_C;
} }
ev_trb.control = cpu_to_le32(ev_trb.control); ev_trb.control = cpu_to_le32(ev_trb.control);
trace_usb_xhci_queue_event(xhci->er_ep_idx, trb_name(&ev_trb), trace_usb_xhci_queue_event(v, intr->er_ep_idx, trb_name(&ev_trb),
event_name(event), ev_trb.parameter, event_name(event), ev_trb.parameter,
ev_trb.status, ev_trb.control); ev_trb.status, ev_trb.control);
addr = xhci->er_start + TRB_SIZE*xhci->er_ep_idx; addr = intr->er_start + TRB_SIZE*intr->er_ep_idx;
pci_dma_write(&xhci->pci_dev, addr, &ev_trb, TRB_SIZE); pci_dma_write(&xhci->pci_dev, addr, &ev_trb, TRB_SIZE);
xhci->er_ep_idx++; intr->er_ep_idx++;
if (xhci->er_ep_idx >= xhci->er_size) { if (intr->er_ep_idx >= intr->er_size) {
xhci->er_ep_idx = 0; intr->er_ep_idx = 0;
xhci->er_pcs = !xhci->er_pcs; intr->er_pcs = !intr->er_pcs;
} }
} }
static void xhci_events_update(XHCIState *xhci) static void xhci_events_update(XHCIState *xhci, int v)
{ {
XHCIInterrupter *intr = &xhci->intr[v];
dma_addr_t erdp; dma_addr_t erdp;
unsigned int dp_idx; unsigned int dp_idx;
bool do_irq = 0; bool do_irq = 0;
...@@ -739,115 +746,116 @@ static void xhci_events_update(XHCIState *xhci) ...@@ -739,115 +746,116 @@ static void xhci_events_update(XHCIState *xhci)
return; return;
} }
erdp = xhci_addr64(xhci->erdp_low, xhci->erdp_high); erdp = xhci_addr64(intr->erdp_low, intr->erdp_high);
if (erdp < xhci->er_start || if (erdp < intr->er_start ||
erdp >= (xhci->er_start + TRB_SIZE*xhci->er_size)) { erdp >= (intr->er_start + TRB_SIZE*intr->er_size)) {
fprintf(stderr, "xhci: ERDP out of bounds: "DMA_ADDR_FMT"\n", erdp); fprintf(stderr, "xhci: ERDP out of bounds: "DMA_ADDR_FMT"\n", erdp);
fprintf(stderr, "xhci: ER at "DMA_ADDR_FMT" len %d\n", fprintf(stderr, "xhci: ER[%d] at "DMA_ADDR_FMT" len %d\n",
xhci->er_start, xhci->er_size); v, intr->er_start, intr->er_size);
xhci_die(xhci); xhci_die(xhci);
return; return;
} }
dp_idx = (erdp - xhci->er_start) / TRB_SIZE; dp_idx = (erdp - intr->er_start) / TRB_SIZE;
assert(dp_idx < xhci->er_size); assert(dp_idx < intr->er_size);
/* NEC didn't read section 4.9.4 of the spec (v1.0 p139 top Note) and thus /* NEC didn't read section 4.9.4 of the spec (v1.0 p139 top Note) and thus
* deadlocks when the ER is full. Hack it by holding off events until * deadlocks when the ER is full. Hack it by holding off events until
* the driver decides to free at least half of the ring */ * the driver decides to free at least half of the ring */
if (xhci->er_full) { if (intr->er_full) {
int er_free = dp_idx - xhci->er_ep_idx; int er_free = dp_idx - intr->er_ep_idx;
if (er_free <= 0) { if (er_free <= 0) {
er_free += xhci->er_size; er_free += intr->er_size;
} }
if (er_free < (xhci->er_size/2)) { if (er_free < (intr->er_size/2)) {
DPRINTF("xhci_events_update(): event ring still " DPRINTF("xhci_events_update(): event ring still "
"more than half full (hack)\n"); "more than half full (hack)\n");
return; return;
} }
} }
while (xhci->ev_buffer_put != xhci->ev_buffer_get) { while (intr->ev_buffer_put != intr->ev_buffer_get) {
assert(xhci->er_full); assert(intr->er_full);
if (((xhci->er_ep_idx+1) % xhci->er_size) == dp_idx) { if (((intr->er_ep_idx+1) % intr->er_size) == dp_idx) {
DPRINTF("xhci_events_update(): event ring full again\n"); DPRINTF("xhci_events_update(): event ring full again\n");
#ifndef ER_FULL_HACK #ifndef ER_FULL_HACK
XHCIEvent full = {ER_HOST_CONTROLLER, CC_EVENT_RING_FULL_ERROR}; XHCIEvent full = {ER_HOST_CONTROLLER, CC_EVENT_RING_FULL_ERROR};
xhci_write_event(xhci, &full); xhci_write_event(xhci, &full, v);
#endif #endif
do_irq = 1; do_irq = 1;
break; break;
} }
XHCIEvent *event = &xhci->ev_buffer[xhci->ev_buffer_get]; XHCIEvent *event = &intr->ev_buffer[intr->ev_buffer_get];
xhci_write_event(xhci, event); xhci_write_event(xhci, event, v);
xhci->ev_buffer_get++; intr->ev_buffer_get++;
do_irq = 1; do_irq = 1;
if (xhci->ev_buffer_get == EV_QUEUE) { if (intr->ev_buffer_get == EV_QUEUE) {
xhci->ev_buffer_get = 0; intr->ev_buffer_get = 0;
} }
} }
if (do_irq) { if (do_irq) {
xhci_intr_raise(xhci); xhci_intr_raise(xhci, v);
} }
if (xhci->er_full && xhci->ev_buffer_put == xhci->ev_buffer_get) { if (intr->er_full && intr->ev_buffer_put == intr->ev_buffer_get) {
DPRINTF("xhci_events_update(): event ring no longer full\n"); DPRINTF("xhci_events_update(): event ring no longer full\n");
xhci->er_full = 0; intr->er_full = 0;
} }
return; return;
} }
static void xhci_event(XHCIState *xhci, XHCIEvent *event) static void xhci_event(XHCIState *xhci, XHCIEvent *event, int v)
{ {
XHCIInterrupter *intr = &xhci->intr[v];
dma_addr_t erdp; dma_addr_t erdp;
unsigned int dp_idx; unsigned int dp_idx;
if (xhci->er_full) { if (intr->er_full) {
DPRINTF("xhci_event(): ER full, queueing\n"); DPRINTF("xhci_event(): ER full, queueing\n");
if (((xhci->ev_buffer_put+1) % EV_QUEUE) == xhci->ev_buffer_get) { if (((intr->ev_buffer_put+1) % EV_QUEUE) == intr->ev_buffer_get) {
fprintf(stderr, "xhci: event queue full, dropping event!\n"); fprintf(stderr, "xhci: event queue full, dropping event!\n");
return; return;
} }
xhci->ev_buffer[xhci->ev_buffer_put++] = *event; intr->ev_buffer[intr->ev_buffer_put++] = *event;
if (xhci->ev_buffer_put == EV_QUEUE) { if (intr->ev_buffer_put == EV_QUEUE) {
xhci->ev_buffer_put = 0; intr->ev_buffer_put = 0;
} }
return; return;
} }
erdp = xhci_addr64(xhci->erdp_low, xhci->erdp_high); erdp = xhci_addr64(intr->erdp_low, intr->erdp_high);
if (erdp < xhci->er_start || if (erdp < intr->er_start ||
erdp >= (xhci->er_start + TRB_SIZE*xhci->er_size)) { erdp >= (intr->er_start + TRB_SIZE*intr->er_size)) {
fprintf(stderr, "xhci: ERDP out of bounds: "DMA_ADDR_FMT"\n", erdp); fprintf(stderr, "xhci: ERDP out of bounds: "DMA_ADDR_FMT"\n", erdp);
fprintf(stderr, "xhci: ER at "DMA_ADDR_FMT" len %d\n", fprintf(stderr, "xhci: ER[%d] at "DMA_ADDR_FMT" len %d\n",
xhci->er_start, xhci->er_size); v, intr->er_start, intr->er_size);
xhci_die(xhci); xhci_die(xhci);
return; return;
} }
dp_idx = (erdp - xhci->er_start) / TRB_SIZE; dp_idx = (erdp - intr->er_start) / TRB_SIZE;
assert(dp_idx < xhci->er_size); assert(dp_idx < intr->er_size);
if ((xhci->er_ep_idx+1) % xhci->er_size == dp_idx) { if ((intr->er_ep_idx+1) % intr->er_size == dp_idx) {
DPRINTF("xhci_event(): ER full, queueing\n"); DPRINTF("xhci_event(): ER full, queueing\n");
#ifndef ER_FULL_HACK #ifndef ER_FULL_HACK
XHCIEvent full = {ER_HOST_CONTROLLER, CC_EVENT_RING_FULL_ERROR}; XHCIEvent full = {ER_HOST_CONTROLLER, CC_EVENT_RING_FULL_ERROR};
xhci_write_event(xhci, &full); xhci_write_event(xhci, &full);
#endif #endif
xhci->er_full = 1; intr->er_full = 1;
if (((xhci->ev_buffer_put+1) % EV_QUEUE) == xhci->ev_buffer_get) { if (((intr->ev_buffer_put+1) % EV_QUEUE) == intr->ev_buffer_get) {
fprintf(stderr, "xhci: event queue full, dropping event!\n"); fprintf(stderr, "xhci: event queue full, dropping event!\n");
return; return;
} }
xhci->ev_buffer[xhci->ev_buffer_put++] = *event; intr->ev_buffer[intr->ev_buffer_put++] = *event;
if (xhci->ev_buffer_put == EV_QUEUE) { if (intr->ev_buffer_put == EV_QUEUE) {
xhci->ev_buffer_put = 0; intr->ev_buffer_put = 0;
} }
} else { } else {
xhci_write_event(xhci, event); xhci_write_event(xhci, event, v);
} }
xhci_intr_raise(xhci); xhci_intr_raise(xhci, v);
} }
static void xhci_ring_init(XHCIState *xhci, XHCIRing *ring, static void xhci_ring_init(XHCIState *xhci, XHCIRing *ring,
...@@ -939,17 +947,18 @@ static int xhci_ring_chain_length(XHCIState *xhci, const XHCIRing *ring) ...@@ -939,17 +947,18 @@ static int xhci_ring_chain_length(XHCIState *xhci, const XHCIRing *ring)
} }
} }
static void xhci_er_reset(XHCIState *xhci) static void xhci_er_reset(XHCIState *xhci, int v)
{ {
XHCIInterrupter *intr = &xhci->intr[v];
XHCIEvRingSeg seg; XHCIEvRingSeg seg;
/* cache the (sole) event ring segment location */ /* cache the (sole) event ring segment location */
if (xhci->erstsz != 1) { if (intr->erstsz != 1) {
fprintf(stderr, "xhci: invalid value for ERSTSZ: %d\n", xhci->erstsz); fprintf(stderr, "xhci: invalid value for ERSTSZ: %d\n", intr->erstsz);
xhci_die(xhci); xhci_die(xhci);
return; return;
} }
dma_addr_t erstba = xhci_addr64(xhci->erstba_low, xhci->erstba_high); dma_addr_t erstba = xhci_addr64(intr->erstba_low, intr->erstba_high);
pci_dma_read(&xhci->pci_dev, erstba, &seg, sizeof(seg)); pci_dma_read(&xhci->pci_dev, erstba, &seg, sizeof(seg));
le32_to_cpus(&seg.addr_low); le32_to_cpus(&seg.addr_low);
le32_to_cpus(&seg.addr_high); le32_to_cpus(&seg.addr_high);
...@@ -959,15 +968,15 @@ static void xhci_er_reset(XHCIState *xhci) ...@@ -959,15 +968,15 @@ static void xhci_er_reset(XHCIState *xhci)
xhci_die(xhci); xhci_die(xhci);
return; return;
} }
xhci->er_start = xhci_addr64(seg.addr_low, seg.addr_high); intr->er_start = xhci_addr64(seg.addr_low, seg.addr_high);
xhci->er_size = seg.size; intr->er_size = seg.size;
xhci->er_ep_idx = 0; intr->er_ep_idx = 0;
xhci->er_pcs = 1; intr->er_pcs = 1;
xhci->er_full = 0; intr->er_full = 0;
DPRINTF("xhci: event ring:" DMA_ADDR_FMT " [%d]\n", DPRINTF("xhci: event ring[%d]:" DMA_ADDR_FMT " [%d]\n",
xhci->er_start, xhci->er_size); v, intr->er_start, intr->er_size);
} }
static void xhci_run(XHCIState *xhci) static void xhci_run(XHCIState *xhci)
...@@ -1368,7 +1377,7 @@ static void xhci_xfer_report(XHCITransfer *xfer) ...@@ -1368,7 +1377,7 @@ static void xhci_xfer_report(XHCITransfer *xfer)
DPRINTF("xhci_xfer_data: EDTLA=%d\n", event.length); DPRINTF("xhci_xfer_data: EDTLA=%d\n", event.length);
edtla = 0; edtla = 0;
} }
xhci_event(xhci, &event); xhci_event(xhci, &event, 0 /* FIXME */);
reported = 1; reported = 1;
if (xfer->status != CC_SUCCESS) { if (xfer->status != CC_SUCCESS) {
return; return;
...@@ -2244,7 +2253,7 @@ static void xhci_process_commands(XHCIState *xhci) ...@@ -2244,7 +2253,7 @@ static void xhci_process_commands(XHCIState *xhci)
break; break;
} }
event.slotid = slotid; event.slotid = slotid;
xhci_event(xhci, &event); xhci_event(xhci, &event, 0 /* FIXME */);
} }
} }
...@@ -2274,7 +2283,7 @@ static void xhci_update_port(XHCIState *xhci, XHCIPort *port, int is_detach) ...@@ -2274,7 +2283,7 @@ static void xhci_update_port(XHCIState *xhci, XHCIPort *port, int is_detach)
port->portsc |= PORTSC_CSC; port->portsc |= PORTSC_CSC;
XHCIEvent ev = { ER_PORT_STATUS_CHANGE, CC_SUCCESS, XHCIEvent ev = { ER_PORT_STATUS_CHANGE, CC_SUCCESS,
port->portnr << 24}; port->portnr << 24};
xhci_event(xhci, &ev); xhci_event(xhci, &ev, 0 /* FIXME */);
DPRINTF("xhci: port change event for port %d\n", port->portnr); DPRINTF("xhci: port change event for port %d\n", port->portnr);
} }
} }
...@@ -2307,20 +2316,22 @@ static void xhci_reset(DeviceState *dev) ...@@ -2307,20 +2316,22 @@ static void xhci_reset(DeviceState *dev)
xhci_update_port(xhci, xhci->ports + i, 0); xhci_update_port(xhci, xhci->ports + i, 0);
} }
xhci->iman = 0; for (i = 0; i < MAXINTRS; i++) {
xhci->imod = 0; xhci->intr[i].iman = 0;
xhci->erstsz = 0; xhci->intr[i].imod = 0;
xhci->erstba_low = 0; xhci->intr[i].erstsz = 0;
xhci->erstba_high = 0; xhci->intr[i].erstba_low = 0;
xhci->erdp_low = 0; xhci->intr[i].erstba_high = 0;
xhci->erdp_high = 0; xhci->intr[i].erdp_low = 0;
xhci->msix_used = 0; xhci->intr[i].erdp_high = 0;
xhci->intr[i].msix_used = 0;
xhci->er_ep_idx = 0; xhci->intr[i].er_ep_idx = 0;
xhci->er_pcs = 1; xhci->intr[i].er_pcs = 1;
xhci->er_full = 0; xhci->intr[i].er_full = 0;
xhci->ev_buffer_put = 0; xhci->intr[i].ev_buffer_put = 0;
xhci->ev_buffer_get = 0; xhci->intr[i].ev_buffer_get = 0;
}
xhci->mfindex_start = qemu_get_clock_ns(vm_clock); xhci->mfindex_start = qemu_get_clock_ns(vm_clock);
xhci_mfwrap_update(xhci); xhci_mfwrap_update(xhci);
...@@ -2551,7 +2562,7 @@ static void xhci_oper_write(XHCIState *xhci, uint32_t reg, uint32_t val) ...@@ -2551,7 +2562,7 @@ static void xhci_oper_write(XHCIState *xhci, uint32_t reg, uint32_t val)
if (xhci->crcr_low & (CRCR_CA|CRCR_CS) && (xhci->crcr_low & CRCR_CRR)) { if (xhci->crcr_low & (CRCR_CA|CRCR_CS) && (xhci->crcr_low & CRCR_CRR)) {
XHCIEvent event = {ER_COMMAND_COMPLETE, CC_COMMAND_RING_STOPPED}; XHCIEvent event = {ER_COMMAND_COMPLETE, CC_COMMAND_RING_STOPPED};
xhci->crcr_low &= ~CRCR_CRR; xhci->crcr_low &= ~CRCR_CRR;
xhci_event(xhci, &event); xhci_event(xhci, &event, 0 /* FIXME */);
DPRINTF("xhci: command ring stopped (CRCR=%08x)\n", xhci->crcr_low); DPRINTF("xhci: command ring stopped (CRCR=%08x)\n", xhci->crcr_low);
} else { } else {
dma_addr_t base = xhci_addr64(xhci->crcr_low & ~0x3f, val); dma_addr_t base = xhci_addr64(xhci->crcr_low & ~0x3f, val);
...@@ -2575,6 +2586,7 @@ static void xhci_oper_write(XHCIState *xhci, uint32_t reg, uint32_t val) ...@@ -2575,6 +2586,7 @@ static void xhci_oper_write(XHCIState *xhci, uint32_t reg, uint32_t val)
static uint32_t xhci_runtime_read(XHCIState *xhci, uint32_t reg) static uint32_t xhci_runtime_read(XHCIState *xhci, uint32_t reg)
{ {
XHCIInterrupter *intr = &xhci->intr[0];
uint32_t ret; uint32_t ret;
switch (reg) { switch (reg) {
...@@ -2582,25 +2594,25 @@ static uint32_t xhci_runtime_read(XHCIState *xhci, uint32_t reg) ...@@ -2582,25 +2594,25 @@ static uint32_t xhci_runtime_read(XHCIState *xhci, uint32_t reg)
ret = xhci_mfindex_get(xhci) & 0x3fff; ret = xhci_mfindex_get(xhci) & 0x3fff;
break; break;
case 0x20: /* IMAN */ case 0x20: /* IMAN */
ret = xhci->iman; ret = intr->iman;
break; break;
case 0x24: /* IMOD */ case 0x24: /* IMOD */
ret = xhci->imod; ret = intr->imod;
break; break;
case 0x28: /* ERSTSZ */ case 0x28: /* ERSTSZ */
ret = xhci->erstsz; ret = intr->erstsz;
break; break;
case 0x30: /* ERSTBA low */ case 0x30: /* ERSTBA low */
ret = xhci->erstba_low; ret = intr->erstba_low;
break; break;
case 0x34: /* ERSTBA high */ case 0x34: /* ERSTBA high */
ret = xhci->erstba_high; ret = intr->erstba_high;
break; break;
case 0x38: /* ERDP low */ case 0x38: /* ERDP low */
ret = xhci->erdp_low; ret = intr->erdp_low;
break; break;
case 0x3c: /* ERDP high */ case 0x3c: /* ERDP high */
ret = xhci->erdp_high; ret = intr->erdp_high;
break; break;
default: default:
fprintf(stderr, "xhci_runtime_read: reg 0x%x unimplemented\n", reg); fprintf(stderr, "xhci_runtime_read: reg 0x%x unimplemented\n", reg);
...@@ -2613,42 +2625,43 @@ static uint32_t xhci_runtime_read(XHCIState *xhci, uint32_t reg) ...@@ -2613,42 +2625,43 @@ static uint32_t xhci_runtime_read(XHCIState *xhci, uint32_t reg)
static void xhci_runtime_write(XHCIState *xhci, uint32_t reg, uint32_t val) static void xhci_runtime_write(XHCIState *xhci, uint32_t reg, uint32_t val)
{ {
XHCIInterrupter *intr = &xhci->intr[0];
trace_usb_xhci_runtime_write(reg, val); trace_usb_xhci_runtime_write(reg, val);
switch (reg) { switch (reg) {
case 0x20: /* IMAN */ case 0x20: /* IMAN */
if (val & IMAN_IP) { if (val & IMAN_IP) {
xhci->iman &= ~IMAN_IP; intr->iman &= ~IMAN_IP;
} }
xhci->iman &= ~IMAN_IE; intr->iman &= ~IMAN_IE;
xhci->iman |= val & IMAN_IE; intr->iman |= val & IMAN_IE;
xhci_intx_update(xhci); xhci_intx_update(xhci);
xhci_msix_update(xhci); xhci_msix_update(xhci, 0);
break; break;
case 0x24: /* IMOD */ case 0x24: /* IMOD */
xhci->imod = val; intr->imod = val;
break; break;
case 0x28: /* ERSTSZ */ case 0x28: /* ERSTSZ */
xhci->erstsz = val & 0xffff; intr->erstsz = val & 0xffff;
break; break;
case 0x30: /* ERSTBA low */ case 0x30: /* ERSTBA low */
/* XXX NEC driver bug: it doesn't align this to 64 bytes /* XXX NEC driver bug: it doesn't align this to 64 bytes
xhci->erstba_low = val & 0xffffffc0; */ intr->erstba_low = val & 0xffffffc0; */
xhci->erstba_low = val & 0xfffffff0; intr->erstba_low = val & 0xfffffff0;
break; break;
case 0x34: /* ERSTBA high */ case 0x34: /* ERSTBA high */
xhci->erstba_high = val; intr->erstba_high = val;
xhci_er_reset(xhci); xhci_er_reset(xhci, 0);
break; break;
case 0x38: /* ERDP low */ case 0x38: /* ERDP low */
if (val & ERDP_EHB) { if (val & ERDP_EHB) {
xhci->erdp_low &= ~ERDP_EHB; intr->erdp_low &= ~ERDP_EHB;
} }
xhci->erdp_low = (val & ~ERDP_EHB) | (xhci->erdp_low & ERDP_EHB); intr->erdp_low = (val & ~ERDP_EHB) | (intr->erdp_low & ERDP_EHB);
break; break;
case 0x3c: /* ERDP high */ case 0x3c: /* ERDP high */
xhci->erdp_high = val; intr->erdp_high = val;
xhci_events_update(xhci); xhci_events_update(xhci, 0);
break; break;
default: default:
fprintf(stderr, "xhci_oper_write: reg 0x%x unimplemented\n", reg); fprintf(stderr, "xhci_oper_write: reg 0x%x unimplemented\n", reg);
...@@ -2778,7 +2791,7 @@ static void xhci_wakeup(USBPort *usbport) ...@@ -2778,7 +2791,7 @@ static void xhci_wakeup(USBPort *usbport)
return; return;
} }
port->portsc |= PORTSC_PLC; port->portsc |= PORTSC_PLC;
xhci_event(xhci, &ev); xhci_event(xhci, &ev, 0 /* FIXME */);
} }
static void xhci_complete(USBPort *port, USBPacket *packet) static void xhci_complete(USBPort *port, USBPacket *packet)
......
trace-events
浏览文件 @ 962d11e1
...@@ -316,7 +316,7 @@ usb_xhci_irq_msi(uint32_t nr) "nr %d" ...@@ -316,7 +316,7 @@ usb_xhci_irq_msi(uint32_t nr) "nr %d"
usb_xhci_irq_msix(uint32_t nr) "nr %d" usb_xhci_irq_msix(uint32_t nr) "nr %d"
usb_xhci_irq_msix_use(uint32_t nr) "nr %d" usb_xhci_irq_msix_use(uint32_t nr) "nr %d"
usb_xhci_irq_msix_unuse(uint32_t nr) "nr %d" usb_xhci_irq_msix_unuse(uint32_t nr) "nr %d"
usb_xhci_queue_event(uint32_t idx, const char *trb, const char *evt, uint64_t param, uint32_t status, uint32_t control) "idx %d, %s, %s, p %016" PRIx64 ", s %08x, c 0x%08x" usb_xhci_queue_event(uint32_t vector, uint32_t idx, const char *trb, const char *evt, uint64_t param, uint32_t status, uint32_t control) "v %d, idx %d, %s, %s, p %016" PRIx64 ", s %08x, c 0x%08x"
usb_xhci_fetch_trb(uint64_t addr, const char *name, uint64_t param, uint32_t status, uint32_t control) "addr %016" PRIx64 ", %s, p %016" PRIx64 ", s %08x, c 0x%08x" usb_xhci_fetch_trb(uint64_t addr, const char *name, uint64_t param, uint32_t status, uint32_t control) "addr %016" PRIx64 ", %s, p %016" PRIx64 ", s %08x, c 0x%08x"
usb_xhci_slot_enable(uint32_t slotid) "slotid %d" usb_xhci_slot_enable(uint32_t slotid) "slotid %d"
usb_xhci_slot_disable(uint32_t slotid) "slotid %d" usb_xhci_slot_disable(uint32_t slotid) "slotid %d"
......
Markdown is supported
0% 或 .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑！
想要评论请 注册 或