xhci.c revision 1.7
1 /* $NetBSD: xhci.c,v 1.7 2013/11/08 03:12:17 christos Exp $ */ 2 3 /* 4 * Copyright (c) 2013 Jonathan A. Kollasch 5 * All rights reserved. 6 * 7 * Redistribution and use in source and binary forms, with or without 8 * modification, are permitted provided that the following conditions 9 * are met: 10 * 1. Redistributions of source code must retain the above copyright 11 * notice, this list of conditions and the following disclaimer. 12 * 2. Redistributions in binary form must reproduce the above copyright 13 * notice, this list of conditions and the following disclaimer in the 14 * documentation and/or other materials provided with the distribution. 15 * 16 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 17 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 18 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 19 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR 20 * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, 21 * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, 22 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; 23 * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, 24 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR 25 * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF 26 * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 27 */ 28 29 #include <sys/cdefs.h> 30 __KERNEL_RCSID(0, "$NetBSD: xhci.c,v 1.7 2013/11/08 03:12:17 christos Exp $"); 31 32 #include <sys/param.h> 33 #include <sys/systm.h> 34 #include <sys/kernel.h> 35 #include <sys/kmem.h> 36 #include <sys/malloc.h> 37 #include <sys/device.h> 38 #include <sys/select.h> 39 #include <sys/proc.h> 40 #include <sys/queue.h> 41 #include <sys/mutex.h> 42 #include <sys/condvar.h> 43 #include <sys/bus.h> 44 #include <sys/cpu.h> 45 46 #include <machine/endian.h> 47 48 #include <dev/usb/usb.h> 49 #include <dev/usb/usbdi.h> 50 #include <dev/usb/usbdivar.h> 51 #include <dev/usb/usb_mem.h> 52 #include <dev/usb/usb_quirks.h> 53 54 #include <dev/usb/xhcireg.h> 55 #include <dev/usb/xhcivar.h> 56 #include <dev/usb/usbroothub_subr.h> 57 58 #ifdef XHCI_DEBUG 59 int xhcidebug = 0; 60 #define DPRINTF(x) do { if (xhcidebug) printf x; } while(0) 61 #define DPRINTFN(n,x) do { if (xhcidebug>(n)) printf x; } while (0) 62 #else 63 #define DPRINTF(x) 64 #define DPRINTFN(n,x) 65 #endif 66 67 #define XHCI_DCI_SLOT 0 68 #define XHCI_DCI_EP_CONTROL 1 69 70 #define XHCI_ICI_INPUT_CONTROL 0 71 72 struct xhci_pipe { 73 struct usbd_pipe xp_pipe; 74 }; 75 76 #define XHCI_INTR_ENDPT 1 77 #define XHCI_COMMAND_RING_TRBS 256 78 #define XHCI_EVENT_RING_TRBS 256 79 #define XHCI_EVENT_RING_SEGMENTS 1 80 #define XHCI_TRB_3_ED_BIT XHCI_TRB_3_ISP_BIT 81 82 static usbd_status xhci_open(usbd_pipe_handle); 83 static int xhci_intr1(struct xhci_softc * const); 84 static void xhci_softintr(void *); 85 static void xhci_poll(struct usbd_bus *); 86 static usbd_status xhci_allocm(struct usbd_bus *, usb_dma_t *, uint32_t); 87 static void xhci_freem(struct usbd_bus *, usb_dma_t *); 88 static usbd_xfer_handle xhci_allocx(struct usbd_bus *); 89 static void xhci_freex(struct usbd_bus *, usbd_xfer_handle); 90 static void xhci_get_lock(struct usbd_bus *, kmutex_t **); 91 static usbd_status xhci_new_device(device_t, usbd_bus_handle, int, int, int, 92 struct usbd_port *); 93 94 static usbd_status xhci_configure_endpoint(usbd_pipe_handle); 95 static usbd_status xhci_unconfigure_endpoint(usbd_pipe_handle); 96 static usbd_status xhci_reset_endpoint(usbd_pipe_handle); 97 //static usbd_status xhci_stop_endpoint(usbd_pipe_handle); 98 99 static usbd_status xhci_set_dequeue(usbd_pipe_handle); 100 101 static usbd_status xhci_do_command(struct xhci_softc * const, 102 struct xhci_trb * const, int); 103 static usbd_status xhci_init_slot(struct xhci_softc * const, uint32_t, 104 int, int, int, int); 105 static usbd_status xhci_enable_slot(struct xhci_softc * const, 106 uint8_t * const); 107 static usbd_status xhci_address_device(struct xhci_softc * const, 108 uint64_t, uint8_t, bool); 109 static usbd_status xhci_update_ep0_mps(struct xhci_softc * const, 110 struct xhci_slot * const, u_int); 111 static usbd_status xhci_ring_init(struct xhci_softc * const, 112 struct xhci_ring * const, size_t, size_t); 113 static void xhci_ring_free(struct xhci_softc * const, struct xhci_ring * const); 114 115 static void xhci_noop(usbd_pipe_handle); 116 117 static usbd_status xhci_root_ctrl_transfer(usbd_xfer_handle); 118 static usbd_status xhci_root_ctrl_start(usbd_xfer_handle); 119 static void xhci_root_ctrl_abort(usbd_xfer_handle); 120 static void xhci_root_ctrl_close(usbd_pipe_handle); 121 static void xhci_root_ctrl_done(usbd_xfer_handle); 122 123 static usbd_status xhci_root_intr_transfer(usbd_xfer_handle); 124 static usbd_status xhci_root_intr_start(usbd_xfer_handle); 125 static void xhci_root_intr_abort(usbd_xfer_handle); 126 static void xhci_root_intr_close(usbd_pipe_handle); 127 static void xhci_root_intr_done(usbd_xfer_handle); 128 129 static usbd_status xhci_device_ctrl_transfer(usbd_xfer_handle); 130 static usbd_status xhci_device_ctrl_start(usbd_xfer_handle); 131 static void xhci_device_ctrl_abort(usbd_xfer_handle); 132 static void xhci_device_ctrl_close(usbd_pipe_handle); 133 static void xhci_device_ctrl_done(usbd_xfer_handle); 134 135 static usbd_status xhci_device_intr_transfer(usbd_xfer_handle); 136 static usbd_status xhci_device_intr_start(usbd_xfer_handle); 137 static void xhci_device_intr_abort(usbd_xfer_handle); 138 static void xhci_device_intr_close(usbd_pipe_handle); 139 static void xhci_device_intr_done(usbd_xfer_handle); 140 141 static usbd_status xhci_device_bulk_transfer(usbd_xfer_handle); 142 static usbd_status xhci_device_bulk_start(usbd_xfer_handle); 143 static void xhci_device_bulk_abort(usbd_xfer_handle); 144 static void xhci_device_bulk_close(usbd_pipe_handle); 145 static void xhci_device_bulk_done(usbd_xfer_handle); 146 147 static void xhci_timeout(void *); 148 static void xhci_timeout_task(void *); 149 150 static const struct usbd_bus_methods xhci_bus_methods = { 151 .open_pipe = xhci_open, 152 .soft_intr = xhci_softintr, 153 .do_poll = xhci_poll, 154 .allocm = xhci_allocm, 155 .freem = xhci_freem, 156 .allocx = xhci_allocx, 157 .freex = xhci_freex, 158 .get_lock = xhci_get_lock, 159 .new_device = xhci_new_device, 160 }; 161 162 static const struct usbd_pipe_methods xhci_root_ctrl_methods = { 163 .transfer = xhci_root_ctrl_transfer, 164 .start = xhci_root_ctrl_start, 165 .abort = xhci_root_ctrl_abort, 166 .close = xhci_root_ctrl_close, 167 .cleartoggle = xhci_noop, 168 .done = xhci_root_ctrl_done, 169 }; 170 171 static const struct usbd_pipe_methods xhci_root_intr_methods = { 172 .transfer = xhci_root_intr_transfer, 173 .start = xhci_root_intr_start, 174 .abort = xhci_root_intr_abort, 175 .close = xhci_root_intr_close, 176 .cleartoggle = xhci_noop, 177 .done = xhci_root_intr_done, 178 }; 179 180 181 static const struct usbd_pipe_methods xhci_device_ctrl_methods = { 182 .transfer = xhci_device_ctrl_transfer, 183 .start = xhci_device_ctrl_start, 184 .abort = xhci_device_ctrl_abort, 185 .close = xhci_device_ctrl_close, 186 .cleartoggle = xhci_noop, 187 .done = xhci_device_ctrl_done, 188 }; 189 190 static const struct usbd_pipe_methods xhci_device_isoc_methods = { 191 .cleartoggle = xhci_noop, 192 }; 193 194 static const struct usbd_pipe_methods xhci_device_bulk_methods = { 195 .transfer = xhci_device_bulk_transfer, 196 .start = xhci_device_bulk_start, 197 .abort = xhci_device_bulk_abort, 198 .close = xhci_device_bulk_close, 199 .cleartoggle = xhci_noop, 200 .done = xhci_device_bulk_done, 201 }; 202 203 static const struct usbd_pipe_methods xhci_device_intr_methods = { 204 .transfer = xhci_device_intr_transfer, 205 .start = xhci_device_intr_start, 206 .abort = xhci_device_intr_abort, 207 .close = xhci_device_intr_close, 208 .cleartoggle = xhci_noop, 209 .done = xhci_device_intr_done, 210 }; 211 212 static inline uint32_t 213 xhci_read_4(const struct xhci_softc * const sc, bus_size_t offset) 214 { 215 return bus_space_read_4(sc->sc_iot, sc->sc_ioh, offset); 216 } 217 218 #if 0 /* unused */ 219 static inline void 220 xhci_write_4(const struct xhci_softc * const sc, bus_size_t offset, 221 uint32_t value) 222 { 223 bus_space_write_4(sc->sc_iot, sc->sc_ioh, offset, value); 224 } 225 #endif /* unused */ 226 227 static inline uint32_t 228 xhci_cap_read_4(const struct xhci_softc * const sc, bus_size_t offset) 229 { 230 return bus_space_read_4(sc->sc_iot, sc->sc_cbh, offset); 231 } 232 233 static inline uint32_t 234 xhci_op_read_4(const struct xhci_softc * const sc, bus_size_t offset) 235 { 236 return bus_space_read_4(sc->sc_iot, sc->sc_obh, offset); 237 } 238 239 static inline void 240 xhci_op_write_4(const struct xhci_softc * const sc, bus_size_t offset, 241 uint32_t value) 242 { 243 bus_space_write_4(sc->sc_iot, sc->sc_obh, offset, value); 244 } 245 246 #if 0 /* unused */ 247 static inline uint64_t 248 xhci_op_read_8(const struct xhci_softc * const sc, bus_size_t offset) 249 { 250 uint64_t value; 251 252 if (sc->sc_ac64) { 253 #ifdef XHCI_USE_BUS_SPACE_8 254 value = bus_space_read_8(sc->sc_iot, sc->sc_obh, offset); 255 #else 256 value = bus_space_read_4(sc->sc_iot, sc->sc_obh, offset); 257 value |= (uint64_t)bus_space_read_4(sc->sc_iot, sc->sc_obh, 258 offset + 4) << 32; 259 #endif 260 } else { 261 value = bus_space_read_4(sc->sc_iot, sc->sc_obh, offset); 262 } 263 264 return value; 265 } 266 #endif /* unused */ 267 268 static inline void 269 xhci_op_write_8(const struct xhci_softc * const sc, bus_size_t offset, 270 uint64_t value) 271 { 272 if (sc->sc_ac64) { 273 #ifdef XHCI_USE_BUS_SPACE_8 274 bus_space_write_8(sc->sc_iot, sc->sc_obh, offset, value); 275 #else 276 bus_space_write_4(sc->sc_iot, sc->sc_obh, offset + 0, 277 (value >> 0) & 0xffffffff); 278 bus_space_write_4(sc->sc_iot, sc->sc_obh, offset + 4, 279 (value >> 32) & 0xffffffff); 280 #endif 281 } else { 282 bus_space_write_4(sc->sc_iot, sc->sc_obh, offset, value); 283 } 284 } 285 286 static inline uint32_t 287 xhci_rt_read_4(const struct xhci_softc * const sc, bus_size_t offset) 288 { 289 return bus_space_read_4(sc->sc_iot, sc->sc_rbh, offset); 290 } 291 292 static inline void 293 xhci_rt_write_4(const struct xhci_softc * const sc, bus_size_t offset, 294 uint32_t value) 295 { 296 bus_space_write_4(sc->sc_iot, sc->sc_rbh, offset, value); 297 } 298 299 #if 0 /* unused */ 300 static inline uint64_t 301 xhci_rt_read_8(const struct xhci_softc * const sc, bus_size_t offset) 302 { 303 uint64_t value; 304 305 if (sc->sc_ac64) { 306 #ifdef XHCI_USE_BUS_SPACE_8 307 value = bus_space_read_8(sc->sc_iot, sc->sc_rbh, offset); 308 #else 309 value = bus_space_read_4(sc->sc_iot, sc->sc_rbh, offset); 310 value |= (uint64_t)bus_space_read_4(sc->sc_iot, sc->sc_rbh, 311 offset + 4) << 32; 312 #endif 313 } else { 314 value = bus_space_read_4(sc->sc_iot, sc->sc_rbh, offset); 315 } 316 317 return value; 318 } 319 #endif /* unused */ 320 321 static inline void 322 xhci_rt_write_8(const struct xhci_softc * const sc, bus_size_t offset, 323 uint64_t value) 324 { 325 if (sc->sc_ac64) { 326 #ifdef XHCI_USE_BUS_SPACE_8 327 bus_space_write_8(sc->sc_iot, sc->sc_rbh, offset, value); 328 #else 329 bus_space_write_4(sc->sc_iot, sc->sc_rbh, offset + 0, 330 (value >> 0) & 0xffffffff); 331 bus_space_write_4(sc->sc_iot, sc->sc_rbh, offset + 4, 332 (value >> 32) & 0xffffffff); 333 #endif 334 } else { 335 bus_space_write_4(sc->sc_iot, sc->sc_rbh, offset, value); 336 } 337 } 338 339 #if 0 /* unused */ 340 static inline uint32_t 341 xhci_db_read_4(const struct xhci_softc * const sc, bus_size_t offset) 342 { 343 return bus_space_read_4(sc->sc_iot, sc->sc_dbh, offset); 344 } 345 #endif /* unused */ 346 347 static inline void 348 xhci_db_write_4(const struct xhci_softc * const sc, bus_size_t offset, 349 uint32_t value) 350 { 351 bus_space_write_4(sc->sc_iot, sc->sc_dbh, offset, value); 352 } 353 354 /* --- */ 355 356 static inline uint8_t 357 xhci_ep_get_type(usb_endpoint_descriptor_t * const ed) 358 { 359 u_int eptype; 360 361 switch (UE_GET_XFERTYPE(ed->bmAttributes)) { 362 case UE_CONTROL: 363 eptype = 0x0; 364 break; 365 case UE_ISOCHRONOUS: 366 eptype = 0x1; 367 break; 368 case UE_BULK: 369 eptype = 0x2; 370 break; 371 case UE_INTERRUPT: 372 eptype = 0x3; 373 break; 374 } 375 376 if ((UE_GET_XFERTYPE(ed->bmAttributes) == UE_CONTROL) || 377 (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN)) 378 return eptype | 0x4; 379 else 380 return eptype; 381 } 382 383 static u_int 384 xhci_ep_get_dci(usb_endpoint_descriptor_t * const ed) 385 { 386 /* xHCI 1.0 section 4.5.1 */ 387 u_int epaddr = UE_GET_ADDR(ed->bEndpointAddress); 388 u_int in = 0; 389 390 if ((UE_GET_XFERTYPE(ed->bmAttributes) == UE_CONTROL) || 391 (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN)) 392 in = 1; 393 394 return epaddr * 2 + in; 395 } 396 397 static inline u_int 398 xhci_dci_to_ici(const u_int i) 399 { 400 return i + 1; 401 } 402 403 static inline void * 404 xhci_slot_get_dcv(struct xhci_softc * const sc, struct xhci_slot * const xs, 405 const u_int dci) 406 { 407 return KERNADDR(&xs->xs_dc_dma, sc->sc_ctxsz * dci); 408 } 409 410 #if 0 /* unused */ 411 static inline bus_addr_t 412 xhci_slot_get_dcp(struct xhci_softc * const sc, struct xhci_slot * const xs, 413 const u_int dci) 414 { 415 return DMAADDR(&xs->xs_dc_dma, sc->sc_ctxsz * dci); 416 } 417 #endif /* unused */ 418 419 static inline void * 420 xhci_slot_get_icv(struct xhci_softc * const sc, struct xhci_slot * const xs, 421 const u_int ici) 422 { 423 return KERNADDR(&xs->xs_ic_dma, sc->sc_ctxsz * ici); 424 } 425 426 static inline bus_addr_t 427 xhci_slot_get_icp(struct xhci_softc * const sc, struct xhci_slot * const xs, 428 const u_int ici) 429 { 430 return DMAADDR(&xs->xs_ic_dma, sc->sc_ctxsz * ici); 431 } 432 433 static inline struct xhci_trb * 434 xhci_ring_trbv(struct xhci_ring * const xr, u_int idx) 435 { 436 return KERNADDR(&xr->xr_dma, XHCI_TRB_SIZE * idx); 437 } 438 439 static inline bus_addr_t 440 xhci_ring_trbp(struct xhci_ring * const xr, u_int idx) 441 { 442 return DMAADDR(&xr->xr_dma, XHCI_TRB_SIZE * idx); 443 } 444 445 static inline void 446 xhci_trb_put(struct xhci_trb * const trb, uint64_t parameter, uint32_t status, 447 uint32_t control) 448 { 449 trb->trb_0 = parameter; 450 trb->trb_2 = status; 451 trb->trb_3 = control; 452 } 453 454 /* --- */ 455 456 void 457 xhci_childdet(device_t self, device_t child) 458 { 459 struct xhci_softc * const sc = device_private(self); 460 461 KASSERT(sc->sc_child == child); 462 if (child == sc->sc_child) 463 sc->sc_child = NULL; 464 } 465 466 int 467 xhci_detach(struct xhci_softc *sc, int flags) 468 { 469 int rv = 0; 470 471 if (sc->sc_child != NULL) 472 rv = config_detach(sc->sc_child, flags); 473 474 if (rv != 0) 475 return (rv); 476 477 /* XXX unconfigure/free slots */ 478 479 /* verify: */ 480 xhci_rt_write_4(sc, XHCI_IMAN(0), 0); 481 xhci_op_write_4(sc, XHCI_USBCMD, 0); 482 /* do we need to wait for stop? */ 483 484 xhci_op_write_8(sc, XHCI_CRCR, 0); 485 xhci_ring_free(sc, &sc->sc_cr); 486 cv_destroy(&sc->sc_command_cv); 487 488 xhci_rt_write_4(sc, XHCI_ERSTSZ(0), 0); 489 xhci_rt_write_8(sc, XHCI_ERSTBA(0), 0); 490 xhci_rt_write_8(sc, XHCI_ERDP(0), 0|XHCI_ERDP_LO_BUSY); 491 xhci_ring_free(sc, &sc->sc_er); 492 493 usb_freemem(&sc->sc_bus, &sc->sc_eventst_dma); 494 495 xhci_op_write_8(sc, XHCI_DCBAAP, 0); 496 usb_freemem(&sc->sc_bus, &sc->sc_dcbaa_dma); 497 498 kmem_free(sc->sc_slots, sizeof(*sc->sc_slots) * sc->sc_maxslots); 499 500 mutex_destroy(&sc->sc_lock); 501 mutex_destroy(&sc->sc_intr_lock); 502 503 pool_cache_destroy(sc->sc_xferpool); 504 505 return rv; 506 } 507 508 int 509 xhci_activate(device_t self, enum devact act) 510 { 511 struct xhci_softc * const sc = device_private(self); 512 513 switch (act) { 514 case DVACT_DEACTIVATE: 515 sc->sc_dying = true; 516 return 0; 517 default: 518 return EOPNOTSUPP; 519 } 520 } 521 522 bool 523 xhci_suspend(device_t dv, const pmf_qual_t *qual) 524 { 525 return false; 526 } 527 528 bool 529 xhci_resume(device_t dv, const pmf_qual_t *qual) 530 { 531 return false; 532 } 533 534 bool 535 xhci_shutdown(device_t self, int flags) 536 { 537 return false; 538 } 539 540 541 static void 542 hexdump(const char *msg, const void *base, size_t len) 543 { 544 #if 0 545 size_t cnt; 546 const uint32_t *p; 547 extern paddr_t vtophys(vaddr_t); 548 549 p = base; 550 cnt = 0; 551 552 printf("*** %s (%zu bytes @ %p %p)\n", msg, len, base, 553 (void *)vtophys((vaddr_t)base)); 554 555 while (cnt < len) { 556 if (cnt % 16 == 0) 557 printf("%p: ", p); 558 else if (cnt % 8 == 0) 559 printf(" |"); 560 printf(" %08x", *p++); 561 cnt += 4; 562 if (cnt % 16 == 0) 563 printf("\n"); 564 } 565 #endif 566 } 567 568 569 usbd_status 570 xhci_init(struct xhci_softc *sc) 571 { 572 bus_size_t bsz; 573 uint32_t cap, hcs1, hcs2, hcc, dboff, rtsoff; 574 uint32_t ecp, ecr; 575 uint32_t usbcmd, usbsts, pagesize, config; 576 int i; 577 uint16_t hciversion; 578 uint8_t caplength; 579 580 DPRINTF(("%s\n", __func__)); 581 582 sc->sc_bus.usbrev = USBREV_2_0; /* XXX Low/Full/High speeds for now */ 583 584 cap = xhci_read_4(sc, XHCI_CAPLENGTH); 585 caplength = XHCI_CAP_CAPLENGTH(cap); 586 hciversion = XHCI_CAP_HCIVERSION(cap); 587 588 if ((hciversion < 0x0096) || (hciversion > 0x0100)) { 589 aprint_normal_dev(sc->sc_dev, 590 "xHCI version %x.%x not known to be supported\n", 591 (hciversion >> 8) & 0xff, (hciversion >> 0) & 0xff); 592 } else { 593 aprint_verbose_dev(sc->sc_dev, "xHCI version %x.%x\n", 594 (hciversion >> 8) & 0xff, (hciversion >> 0) & 0xff); 595 } 596 597 if (bus_space_subregion(sc->sc_iot, sc->sc_ioh, 0, caplength, 598 &sc->sc_cbh) != 0) { 599 aprint_error_dev(sc->sc_dev, "capability subregion failure\n"); 600 return USBD_NOMEM; 601 } 602 603 hcs1 = xhci_cap_read_4(sc, XHCI_HCSPARAMS1); 604 sc->sc_maxslots = XHCI_HCS1_MAXSLOTS(hcs1); 605 sc->sc_maxintrs = XHCI_HCS1_MAXINTRS(hcs1); 606 sc->sc_maxports = XHCI_HCS1_MAXPORTS(hcs1); 607 hcs2 = xhci_cap_read_4(sc, XHCI_HCSPARAMS2); 608 (void)xhci_cap_read_4(sc, XHCI_HCSPARAMS3); 609 hcc = xhci_cap_read_4(sc, XHCI_HCCPARAMS); 610 611 sc->sc_ac64 = XHCI_HCC_AC64(hcc); 612 sc->sc_ctxsz = XHCI_HCC_CSZ(hcc) ? 64 : 32; 613 device_printf(sc->sc_dev, "ac64 %d ctxsz %d\n", sc->sc_ac64, 614 sc->sc_ctxsz); 615 616 device_printf(sc->sc_dev, "xECP %x\n", XHCI_HCC_XECP(hcc) * 4); 617 ecp = XHCI_HCC_XECP(hcc) * 4; 618 while (ecp != 0) { 619 ecr = xhci_read_4(sc, ecp); 620 device_printf(sc->sc_dev, "ECR %x: %08x\n", ecp, ecr); 621 switch (XHCI_XECP_ID(ecr)) { 622 case XHCI_ID_PROTOCOLS: { 623 uint32_t w0, w4, w8; 624 uint16_t w2; 625 w0 = xhci_read_4(sc, ecp + 0); 626 w2 = (w0 >> 16) & 0xffff; 627 w4 = xhci_read_4(sc, ecp + 4); 628 w8 = xhci_read_4(sc, ecp + 8); 629 device_printf(sc->sc_dev, "SP: %08x %08x %08x\n", 630 w0, w4, w8); 631 if (w4 == 0x20425355 && w2 == 0x0300) { 632 sc->sc_ss_port_start = (w8 >> 0) & 0xff;; 633 sc->sc_ss_port_count = (w8 >> 8) & 0xff;; 634 } 635 if (w4 == 0x20425355 && w2 == 0x0200) { 636 sc->sc_hs_port_start = (w8 >> 0) & 0xff; 637 sc->sc_hs_port_count = (w8 >> 8) & 0xff; 638 } 639 break; 640 } 641 default: 642 break; 643 } 644 ecr = xhci_read_4(sc, ecp); 645 if (XHCI_XECP_NEXT(ecr) == 0) { 646 ecp = 0; 647 } else { 648 ecp += XHCI_XECP_NEXT(ecr) * 4; 649 } 650 } 651 652 bsz = XHCI_PORTSC(sc->sc_maxports + 1); 653 if (bus_space_subregion(sc->sc_iot, sc->sc_ioh, caplength, bsz, 654 &sc->sc_obh) != 0) { 655 aprint_error_dev(sc->sc_dev, "operational subregion failure\n"); 656 return USBD_NOMEM; 657 } 658 659 dboff = xhci_cap_read_4(sc, XHCI_DBOFF); 660 if (bus_space_subregion(sc->sc_iot, sc->sc_ioh, dboff, 661 sc->sc_maxslots * 4, &sc->sc_dbh) != 0) { 662 aprint_error_dev(sc->sc_dev, "doorbell subregion failure\n"); 663 return USBD_NOMEM; 664 } 665 666 rtsoff = xhci_cap_read_4(sc, XHCI_RTSOFF); 667 if (bus_space_subregion(sc->sc_iot, sc->sc_ioh, rtsoff, 668 sc->sc_maxintrs * 0x20, &sc->sc_rbh) != 0) { 669 aprint_error_dev(sc->sc_dev, "runtime subregion failure\n"); 670 return USBD_NOMEM; 671 } 672 673 for (i = 0; i < 100; i++) { 674 usbsts = xhci_op_read_4(sc, XHCI_USBSTS); 675 if ((usbsts & XHCI_STS_CNR) == 0) 676 break; 677 usb_delay_ms(&sc->sc_bus, 1); 678 } 679 if (i >= 100) 680 return USBD_IOERROR; 681 682 usbcmd = 0; 683 xhci_op_write_4(sc, XHCI_USBCMD, usbcmd); 684 usb_delay_ms(&sc->sc_bus, 1); 685 686 usbcmd = XHCI_CMD_HCRST; 687 xhci_op_write_4(sc, XHCI_USBCMD, usbcmd); 688 for (i = 0; i < 100; i++) { 689 usbcmd = xhci_op_read_4(sc, XHCI_USBCMD); 690 if ((usbcmd & XHCI_CMD_HCRST) == 0) 691 break; 692 usb_delay_ms(&sc->sc_bus, 1); 693 } 694 if (i >= 100) 695 return USBD_IOERROR; 696 697 for (i = 0; i < 100; i++) { 698 usbsts = xhci_op_read_4(sc, XHCI_USBSTS); 699 if ((usbsts & XHCI_STS_CNR) == 0) 700 break; 701 usb_delay_ms(&sc->sc_bus, 1); 702 } 703 if (i >= 100) 704 return USBD_IOERROR; 705 706 pagesize = xhci_op_read_4(sc, XHCI_PAGESIZE); 707 device_printf(sc->sc_dev, "PAGESIZE 0x%08x\n", pagesize); 708 pagesize = ffs(pagesize); 709 if (pagesize == 0) 710 return USBD_IOERROR; 711 sc->sc_pgsz = 1 << (12 + (pagesize - 1)); 712 device_printf(sc->sc_dev, "sc_pgsz 0x%08x\n", (uint32_t)sc->sc_pgsz); 713 device_printf(sc->sc_dev, "sc_maxslots 0x%08x\n", 714 (uint32_t)sc->sc_maxslots); 715 716 usbd_status err; 717 718 sc->sc_maxspbuf = XHCI_HCS2_MAXSPBUF(hcs2); 719 device_printf(sc->sc_dev, "sc_maxspbuf %d\n", sc->sc_maxspbuf); 720 if (sc->sc_maxspbuf != 0) { 721 err = usb_allocmem(&sc->sc_bus, 722 sizeof(uint64_t) * sc->sc_maxspbuf, sizeof(uint64_t), 723 &sc->sc_spbufarray_dma); 724 if (err) 725 return err; 726 727 sc->sc_spbuf_dma = kmem_zalloc(sizeof(*sc->sc_spbuf_dma) * sc->sc_maxspbuf, KM_SLEEP); 728 uint64_t *spbufarray = KERNADDR(&sc->sc_spbufarray_dma, 0); 729 for (i = 0; i < sc->sc_maxspbuf; i++) { 730 usb_dma_t * const dma = &sc->sc_spbuf_dma[i]; 731 /* allocate contexts */ 732 err = usb_allocmem(&sc->sc_bus, sc->sc_pgsz, 733 sc->sc_pgsz, dma); 734 if (err) 735 return err; 736 spbufarray[i] = htole64(DMAADDR(dma, 0)); 737 usb_syncmem(dma, 0, sc->sc_pgsz, 738 BUS_DMASYNC_PREREAD|BUS_DMASYNC_PREWRITE); 739 } 740 741 usb_syncmem(&sc->sc_spbufarray_dma, 0, 742 sizeof(uint64_t) * sc->sc_maxspbuf, BUS_DMASYNC_PREWRITE); 743 } 744 745 config = xhci_op_read_4(sc, XHCI_CONFIG); 746 config &= ~0xFF; 747 config |= sc->sc_maxslots & 0xFF; 748 xhci_op_write_4(sc, XHCI_CONFIG, config); 749 750 err = xhci_ring_init(sc, &sc->sc_cr, XHCI_COMMAND_RING_TRBS, 751 XHCI_COMMAND_RING_SEGMENTS_ALIGN); 752 if (err) { 753 aprint_error_dev(sc->sc_dev, "command ring init fail\n"); 754 return err; 755 } 756 757 err = xhci_ring_init(sc, &sc->sc_er, XHCI_EVENT_RING_TRBS, 758 XHCI_EVENT_RING_SEGMENTS_ALIGN); 759 if (err) { 760 aprint_error_dev(sc->sc_dev, "event ring init fail\n"); 761 return err; 762 } 763 764 { 765 usb_dma_t *dma; 766 size_t size; 767 size_t align; 768 769 dma = &sc->sc_eventst_dma; 770 size = roundup2(XHCI_EVENT_RING_SEGMENTS * XHCI_ERSTE_SIZE, 771 XHCI_EVENT_RING_SEGMENT_TABLE_ALIGN); 772 KASSERT(size <= (512 * 1024)); 773 align = XHCI_EVENT_RING_SEGMENT_TABLE_ALIGN; 774 err = usb_allocmem(&sc->sc_bus, size, align, dma); 775 memset(KERNADDR(dma, 0), 0, size); 776 usb_syncmem(dma, 0, size, BUS_DMASYNC_PREWRITE); 777 device_printf(sc->sc_dev, "eventst: %s %016jx %p %zx\n", 778 usbd_errstr(err), 779 (uintmax_t)DMAADDR(&sc->sc_eventst_dma, 0), 780 KERNADDR(&sc->sc_eventst_dma, 0), 781 sc->sc_eventst_dma.block->size); 782 783 dma = &sc->sc_dcbaa_dma; 784 size = (1 + sc->sc_maxslots) * sizeof(uint64_t); 785 KASSERT(size <= 2048); 786 align = XHCI_DEVICE_CONTEXT_BASE_ADDRESS_ARRAY_ALIGN; 787 err = usb_allocmem(&sc->sc_bus, size, align, dma); 788 memset(KERNADDR(dma, 0), 0, size); 789 if (sc->sc_maxspbuf != 0) { 790 /* 791 * DCBA entry 0 hold the scratchbuf array pointer. 792 */ 793 *(uint64_t *)KERNADDR(dma, 0) = 794 htole64(DMAADDR(&sc->sc_spbufarray_dma, 0)); 795 } 796 usb_syncmem(dma, 0, size, BUS_DMASYNC_PREWRITE); 797 device_printf(sc->sc_dev, "dcbaa: %s %016jx %p %zx\n", 798 usbd_errstr(err), 799 (uintmax_t)DMAADDR(&sc->sc_dcbaa_dma, 0), 800 KERNADDR(&sc->sc_dcbaa_dma, 0), 801 sc->sc_dcbaa_dma.block->size); 802 } 803 804 sc->sc_slots = kmem_zalloc(sizeof(*sc->sc_slots) * sc->sc_maxslots, 805 KM_SLEEP); 806 807 cv_init(&sc->sc_command_cv, "xhcicmd"); 808 809 struct xhci_erste *erst; 810 erst = KERNADDR(&sc->sc_eventst_dma, 0); 811 erst[0].erste_0 = htole64(xhci_ring_trbp(&sc->sc_er, 0)); 812 erst[0].erste_2 = htole32(XHCI_EVENT_RING_TRBS); 813 erst[0].erste_3 = htole32(0); 814 usb_syncmem(&sc->sc_eventst_dma, 0, 815 XHCI_ERSTE_SIZE * XHCI_EVENT_RING_SEGMENTS, BUS_DMASYNC_PREWRITE); 816 817 xhci_rt_write_4(sc, XHCI_ERSTSZ(0), XHCI_EVENT_RING_SEGMENTS); 818 xhci_rt_write_8(sc, XHCI_ERSTBA(0), DMAADDR(&sc->sc_eventst_dma, 0)); 819 xhci_rt_write_8(sc, XHCI_ERDP(0), xhci_ring_trbp(&sc->sc_er, 0) | 820 XHCI_ERDP_LO_BUSY); 821 xhci_op_write_8(sc, XHCI_DCBAAP, DMAADDR(&sc->sc_dcbaa_dma, 0)); 822 xhci_op_write_8(sc, XHCI_CRCR, xhci_ring_trbp(&sc->sc_cr, 0) | 823 sc->sc_cr.xr_cs); 824 825 #if 0 826 hexdump("eventst", KERNADDR(&sc->sc_eventst_dma, 0), 827 XHCI_ERSTE_SIZE * XHCI_EVENT_RING_SEGMENTS); 828 #endif 829 830 xhci_rt_write_4(sc, XHCI_IMAN(0), XHCI_IMAN_INTR_ENA); 831 xhci_rt_write_4(sc, XHCI_IMOD(0), 0); 832 833 xhci_op_write_4(sc, XHCI_USBCMD, XHCI_CMD_INTE|XHCI_CMD_RS); /* Go! */ 834 device_printf(sc->sc_dev, "USBCMD %08"PRIx32"\n", 835 xhci_op_read_4(sc, XHCI_USBCMD)); 836 837 mutex_init(&sc->sc_lock, MUTEX_DEFAULT, IPL_SOFTUSB); 838 mutex_init(&sc->sc_intr_lock, MUTEX_DEFAULT, IPL_SCHED); 839 cv_init(&sc->sc_softwake_cv, "xhciab"); 840 841 sc->sc_xferpool = pool_cache_init(sizeof(struct xhci_xfer), 0, 0, 0, 842 "xhcixfer", NULL, IPL_USB, NULL, NULL, NULL); 843 844 /* Set up the bus struct. */ 845 sc->sc_bus.methods = &xhci_bus_methods; 846 sc->sc_bus.pipe_size = sizeof(struct xhci_pipe); 847 848 return USBD_NORMAL_COMPLETION; 849 } 850 851 int 852 xhci_intr(void *v) 853 { 854 struct xhci_softc * const sc = v; 855 856 if (sc == NULL || sc->sc_dying || !device_has_power(sc->sc_dev)) 857 return 0; 858 859 DPRINTF(("%s: %s\n", __func__, device_xname(sc->sc_dev))); 860 861 /* If we get an interrupt while polling, then just ignore it. */ 862 if (sc->sc_bus.use_polling) { 863 #ifdef DIAGNOSTIC 864 DPRINTFN(16, ("xhci_intr: ignored interrupt while polling\n")); 865 #endif 866 return 0; 867 } 868 869 return xhci_intr1(sc); 870 } 871 872 int 873 xhci_intr1(struct xhci_softc * const sc) 874 { 875 uint32_t usbsts; 876 uint32_t iman; 877 878 usbsts = xhci_op_read_4(sc, XHCI_USBSTS); 879 //device_printf(sc->sc_dev, "%s USBSTS %08x\n", __func__, usbsts); 880 #if 0 881 if ((usbsts & (XHCI_STS_EINT|XHCI_STS_PCD)) == 0) { 882 return 0; 883 } 884 #endif 885 xhci_op_write_4(sc, XHCI_USBSTS, 886 usbsts & (2|XHCI_STS_EINT|XHCI_STS_PCD)); /* XXX */ 887 usbsts = xhci_op_read_4(sc, XHCI_USBSTS); 888 //device_printf(sc->sc_dev, "%s USBSTS %08x\n", __func__, usbsts); 889 890 iman = xhci_rt_read_4(sc, XHCI_IMAN(0)); 891 //device_printf(sc->sc_dev, "%s IMAN0 %08x\n", __func__, iman); 892 if ((iman & XHCI_IMAN_INTR_PEND) == 0) { 893 return 0; 894 } 895 xhci_rt_write_4(sc, XHCI_IMAN(0), iman); 896 iman = xhci_rt_read_4(sc, XHCI_IMAN(0)); 897 //device_printf(sc->sc_dev, "%s IMAN0 %08x\n", __func__, iman); 898 usbsts = xhci_op_read_4(sc, XHCI_USBSTS); 899 //device_printf(sc->sc_dev, "%s USBSTS %08x\n", __func__, usbsts); 900 901 sc->sc_bus.no_intrs++; 902 usb_schedsoftintr(&sc->sc_bus); 903 904 return 1; 905 } 906 907 static usbd_status 908 xhci_configure_endpoint(usbd_pipe_handle pipe) 909 { 910 struct xhci_softc * const sc = pipe->device->bus->hci_private; 911 struct xhci_slot * const xs = pipe->device->hci_private; 912 const u_int dci = xhci_ep_get_dci(pipe->endpoint->edesc); 913 usb_endpoint_descriptor_t * const ed = pipe->endpoint->edesc; 914 const uint8_t xfertype = UE_GET_XFERTYPE(ed->bmAttributes); 915 struct xhci_trb trb; 916 usbd_status err; 917 uint32_t *cp; 918 919 device_printf(sc->sc_dev, "%s dci %u (0x%x)\n", __func__, dci, 920 pipe->endpoint->edesc->bEndpointAddress); 921 922 /* XXX ensure input context is available? */ 923 924 memset(xhci_slot_get_icv(sc, xs, 0), 0, sc->sc_pgsz); 925 926 cp = xhci_slot_get_icv(sc, xs, XHCI_ICI_INPUT_CONTROL); 927 cp[0] = htole32(0); 928 cp[1] = htole32(XHCI_INCTX_1_ADD_MASK(dci)); 929 930 /* set up input slot context */ 931 cp = xhci_slot_get_icv(sc, xs, xhci_dci_to_ici(XHCI_DCI_SLOT)); 932 cp[0] = htole32(XHCI_SCTX_0_CTX_NUM_SET(dci)); 933 cp[1] = htole32(0); 934 cp[2] = htole32(0); 935 cp[3] = htole32(0); 936 937 cp = xhci_slot_get_icv(sc, xs, xhci_dci_to_ici(dci)); 938 if (xfertype == UE_INTERRUPT) { 939 cp[0] = htole32( 940 XHCI_EPCTX_0_IVAL_SET(3) /* XXX */ 941 ); 942 cp[1] = htole32( 943 XHCI_EPCTX_1_CERR_SET(3) | 944 XHCI_EPCTX_1_EPTYPE_SET(xhci_ep_get_type(pipe->endpoint->edesc)) | 945 XHCI_EPCTX_1_MAXB_SET(0) | 946 XHCI_EPCTX_1_MAXP_SIZE_SET(8) /* XXX */ 947 ); 948 cp[4] = htole32( 949 XHCI_EPCTX_4_AVG_TRB_LEN_SET(8) 950 ); 951 } else { 952 cp[0] = htole32(0); 953 cp[1] = htole32( 954 XHCI_EPCTX_1_CERR_SET(3) | 955 XHCI_EPCTX_1_EPTYPE_SET(xhci_ep_get_type(pipe->endpoint->edesc)) | 956 XHCI_EPCTX_1_MAXB_SET(0) | 957 XHCI_EPCTX_1_MAXP_SIZE_SET(512) /* XXX */ 958 ); 959 } 960 *(uint64_t *)(&cp[2]) = htole64( 961 xhci_ring_trbp(&xs->xs_ep[dci].xe_tr, 0) | 962 XHCI_EPCTX_2_DCS_SET(1)); 963 964 /* sync input contexts before they are read from memory */ 965 usb_syncmem(&xs->xs_ic_dma, 0, sc->sc_pgsz, BUS_DMASYNC_PREWRITE); 966 hexdump("input control context", xhci_slot_get_icv(sc, xs, 0), 967 sc->sc_ctxsz * 1); 968 hexdump("input endpoint context", xhci_slot_get_icv(sc, xs, 969 xhci_dci_to_ici(dci)), sc->sc_ctxsz * 1); 970 971 trb.trb_0 = xhci_slot_get_icp(sc, xs, 0); 972 trb.trb_2 = 0; 973 trb.trb_3 = XHCI_TRB_3_SLOT_SET(xs->xs_idx) | 974 XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_CONFIGURE_EP); 975 976 err = xhci_do_command(sc, &trb, USBD_DEFAULT_TIMEOUT); 977 978 usb_syncmem(&xs->xs_dc_dma, 0, sc->sc_pgsz, BUS_DMASYNC_POSTREAD); 979 hexdump("output context", xhci_slot_get_dcv(sc, xs, dci), 980 sc->sc_ctxsz * 1); 981 982 return err; 983 } 984 985 static usbd_status 986 xhci_unconfigure_endpoint(usbd_pipe_handle pipe) 987 { 988 return USBD_NORMAL_COMPLETION; 989 } 990 991 static usbd_status 992 xhci_reset_endpoint(usbd_pipe_handle pipe) 993 { 994 struct xhci_softc * const sc = pipe->device->bus->hci_private; 995 struct xhci_slot * const xs = pipe->device->hci_private; 996 const u_int dci = xhci_ep_get_dci(pipe->endpoint->edesc); 997 struct xhci_trb trb; 998 usbd_status err; 999 1000 device_printf(sc->sc_dev, "%s\n", __func__); 1001 1002 trb.trb_0 = 0; 1003 trb.trb_2 = 0; 1004 trb.trb_3 = XHCI_TRB_3_SLOT_SET(xs->xs_idx) | 1005 XHCI_TRB_3_EP_SET(dci) | 1006 XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_RESET_EP); 1007 1008 err = xhci_do_command(sc, &trb, USBD_DEFAULT_TIMEOUT); 1009 1010 return err; 1011 } 1012 1013 #if 0 1014 static usbd_status 1015 xhci_stop_endpoint(usbd_pipe_handle pipe) 1016 { 1017 struct xhci_softc * const sc = pipe->device->bus->hci_private; 1018 struct xhci_slot * const xs = pipe->device->hci_private; 1019 struct xhci_trb trb; 1020 usbd_status err; 1021 const u_int dci = xhci_ep_get_dci(pipe->endpoint->edesc); 1022 1023 device_printf(sc->sc_dev, "%s\n", __func__); 1024 1025 trb.trb_0 = 0; 1026 trb.trb_2 = 0; 1027 trb.trb_3 = XHCI_TRB_3_SLOT_SET(xs->xs_idx) | 1028 XHCI_TRB_3_EP_SET(dci) | 1029 XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_STOP_EP); 1030 1031 err = xhci_do_command(sc, &trb, USBD_DEFAULT_TIMEOUT); 1032 1033 return err; 1034 } 1035 #endif 1036 1037 static usbd_status 1038 xhci_set_dequeue(usbd_pipe_handle pipe) 1039 { 1040 struct xhci_softc * const sc = pipe->device->bus->hci_private; 1041 struct xhci_slot * const xs = pipe->device->hci_private; 1042 const u_int dci = xhci_ep_get_dci(pipe->endpoint->edesc); 1043 struct xhci_ring * const xr = &xs->xs_ep[dci].xe_tr; 1044 struct xhci_trb trb; 1045 usbd_status err; 1046 1047 device_printf(sc->sc_dev, "%s\n", __func__); 1048 1049 memset(xr->xr_trb, 0, xr->xr_ntrb * XHCI_TRB_SIZE); 1050 usb_syncmem(&xr->xr_dma, 0, xr->xr_ntrb * XHCI_TRB_SIZE, 1051 BUS_DMASYNC_PREWRITE); 1052 1053 xr->xr_ep = 0; 1054 xr->xr_cs = 1; 1055 1056 trb.trb_0 = xhci_ring_trbp(xr, 0) | 1; /* XXX */ 1057 trb.trb_2 = 0; 1058 trb.trb_3 = XHCI_TRB_3_SLOT_SET(xs->xs_idx) | 1059 XHCI_TRB_3_EP_SET(dci) | 1060 XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_SET_TR_DEQUEUE); 1061 1062 err = xhci_do_command(sc, &trb, USBD_DEFAULT_TIMEOUT); 1063 1064 return err; 1065 } 1066 1067 static usbd_status 1068 xhci_open(usbd_pipe_handle pipe) 1069 { 1070 usbd_device_handle const dev = pipe->device; 1071 struct xhci_softc * const sc = dev->bus->hci_private; 1072 usb_endpoint_descriptor_t * const ed = pipe->endpoint->edesc; 1073 const int8_t addr = dev->address; 1074 const uint8_t xfertype = UE_GET_XFERTYPE(ed->bmAttributes); 1075 1076 DPRINTF(("%s\n", __func__)); 1077 DPRINTF(("addr %d\n", addr)); 1078 device_printf(sc->sc_dev, "%s addr %d depth %d port %d speed %d\n", 1079 __func__, addr, dev->depth, dev->powersrc->portno, dev->speed); 1080 1081 if (sc->sc_dying) 1082 return USBD_IOERROR; 1083 1084 /* Root Hub */ 1085 if (dev->depth == 0 && dev->powersrc->portno == 0 && 1086 dev->speed != USB_SPEED_SUPER) { 1087 switch (ed->bEndpointAddress) { 1088 case USB_CONTROL_ENDPOINT: 1089 pipe->methods = &xhci_root_ctrl_methods; 1090 break; 1091 case UE_DIR_IN | XHCI_INTR_ENDPT: 1092 pipe->methods = &xhci_root_intr_methods; 1093 break; 1094 default: 1095 pipe->methods = NULL; 1096 DPRINTF(("xhci_open: bad bEndpointAddress 0x%02x\n", 1097 ed->bEndpointAddress)); 1098 return USBD_INVAL; 1099 } 1100 return USBD_NORMAL_COMPLETION; 1101 } 1102 1103 switch (xfertype) { 1104 case UE_CONTROL: 1105 pipe->methods = &xhci_device_ctrl_methods; 1106 break; 1107 case UE_ISOCHRONOUS: 1108 pipe->methods = &xhci_device_isoc_methods; 1109 return USBD_INVAL; 1110 break; 1111 case UE_BULK: 1112 pipe->methods = &xhci_device_bulk_methods; 1113 break; 1114 case UE_INTERRUPT: 1115 pipe->methods = &xhci_device_intr_methods; 1116 break; 1117 default: 1118 return USBD_IOERROR; 1119 break; 1120 } 1121 1122 if (ed->bEndpointAddress != USB_CONTROL_ENDPOINT) 1123 xhci_configure_endpoint(pipe); 1124 1125 return USBD_NORMAL_COMPLETION; 1126 } 1127 1128 static void 1129 xhci_rhpsc(struct xhci_softc * const sc, u_int port) 1130 { 1131 usbd_xfer_handle const xfer = sc->sc_intrxfer; 1132 uint8_t *p; 1133 1134 device_printf(sc->sc_dev, "port %u status change\n", port); 1135 1136 if (xfer == NULL) 1137 return; 1138 1139 if (!(port >= sc->sc_hs_port_start && 1140 port < sc->sc_hs_port_start + sc->sc_hs_port_count)) 1141 return; 1142 1143 port -= sc->sc_hs_port_start; 1144 port += 1; 1145 device_printf(sc->sc_dev, "hs port %u status change\n", port); 1146 1147 p = KERNADDR(&xfer->dmabuf, 0); 1148 memset(p, 0, xfer->length); 1149 p[port/NBBY] |= 1 << (port%NBBY); 1150 xfer->actlen = xfer->length; 1151 xfer->status = USBD_NORMAL_COMPLETION; 1152 usb_transfer_complete(xfer); 1153 } 1154 1155 static void 1156 xhci_handle_event(struct xhci_softc * const sc, const struct xhci_trb * const trb) 1157 { 1158 uint64_t trb_0; 1159 uint32_t trb_2, trb_3; 1160 1161 DPRINTF(("%s: %s\n", __func__, device_xname(sc->sc_dev))); 1162 1163 trb_0 = le64toh(trb->trb_0); 1164 trb_2 = le32toh(trb->trb_2); 1165 trb_3 = le32toh(trb->trb_3); 1166 1167 #if 0 1168 device_printf(sc->sc_dev, 1169 "event: %p 0x%016"PRIx64" 0x%08"PRIx32" 0x%08"PRIx32"\n", trb, 1170 trb_0, trb_2, trb_3); 1171 #endif 1172 1173 switch (XHCI_TRB_3_TYPE_GET(trb_3)){ 1174 case XHCI_TRB_EVENT_TRANSFER: { 1175 u_int slot, dci; 1176 struct xhci_slot *xs; 1177 struct xhci_ring *xr; 1178 struct xhci_xfer *xx; 1179 usbd_xfer_handle xfer; 1180 usbd_status err; 1181 1182 slot = XHCI_TRB_3_SLOT_GET(trb_3); 1183 dci = XHCI_TRB_3_EP_GET(trb_3); 1184 1185 xs = &sc->sc_slots[slot]; 1186 xr = &xs->xs_ep[dci].xe_tr; 1187 1188 if ((trb_3 & XHCI_TRB_3_ED_BIT) == 0) { 1189 xx = xr->xr_cookies[(trb_0 - xhci_ring_trbp(xr, 0))/ 1190 sizeof(struct xhci_trb)]; 1191 } else { 1192 xx = (void *)(uintptr_t)(trb_0 & ~0x3); 1193 } 1194 xfer = &xx->xx_xfer; 1195 #if 0 1196 device_printf(sc->sc_dev, "%s xfer %p\n", __func__, xfer); 1197 #endif 1198 1199 if ((trb_3 & XHCI_TRB_3_ED_BIT) != 0) { 1200 #if 0 1201 device_printf(sc->sc_dev, "transfer event data: " 1202 "0x%016"PRIx64" 0x%08"PRIx32" %02x\n", 1203 trb_0, XHCI_TRB_2_REM_GET(trb_2), 1204 XHCI_TRB_2_ERROR_GET(trb_2)); 1205 #endif 1206 if ((trb_0 & 0x3) == 0x3) { 1207 xfer->actlen = XHCI_TRB_2_REM_GET(trb_2); 1208 } 1209 } 1210 1211 if (XHCI_TRB_2_ERROR_GET(trb_2) == 1212 XHCI_TRB_ERROR_SUCCESS) { 1213 xfer->actlen = xfer->length - XHCI_TRB_2_REM_GET(trb_2); 1214 err = USBD_NORMAL_COMPLETION; 1215 } else if (XHCI_TRB_2_ERROR_GET(trb_2) == 1216 XHCI_TRB_ERROR_SHORT_PKT) { 1217 xfer->actlen = xfer->length - XHCI_TRB_2_REM_GET(trb_2); 1218 err = USBD_NORMAL_COMPLETION; 1219 } else if (XHCI_TRB_2_ERROR_GET(trb_2) == 1220 XHCI_TRB_ERROR_STALL) { 1221 err = USBD_STALLED; 1222 xr->is_halted = true; 1223 } else { 1224 err = USBD_IOERROR; 1225 } 1226 xfer->status = err; 1227 1228 //mutex_enter(&sc->sc_lock); /* XXX ??? */ 1229 if ((trb_3 & XHCI_TRB_3_ED_BIT) != 0) { 1230 if ((trb_0 & 0x3) == 0x0) { 1231 usb_transfer_complete(xfer); 1232 } 1233 } else { 1234 usb_transfer_complete(xfer); 1235 } 1236 //mutex_exit(&sc->sc_lock); /* XXX ??? */ 1237 1238 } 1239 break; 1240 case XHCI_TRB_EVENT_CMD_COMPLETE: 1241 if (trb_0 == sc->sc_command_addr) { 1242 sc->sc_result_trb.trb_0 = trb_0; 1243 sc->sc_result_trb.trb_2 = trb_2; 1244 sc->sc_result_trb.trb_3 = trb_3; 1245 if (XHCI_TRB_2_ERROR_GET(trb_2) != 1246 XHCI_TRB_ERROR_SUCCESS) { 1247 device_printf(sc->sc_dev, "command completion " 1248 "failure: 0x%016"PRIx64" 0x%08"PRIx32" " 1249 "0x%08"PRIx32"\n", trb_0, trb_2, trb_3); 1250 } 1251 cv_signal(&sc->sc_command_cv); 1252 } else { 1253 device_printf(sc->sc_dev, "event: %p 0x%016"PRIx64" " 1254 "0x%08"PRIx32" 0x%08"PRIx32"\n", trb, trb_0, 1255 trb_2, trb_3); 1256 } 1257 break; 1258 case XHCI_TRB_EVENT_PORT_STS_CHANGE: 1259 xhci_rhpsc(sc, (uint32_t)((trb_0 >> 24) & 0xff)); 1260 break; 1261 default: 1262 break; 1263 } 1264 } 1265 1266 static void 1267 xhci_softintr(void *v) 1268 { 1269 struct usbd_bus * const bus = v; 1270 struct xhci_softc * const sc = bus->hci_private; 1271 struct xhci_ring * const er = &sc->sc_er; 1272 struct xhci_trb *trb; 1273 int i, j, k; 1274 1275 DPRINTF(("%s: %s\n", __func__, device_xname(sc->sc_dev))); 1276 1277 i = er->xr_ep; 1278 j = er->xr_cs; 1279 1280 while (1) { 1281 usb_syncmem(&er->xr_dma, XHCI_TRB_SIZE * i, XHCI_TRB_SIZE, 1282 BUS_DMASYNC_POSTREAD); 1283 trb = &er->xr_trb[i]; 1284 k = (le32toh(trb->trb_3) & XHCI_TRB_3_CYCLE_BIT) ? 1 : 0; 1285 1286 if (j != k) 1287 break; 1288 1289 xhci_handle_event(sc, trb); 1290 1291 i++; 1292 if (i == XHCI_EVENT_RING_TRBS) { 1293 i = 0; 1294 j ^= 1; 1295 } 1296 } 1297 1298 er->xr_ep = i; 1299 er->xr_cs = j; 1300 1301 xhci_rt_write_8(sc, XHCI_ERDP(0), xhci_ring_trbp(er, er->xr_ep) | 1302 XHCI_ERDP_LO_BUSY); 1303 1304 DPRINTF(("%s: %s ends\n", __func__, device_xname(sc->sc_dev))); 1305 1306 return; 1307 } 1308 1309 static void 1310 xhci_poll(struct usbd_bus *bus) 1311 { 1312 struct xhci_softc * const sc = bus->hci_private; 1313 1314 DPRINTF(("%s: %s\n", __func__, device_xname(sc->sc_dev))); 1315 1316 xhci_intr1(sc); 1317 1318 return; 1319 } 1320 1321 static usbd_status 1322 xhci_allocm(struct usbd_bus *bus, usb_dma_t *dma, uint32_t size) 1323 { 1324 struct xhci_softc * const sc = bus->hci_private; 1325 usbd_status err; 1326 1327 DPRINTF(("%s\n", __func__)); 1328 1329 err = usb_allocmem_flags(&sc->sc_bus, size, 0, dma, 0); 1330 #if 0 1331 if (err == USBD_NOMEM) 1332 err = usb_reserve_allocm(&sc->sc_dma_reserve, dma, size); 1333 #endif 1334 #ifdef XHCI_DEBUG 1335 if (err) 1336 device_printf(sc->sc_dev, "xhci_allocm: usb_allocmem()=%d\n", 1337 err); 1338 #endif 1339 1340 return err; 1341 } 1342 1343 static void 1344 xhci_freem(struct usbd_bus *bus, usb_dma_t *dma) 1345 { 1346 struct xhci_softc * const sc = bus->hci_private; 1347 1348 // DPRINTF(("%s\n", __func__)); 1349 1350 #if 0 1351 if (dma->block->flags & USB_DMA_RESERVE) { 1352 usb_reserve_freem(&sc->sc_dma_reserve, dma); 1353 return; 1354 } 1355 #endif 1356 usb_freemem(&sc->sc_bus, dma); 1357 } 1358 1359 static usbd_xfer_handle 1360 xhci_allocx(struct usbd_bus *bus) 1361 { 1362 struct xhci_softc * const sc = bus->hci_private; 1363 usbd_xfer_handle xfer; 1364 1365 // DPRINTF(("%s\n", __func__)); 1366 1367 xfer = pool_cache_get(sc->sc_xferpool, PR_NOWAIT); 1368 if (xfer != NULL) { 1369 memset(xfer, 0, sizeof(struct xhci_xfer)); 1370 #ifdef DIAGNOSTIC 1371 xfer->busy_free = XFER_BUSY; 1372 #endif 1373 } 1374 1375 return xfer; 1376 } 1377 1378 static void 1379 xhci_freex(struct usbd_bus *bus, usbd_xfer_handle xfer) 1380 { 1381 struct xhci_softc * const sc = bus->hci_private; 1382 1383 // DPRINTF(("%s\n", __func__)); 1384 1385 #ifdef DIAGNOSTIC 1386 if (xfer->busy_free != XFER_BUSY) { 1387 device_printf(sc->sc_dev, "xhci_freex: xfer=%p " 1388 "not busy, 0x%08x\n", xfer, xfer->busy_free); 1389 } 1390 xfer->busy_free = XFER_FREE; 1391 #endif 1392 pool_cache_put(sc->sc_xferpool, xfer); 1393 } 1394 1395 static void 1396 xhci_get_lock(struct usbd_bus *bus, kmutex_t **lock) 1397 { 1398 struct xhci_softc * const sc = bus->hci_private; 1399 1400 *lock = &sc->sc_lock; 1401 } 1402 1403 extern u_int32_t usb_cookie_no; 1404 1405 static usbd_status 1406 xhci_new_device(device_t parent, usbd_bus_handle bus, int depth, 1407 int speed, int port, struct usbd_port *up) 1408 { 1409 struct xhci_softc * const sc = bus->hci_private; 1410 usbd_device_handle dev; 1411 usbd_status err; 1412 usb_device_descriptor_t *dd; 1413 struct usbd_device *hub; 1414 struct usbd_device *adev; 1415 int rhport = 0; 1416 struct xhci_slot *xs; 1417 uint32_t *cp; 1418 uint8_t slot; 1419 uint8_t addr; 1420 1421 dev = malloc(sizeof *dev, M_USB, M_NOWAIT|M_ZERO); 1422 if (dev == NULL) 1423 return USBD_NOMEM; 1424 1425 dev->bus = bus; 1426 1427 /* Set up default endpoint handle. */ 1428 dev->def_ep.edesc = &dev->def_ep_desc; 1429 1430 /* Set up default endpoint descriptor. */ 1431 dev->def_ep_desc.bLength = USB_ENDPOINT_DESCRIPTOR_SIZE; 1432 dev->def_ep_desc.bDescriptorType = UDESC_ENDPOINT; 1433 dev->def_ep_desc.bEndpointAddress = USB_CONTROL_ENDPOINT; 1434 dev->def_ep_desc.bmAttributes = UE_CONTROL; 1435 /* XXX */ 1436 USETW(dev->def_ep_desc.wMaxPacketSize, 64); 1437 dev->def_ep_desc.bInterval = 0; 1438 1439 /* doesn't matter, just don't let it uninitialized */ 1440 dev->def_ep.datatoggle = 0; 1441 1442 device_printf(sc->sc_dev, "%s up %p portno %d\n", __func__, up, 1443 up->portno); 1444 1445 dev->quirks = &usbd_no_quirk; 1446 dev->address = 0; 1447 dev->ddesc.bMaxPacketSize = 0; 1448 dev->depth = depth; 1449 dev->powersrc = up; 1450 dev->myhub = up->parent; 1451 1452 up->device = dev; 1453 1454 /* Locate root hub port */ 1455 for (adev = dev, hub = dev; 1456 hub != NULL; 1457 adev = hub, hub = hub->myhub) { 1458 device_printf(sc->sc_dev, "%s hub %p\n", __func__, hub); 1459 } 1460 device_printf(sc->sc_dev, "%s hub %p\n", __func__, hub); 1461 1462 if (hub != NULL) { 1463 for (int p = 0; p < hub->hub->hubdesc.bNbrPorts; p++) { 1464 if (hub->hub->ports[p].device == adev) { 1465 rhport = p; 1466 } 1467 } 1468 } else { 1469 rhport = port; 1470 } 1471 if (speed == USB_SPEED_SUPER) { 1472 rhport += sc->sc_ss_port_start - 1; 1473 } else { 1474 rhport += sc->sc_hs_port_start - 1; 1475 } 1476 device_printf(sc->sc_dev, "%s rhport %d\n", __func__, rhport); 1477 1478 dev->speed = speed; 1479 dev->langid = USBD_NOLANG; 1480 dev->cookie.cookie = ++usb_cookie_no; 1481 1482 /* Establish the default pipe. */ 1483 err = usbd_setup_pipe(dev, 0, &dev->def_ep, USBD_DEFAULT_INTERVAL, 1484 &dev->default_pipe); 1485 if (err) { 1486 usbd_remove_device(dev, up); 1487 return (err); 1488 } 1489 1490 dd = &dev->ddesc; 1491 1492 if ((depth == 0) && (port == 0)) { 1493 KASSERT(bus->devices[dev->address] == NULL); 1494 bus->devices[dev->address] = dev; 1495 err = usbd_get_initial_ddesc(dev, dd); 1496 if (err) 1497 return err; 1498 err = usbd_reload_device_desc(dev); 1499 if (err) 1500 return err; 1501 } else { 1502 err = xhci_enable_slot(sc, &slot); 1503 if (err) 1504 return err; 1505 err = xhci_init_slot(sc, slot, depth, speed, port, rhport); 1506 if (err) 1507 return err; 1508 xs = &sc->sc_slots[slot]; 1509 dev->hci_private = xs; 1510 cp = xhci_slot_get_dcv(sc, xs, XHCI_DCI_SLOT); 1511 //hexdump("slot context", cp, sc->sc_ctxsz); 1512 addr = XHCI_SCTX_3_DEV_ADDR_GET(cp[3]); 1513 device_printf(sc->sc_dev, "%s device address %u\n", 1514 __func__, addr); 1515 /* XXX ensure we know when the hardware does something 1516 we can't yet cope with */ 1517 KASSERT(addr >= 1 && addr <= 127); 1518 dev->address = addr; 1519 /* XXX dev->address not necessarily unique on bus */ 1520 KASSERT(bus->devices[dev->address] == NULL); 1521 bus->devices[dev->address] = dev; 1522 1523 err = usbd_get_initial_ddesc(dev, dd); 1524 if (err) 1525 return err; 1526 USETW(dev->def_ep_desc.wMaxPacketSize, dd->bMaxPacketSize); 1527 device_printf(sc->sc_dev, "%s bMaxPacketSize %u\n", __func__, 1528 dd->bMaxPacketSize); 1529 xhci_update_ep0_mps(sc, xs, dd->bMaxPacketSize); 1530 err = usbd_reload_device_desc(dev); 1531 if (err) 1532 return err; 1533 1534 usbd_kill_pipe(dev->default_pipe); 1535 err = usbd_setup_pipe(dev, 0, &dev->def_ep, 1536 USBD_DEFAULT_INTERVAL, &dev->default_pipe); 1537 } 1538 1539 DPRINTF(("usbd_new_device: adding unit addr=%d, rev=%02x, class=%d, " 1540 "subclass=%d, protocol=%d, maxpacket=%d, len=%d, noconf=%d, " 1541 "speed=%d\n", dev->address,UGETW(dd->bcdUSB), 1542 dd->bDeviceClass, dd->bDeviceSubClass, dd->bDeviceProtocol, 1543 dd->bMaxPacketSize, dd->bLength, dd->bNumConfigurations, 1544 dev->speed)); 1545 1546 usbd_add_dev_event(USB_EVENT_DEVICE_ATTACH, dev); 1547 1548 if ((depth == 0) && (port == 0)) { 1549 usbd_attach_roothub(parent, dev); 1550 device_printf(sc->sc_dev, "root_hub %p\n", bus->root_hub); 1551 return USBD_NORMAL_COMPLETION; 1552 } 1553 1554 1555 err = usbd_probe_and_attach(parent, dev, port, dev->address); 1556 if (err) { 1557 usbd_remove_device(dev, up); 1558 return (err); 1559 } 1560 1561 return USBD_NORMAL_COMPLETION; 1562 } 1563 1564 static usbd_status 1565 xhci_ring_init(struct xhci_softc * const sc, struct xhci_ring * const xr, 1566 size_t ntrb, size_t align) 1567 { 1568 usbd_status err; 1569 size_t size = ntrb * XHCI_TRB_SIZE; 1570 1571 err = usb_allocmem(&sc->sc_bus, size, align, &xr->xr_dma); 1572 if (err) 1573 return err; 1574 mutex_init(&xr->xr_lock, MUTEX_DEFAULT, IPL_SOFTUSB); 1575 xr->xr_cookies = kmem_zalloc(sizeof(*xr->xr_cookies) * ntrb, KM_SLEEP); 1576 xr->xr_trb = xhci_ring_trbv(xr, 0); 1577 xr->xr_ntrb = ntrb; 1578 xr->xr_ep = 0; 1579 xr->xr_cs = 1; 1580 memset(xr->xr_trb, 0, size); 1581 usb_syncmem(&xr->xr_dma, 0, size, BUS_DMASYNC_PREWRITE); 1582 xr->is_halted = false; 1583 1584 return USBD_NORMAL_COMPLETION; 1585 } 1586 1587 static void 1588 xhci_ring_free(struct xhci_softc * const sc, struct xhci_ring * const xr) 1589 { 1590 usb_freemem(&sc->sc_bus, &xr->xr_dma); 1591 mutex_destroy(&xr->xr_lock); 1592 kmem_free(xr->xr_cookies, sizeof(*xr->xr_cookies) * xr->xr_ntrb); 1593 } 1594 1595 static void 1596 xhci_ring_put(struct xhci_softc * const sc, struct xhci_ring * const xr, 1597 void *cookie, struct xhci_trb * const trbs, size_t ntrbs) 1598 { 1599 size_t i; 1600 u_int ri; 1601 u_int cs; 1602 uint64_t parameter; 1603 uint32_t status; 1604 uint32_t control; 1605 1606 for (i = 0; i < ntrbs; i++) { 1607 #if 0 1608 device_printf(sc->sc_dev, "%s %p %p %zu " 1609 "%016"PRIx64" %08"PRIx32" %08"PRIx32"\n", __func__, xr, 1610 trbs, i, trbs[i].trb_0, trbs[i].trb_2, trbs[i].trb_3); 1611 #endif 1612 KASSERT(XHCI_TRB_3_TYPE_GET(trbs[i].trb_3) != 1613 XHCI_TRB_TYPE_LINK); 1614 } 1615 1616 #if 0 1617 device_printf(sc->sc_dev, "%s %p xr_ep 0x%x xr_cs %u\n", __func__, 1618 xr, xr->xr_ep, xr->xr_cs); 1619 #endif 1620 1621 ri = xr->xr_ep; 1622 cs = xr->xr_cs; 1623 1624 if (ri + ntrbs >= (xr->xr_ntrb - 1)) { 1625 parameter = xhci_ring_trbp(xr, 0); 1626 status = 0; 1627 control = XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_LINK) | 1628 XHCI_TRB_3_TC_BIT | (cs ? XHCI_TRB_3_CYCLE_BIT : 0); 1629 xhci_trb_put(&xr->xr_trb[ri], htole64(parameter), 1630 htole32(status), htole32(control)); 1631 usb_syncmem(&xr->xr_dma, XHCI_TRB_SIZE * ri, XHCI_TRB_SIZE * 1, 1632 BUS_DMASYNC_PREWRITE); 1633 xr->xr_cookies[ri] = NULL; 1634 xr->xr_ep = 0; 1635 xr->xr_cs ^= 1; 1636 ri = xr->xr_ep; 1637 cs = xr->xr_cs; 1638 } 1639 1640 ri++; 1641 1642 for (i = 1; i < ntrbs; i++) { 1643 parameter = trbs[i].trb_0; 1644 status = trbs[i].trb_2; 1645 control = trbs[i].trb_3; 1646 1647 if (cs) { 1648 control |= XHCI_TRB_3_CYCLE_BIT; 1649 } else { 1650 control &= ~XHCI_TRB_3_CYCLE_BIT; 1651 } 1652 1653 xhci_trb_put(&xr->xr_trb[ri], htole64(parameter), 1654 htole32(status), htole32(control)); 1655 usb_syncmem(&xr->xr_dma, XHCI_TRB_SIZE * ri, XHCI_TRB_SIZE * 1, 1656 BUS_DMASYNC_PREWRITE); 1657 xr->xr_cookies[ri] = cookie; 1658 ri++; 1659 } 1660 1661 i = 0; 1662 { 1663 parameter = trbs[i].trb_0; 1664 status = trbs[i].trb_2; 1665 control = trbs[i].trb_3; 1666 1667 if (xr->xr_cs) { 1668 control |= XHCI_TRB_3_CYCLE_BIT; 1669 } else { 1670 control &= ~XHCI_TRB_3_CYCLE_BIT; 1671 } 1672 1673 xhci_trb_put(&xr->xr_trb[xr->xr_ep], htole64(parameter), 1674 htole32(status), htole32(control)); 1675 usb_syncmem(&xr->xr_dma, XHCI_TRB_SIZE * ri, XHCI_TRB_SIZE * 1, 1676 BUS_DMASYNC_PREWRITE); 1677 xr->xr_cookies[xr->xr_ep] = cookie; 1678 } 1679 1680 xr->xr_ep = ri; 1681 xr->xr_cs = cs; 1682 1683 #if 0 1684 device_printf(sc->sc_dev, "%s %p xr_ep 0x%x xr_cs %u\n", __func__, 1685 xr, xr->xr_ep, xr->xr_cs); 1686 #endif 1687 } 1688 1689 static usbd_status 1690 xhci_do_command(struct xhci_softc * const sc, struct xhci_trb * const trb, 1691 int timeout) 1692 { 1693 struct xhci_ring * const cr = &sc->sc_cr; 1694 usbd_status err; 1695 1696 device_printf(sc->sc_dev, "%s input: " 1697 "0x%016"PRIx64" 0x%08"PRIx32" 0x%08"PRIx32"\n", __func__, 1698 trb->trb_0, trb->trb_2, trb->trb_3); 1699 1700 mutex_enter(&sc->sc_lock); 1701 1702 KASSERT(sc->sc_command_addr == 0); 1703 sc->sc_command_addr = xhci_ring_trbp(cr, cr->xr_ep); 1704 1705 mutex_enter(&cr->xr_lock); 1706 xhci_ring_put(sc, cr, NULL, trb, 1); 1707 mutex_exit(&cr->xr_lock); 1708 1709 xhci_db_write_4(sc, XHCI_DOORBELL(0), 0); 1710 1711 if (cv_timedwait(&sc->sc_command_cv, &sc->sc_lock, 1712 MAX(1, mstohz(timeout))) == EWOULDBLOCK) { 1713 err = USBD_TIMEOUT; 1714 goto timedout; 1715 } 1716 1717 trb->trb_0 = sc->sc_result_trb.trb_0; 1718 trb->trb_2 = sc->sc_result_trb.trb_2; 1719 trb->trb_3 = sc->sc_result_trb.trb_3; 1720 1721 device_printf(sc->sc_dev, "%s output: " 1722 "0x%016"PRIx64" 0x%08"PRIx32" 0x%08"PRIx32"\n", __func__, 1723 trb->trb_0, trb->trb_2, trb->trb_3); 1724 1725 switch (XHCI_TRB_2_ERROR_GET(trb->trb_2)) { 1726 case XHCI_TRB_ERROR_SUCCESS: 1727 err = USBD_NORMAL_COMPLETION; 1728 break; 1729 default: 1730 case 192 ... 223: 1731 err = USBD_IOERROR; 1732 break; 1733 case 224 ... 255: 1734 err = USBD_NORMAL_COMPLETION; 1735 break; 1736 } 1737 1738 timedout: 1739 sc->sc_command_addr = 0; 1740 mutex_exit(&sc->sc_lock); 1741 return err; 1742 } 1743 1744 static usbd_status 1745 xhci_enable_slot(struct xhci_softc * const sc, uint8_t * const slotp) 1746 { 1747 struct xhci_trb trb; 1748 usbd_status err; 1749 1750 trb.trb_0 = 0; 1751 trb.trb_2 = 0; 1752 trb.trb_3 = XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_ENABLE_SLOT); 1753 1754 err = xhci_do_command(sc, &trb, USBD_DEFAULT_TIMEOUT); 1755 if (err != USBD_NORMAL_COMPLETION) { 1756 return err; 1757 } 1758 1759 *slotp = XHCI_TRB_3_SLOT_GET(trb.trb_3); 1760 1761 return err; 1762 } 1763 1764 static usbd_status 1765 xhci_address_device(struct xhci_softc * const sc, 1766 uint64_t icp, uint8_t slot_id, bool bsr) 1767 { 1768 struct xhci_trb trb; 1769 usbd_status err; 1770 1771 trb.trb_0 = icp; 1772 trb.trb_2 = 0; 1773 trb.trb_3 = XHCI_TRB_3_SLOT_SET(slot_id) | 1774 XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_ADDRESS_DEVICE) | 1775 (bsr ? XHCI_TRB_3_BSR_BIT : 0); 1776 1777 err = xhci_do_command(sc, &trb, USBD_DEFAULT_TIMEOUT); 1778 return err; 1779 } 1780 1781 static usbd_status 1782 xhci_update_ep0_mps(struct xhci_softc * const sc, 1783 struct xhci_slot * const xs, u_int mps) 1784 { 1785 struct xhci_trb trb; 1786 usbd_status err; 1787 uint32_t * cp; 1788 1789 device_printf(sc->sc_dev, "%s\n", __func__); 1790 1791 cp = xhci_slot_get_icv(sc, xs, XHCI_ICI_INPUT_CONTROL); 1792 cp[0] = htole32(0); 1793 cp[1] = htole32(XHCI_INCTX_1_ADD_MASK(XHCI_DCI_EP_CONTROL)); 1794 1795 cp = xhci_slot_get_icv(sc, xs, xhci_dci_to_ici(XHCI_DCI_EP_CONTROL)); 1796 cp[1] = htole32(XHCI_EPCTX_1_MAXP_SIZE_SET(mps)); 1797 1798 /* sync input contexts before they are read from memory */ 1799 usb_syncmem(&xs->xs_ic_dma, 0, sc->sc_pgsz, BUS_DMASYNC_PREWRITE); 1800 hexdump("input context", xhci_slot_get_icv(sc, xs, 0), 1801 sc->sc_ctxsz * 4); 1802 1803 trb.trb_0 = xhci_slot_get_icp(sc, xs, 0); 1804 trb.trb_2 = 0; 1805 trb.trb_3 = XHCI_TRB_3_SLOT_SET(xs->xs_idx) | 1806 XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_EVALUATE_CTX); 1807 1808 err = xhci_do_command(sc, &trb, USBD_DEFAULT_TIMEOUT); 1809 KASSERT(err == USBD_NORMAL_COMPLETION); /* XXX */ 1810 return err; 1811 } 1812 1813 static void 1814 xhci_set_dcba(struct xhci_softc * const sc, uint64_t dcba, int si) 1815 { 1816 uint64_t * const dcbaa = KERNADDR(&sc->sc_dcbaa_dma, 0); 1817 1818 device_printf(sc->sc_dev, "dcbaa %p dc %016"PRIx64" slot %d\n", 1819 &dcbaa[si], dcba, si); 1820 1821 dcbaa[si] = htole64(dcba); 1822 usb_syncmem(&sc->sc_dcbaa_dma, si * sizeof(uint64_t), sizeof(uint64_t), 1823 BUS_DMASYNC_PREWRITE); 1824 } 1825 1826 static usbd_status 1827 xhci_init_slot(struct xhci_softc * const sc, uint32_t slot, int depth, 1828 int speed, int port, int rhport) 1829 { 1830 struct xhci_slot *xs; 1831 usbd_status err; 1832 u_int dci; 1833 uint32_t *cp; 1834 uint32_t mps; 1835 uint32_t xspeed; 1836 1837 switch (speed) { 1838 case USB_SPEED_LOW: 1839 xspeed = 2; 1840 mps = USB_MAX_IPACKET; 1841 break; 1842 case USB_SPEED_FULL: 1843 xspeed = 1; 1844 mps = 64; 1845 break; 1846 case USB_SPEED_HIGH: 1847 xspeed = 3; 1848 mps = USB_2_MAX_CTRL_PACKET; 1849 break; 1850 case USB_SPEED_SUPER: 1851 xspeed = 4; 1852 mps = USB_3_MAX_CTRL_PACKET; 1853 break; 1854 } 1855 1856 xs = &sc->sc_slots[slot]; 1857 xs->xs_idx = slot; 1858 1859 /* allocate contexts */ 1860 err = usb_allocmem(&sc->sc_bus, sc->sc_pgsz, sc->sc_pgsz, 1861 &xs->xs_dc_dma); 1862 if (err) 1863 return err; 1864 memset(KERNADDR(&xs->xs_dc_dma, 0), 0, sc->sc_pgsz); 1865 1866 err = usb_allocmem(&sc->sc_bus, sc->sc_pgsz, sc->sc_pgsz, 1867 &xs->xs_ic_dma); 1868 if (err) 1869 return err; 1870 memset(KERNADDR(&xs->xs_ic_dma, 0), 0, sc->sc_pgsz); 1871 1872 for (dci = 0; dci < 32; dci++) { 1873 //CTASSERT(sizeof(xs->xs_ep[dci]) == sizeof(struct xhci_endpoint)); 1874 memset(&xs->xs_ep[dci], 0, sizeof(xs->xs_ep[dci])); 1875 if (dci == XHCI_DCI_SLOT) 1876 continue; 1877 err = xhci_ring_init(sc, &xs->xs_ep[dci].xe_tr, 1878 XHCI_TRANSFER_RING_TRBS, XHCI_TRB_ALIGN); 1879 if (err) { 1880 device_printf(sc->sc_dev, "ring init failure\n"); 1881 return err; 1882 } 1883 } 1884 1885 /* set up initial input control context */ 1886 cp = xhci_slot_get_icv(sc, xs, XHCI_ICI_INPUT_CONTROL); 1887 cp[0] = htole32(0); 1888 cp[1] = htole32(XHCI_INCTX_1_ADD_MASK(XHCI_DCI_EP_CONTROL)| 1889 XHCI_INCTX_1_ADD_MASK(XHCI_DCI_SLOT)); 1890 1891 /* set up input slot context */ 1892 cp = xhci_slot_get_icv(sc, xs, xhci_dci_to_ici(XHCI_DCI_SLOT)); 1893 cp[0] = htole32( 1894 XHCI_SCTX_0_CTX_NUM_SET(1) | 1895 XHCI_SCTX_0_SPEED_SET(xspeed) 1896 ); 1897 cp[1] = htole32( 1898 XHCI_SCTX_1_RH_PORT_SET(rhport) 1899 ); 1900 cp[2] = htole32( 1901 XHCI_SCTX_2_IRQ_TARGET_SET(0) 1902 ); 1903 cp[3] = htole32(0); 1904 1905 /* set up input EP0 context */ 1906 cp = xhci_slot_get_icv(sc, xs, xhci_dci_to_ici(XHCI_DCI_EP_CONTROL)); 1907 cp[0] = htole32(0); 1908 cp[1] = htole32( 1909 XHCI_EPCTX_1_MAXP_SIZE_SET(mps) | 1910 XHCI_EPCTX_1_EPTYPE_SET(4) | 1911 XHCI_EPCTX_1_CERR_SET(3) 1912 ); 1913 /* can't use xhci_ep_get_dci() yet? */ 1914 *(uint64_t *)(&cp[2]) = htole64( 1915 xhci_ring_trbp(&xs->xs_ep[XHCI_DCI_EP_CONTROL].xe_tr, 0) | 1916 XHCI_EPCTX_2_DCS_SET(1)); 1917 cp[4] = htole32( 1918 XHCI_EPCTX_4_AVG_TRB_LEN_SET(8) 1919 ); 1920 1921 /* sync input contexts before they are read from memory */ 1922 usb_syncmem(&xs->xs_ic_dma, 0, sc->sc_pgsz, BUS_DMASYNC_PREWRITE); 1923 hexdump("input context", xhci_slot_get_icv(sc, xs, 0), 1924 sc->sc_ctxsz * 3); 1925 1926 xhci_set_dcba(sc, DMAADDR(&xs->xs_dc_dma, 0), slot); 1927 1928 err = xhci_address_device(sc, xhci_slot_get_icp(sc, xs, 0), slot, 1929 false); 1930 1931 usb_syncmem(&xs->xs_dc_dma, 0, sc->sc_pgsz, BUS_DMASYNC_POSTREAD); 1932 hexdump("output context", xhci_slot_get_dcv(sc, xs, 0), 1933 sc->sc_ctxsz * 2); 1934 1935 return err; 1936 } 1937 1938 /* ----- */ 1939 1940 static void 1941 xhci_noop(usbd_pipe_handle pipe) 1942 { 1943 DPRINTF(("%s\n", __func__)); 1944 } 1945 1946 /* root hub descriptors */ 1947 1948 static const usb_device_descriptor_t xhci_devd = { 1949 USB_DEVICE_DESCRIPTOR_SIZE, 1950 UDESC_DEVICE, /* type */ 1951 {0x00, 0x02}, /* USB version */ 1952 UDCLASS_HUB, /* class */ 1953 UDSUBCLASS_HUB, /* subclass */ 1954 UDPROTO_HSHUBSTT, /* protocol */ 1955 64, /* max packet */ 1956 {0},{0},{0x00,0x01}, /* device id */ 1957 1,2,0, /* string indexes */ 1958 1 /* # of configurations */ 1959 }; 1960 1961 static const usb_device_qualifier_t xhci_odevd = { 1962 USB_DEVICE_DESCRIPTOR_SIZE, 1963 UDESC_DEVICE_QUALIFIER, /* type */ 1964 {0x00, 0x02}, /* USB version */ 1965 UDCLASS_HUB, /* class */ 1966 UDSUBCLASS_HUB, /* subclass */ 1967 UDPROTO_FSHUB, /* protocol */ 1968 64, /* max packet */ 1969 1, /* # of configurations */ 1970 0 1971 }; 1972 1973 static const usb_config_descriptor_t xhci_confd = { 1974 USB_CONFIG_DESCRIPTOR_SIZE, 1975 UDESC_CONFIG, 1976 {USB_CONFIG_DESCRIPTOR_SIZE + 1977 USB_INTERFACE_DESCRIPTOR_SIZE + 1978 USB_ENDPOINT_DESCRIPTOR_SIZE}, 1979 1, 1980 1, 1981 0, 1982 UC_ATTR_MBO | UC_SELF_POWERED, 1983 0 /* max power */ 1984 }; 1985 1986 static const usb_interface_descriptor_t xhci_ifcd = { 1987 USB_INTERFACE_DESCRIPTOR_SIZE, 1988 UDESC_INTERFACE, 1989 0, 1990 0, 1991 1, 1992 UICLASS_HUB, 1993 UISUBCLASS_HUB, 1994 UIPROTO_HSHUBSTT, 1995 0 1996 }; 1997 1998 static const usb_endpoint_descriptor_t xhci_endpd = { 1999 USB_ENDPOINT_DESCRIPTOR_SIZE, 2000 UDESC_ENDPOINT, 2001 UE_DIR_IN | XHCI_INTR_ENDPT, 2002 UE_INTERRUPT, 2003 {8, 0}, /* max packet */ 2004 12 2005 }; 2006 2007 static const usb_hub_descriptor_t xhci_hubd = { 2008 USB_HUB_DESCRIPTOR_SIZE, 2009 UDESC_HUB, 2010 0, 2011 {0,0}, 2012 0, 2013 0, 2014 {""}, 2015 {""}, 2016 }; 2017 2018 /* root hub control */ 2019 2020 static usbd_status 2021 xhci_root_ctrl_transfer(usbd_xfer_handle xfer) 2022 { 2023 struct xhci_softc * const sc = xfer->pipe->device->bus->hci_private; 2024 usbd_status err; 2025 2026 DPRINTF(("%s\n", __func__)); 2027 2028 /* Insert last in queue. */ 2029 mutex_enter(&sc->sc_lock); 2030 err = usb_insert_transfer(xfer); 2031 mutex_exit(&sc->sc_lock); 2032 if (err) 2033 return err; 2034 2035 /* Pipe isn't running, start first */ 2036 return (xhci_root_ctrl_start(SIMPLEQ_FIRST(&xfer->pipe->queue))); 2037 } 2038 2039 static usbd_status 2040 xhci_root_ctrl_start(usbd_xfer_handle xfer) 2041 { 2042 struct xhci_softc * const sc = xfer->pipe->device->bus->hci_private; 2043 usb_port_status_t ps; 2044 usb_device_request_t *req; 2045 void *buf = NULL; 2046 usb_hub_descriptor_t hubd; 2047 usbd_status err; 2048 int len, value, index; 2049 int l, totlen = 0; 2050 int port, i; 2051 uint32_t v; 2052 2053 DPRINTF(("%s\n", __func__)); 2054 2055 if (sc->sc_dying) 2056 return USBD_IOERROR; 2057 2058 req = &xfer->request; 2059 2060 value = UGETW(req->wValue); 2061 index = UGETW(req->wIndex); 2062 len = UGETW(req->wLength); 2063 2064 if (len != 0) 2065 buf = KERNADDR(&xfer->dmabuf, 0); 2066 2067 DPRINTF(("root req: %02x %02x %04x %04x %04x\n", req->bmRequestType, 2068 req->bRequest, value, index, len)); 2069 2070 #define C(x,y) ((x) | ((y) << 8)) 2071 switch(C(req->bRequest, req->bmRequestType)) { 2072 case C(UR_CLEAR_FEATURE, UT_WRITE_DEVICE): 2073 case C(UR_CLEAR_FEATURE, UT_WRITE_INTERFACE): 2074 case C(UR_CLEAR_FEATURE, UT_WRITE_ENDPOINT): 2075 /* 2076 * DEVICE_REMOTE_WAKEUP and ENDPOINT_HALT are no-ops 2077 * for the integrated root hub. 2078 */ 2079 break; 2080 case C(UR_GET_CONFIG, UT_READ_DEVICE): 2081 if (len > 0) { 2082 *(uint8_t *)buf = sc->sc_conf; 2083 totlen = 1; 2084 } 2085 break; 2086 case C(UR_GET_DESCRIPTOR, UT_READ_DEVICE): 2087 DPRINTFN(8,("xhci_root_ctrl_start: wValue=0x%04x\n", value)); 2088 if (len == 0) 2089 break; 2090 switch(value >> 8) { 2091 case UDESC_DEVICE: 2092 if ((value & 0xff) != 0) { 2093 err = USBD_IOERROR; 2094 goto ret; 2095 } 2096 totlen = l = min(len, USB_DEVICE_DESCRIPTOR_SIZE); 2097 memcpy(buf, &xhci_devd, l); 2098 break; 2099 case UDESC_DEVICE_QUALIFIER: 2100 if ((value & 0xff) != 0) { 2101 } 2102 totlen = l = min(len, USB_DEVICE_DESCRIPTOR_SIZE); 2103 memcpy(buf, &xhci_odevd, l); 2104 break; 2105 case UDESC_OTHER_SPEED_CONFIGURATION: 2106 case UDESC_CONFIG: 2107 if ((value & 0xff) != 0) { 2108 err = USBD_IOERROR; 2109 goto ret; 2110 } 2111 totlen = l = min(len, USB_CONFIG_DESCRIPTOR_SIZE); 2112 memcpy(buf, &xhci_confd, l); 2113 ((usb_config_descriptor_t *)buf)->bDescriptorType = 2114 value >> 8; 2115 buf = (char *)buf + l; 2116 len -= l; 2117 l = min(len, USB_INTERFACE_DESCRIPTOR_SIZE); 2118 totlen += l; 2119 memcpy(buf, &xhci_ifcd, l); 2120 buf = (char *)buf + l; 2121 len -= l; 2122 l = min(len, USB_ENDPOINT_DESCRIPTOR_SIZE); 2123 totlen += l; 2124 memcpy(buf, &xhci_endpd, l); 2125 break; 2126 case UDESC_STRING: 2127 #define sd ((usb_string_descriptor_t *)buf) 2128 switch (value & 0xff) { 2129 case 0: /* Language table */ 2130 totlen = usb_makelangtbl(sd, len); 2131 break; 2132 case 1: /* Vendor */ 2133 totlen = usb_makestrdesc(sd, len, "NetBSD"); 2134 break; 2135 case 2: /* Product */ 2136 totlen = usb_makestrdesc(sd, len, 2137 "xHCI Root Hub"); 2138 break; 2139 } 2140 #undef sd 2141 break; 2142 default: 2143 err = USBD_IOERROR; 2144 goto ret; 2145 } 2146 break; 2147 case C(UR_GET_INTERFACE, UT_READ_INTERFACE): 2148 if (len > 0) { 2149 *(uint8_t *)buf = 0; 2150 totlen = 1; 2151 } 2152 break; 2153 case C(UR_GET_STATUS, UT_READ_DEVICE): 2154 if (len > 1) { 2155 USETW(((usb_status_t *)buf)->wStatus,UDS_SELF_POWERED); 2156 totlen = 2; 2157 } 2158 break; 2159 case C(UR_GET_STATUS, UT_READ_INTERFACE): 2160 case C(UR_GET_STATUS, UT_READ_ENDPOINT): 2161 if (len > 1) { 2162 USETW(((usb_status_t *)buf)->wStatus, 0); 2163 totlen = 2; 2164 } 2165 break; 2166 case C(UR_SET_ADDRESS, UT_WRITE_DEVICE): 2167 if (value >= USB_MAX_DEVICES) { 2168 err = USBD_IOERROR; 2169 goto ret; 2170 } 2171 //sc->sc_addr = value; 2172 break; 2173 case C(UR_SET_CONFIG, UT_WRITE_DEVICE): 2174 if (value != 0 && value != 1) { 2175 err = USBD_IOERROR; 2176 goto ret; 2177 } 2178 sc->sc_conf = value; 2179 break; 2180 case C(UR_SET_DESCRIPTOR, UT_WRITE_DEVICE): 2181 break; 2182 case C(UR_SET_FEATURE, UT_WRITE_DEVICE): 2183 case C(UR_SET_FEATURE, UT_WRITE_INTERFACE): 2184 case C(UR_SET_FEATURE, UT_WRITE_ENDPOINT): 2185 err = USBD_IOERROR; 2186 goto ret; 2187 case C(UR_SET_INTERFACE, UT_WRITE_INTERFACE): 2188 break; 2189 case C(UR_SYNCH_FRAME, UT_WRITE_ENDPOINT): 2190 break; 2191 /* Hub requests */ 2192 case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_DEVICE): 2193 break; 2194 case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_OTHER): 2195 DPRINTFN(4, ("xhci_root_ctrl_start: UR_CLEAR_PORT_FEATURE " 2196 "port=%d feature=%d\n", 2197 index, value)); 2198 if (index < 1 || index > sc->sc_hs_port_count) { 2199 err = USBD_IOERROR; 2200 goto ret; 2201 } 2202 port = XHCI_PORTSC(sc->sc_hs_port_start - 1 + index); 2203 v = xhci_op_read_4(sc, port); 2204 DPRINTFN(4, ("xhci_root_ctrl_start: portsc=0x%08x\n", v)); 2205 v &= ~XHCI_PS_CLEAR; 2206 switch (value) { 2207 case UHF_PORT_ENABLE: 2208 xhci_op_write_4(sc, port, v &~ XHCI_PS_PED); 2209 break; 2210 case UHF_PORT_SUSPEND: 2211 err = USBD_IOERROR; 2212 goto ret; 2213 case UHF_PORT_POWER: 2214 break; 2215 case UHF_PORT_TEST: 2216 case UHF_PORT_INDICATOR: 2217 err = USBD_IOERROR; 2218 goto ret; 2219 case UHF_C_PORT_CONNECTION: 2220 xhci_op_write_4(sc, port, v | XHCI_PS_CSC); 2221 break; 2222 case UHF_C_PORT_ENABLE: 2223 case UHF_C_PORT_SUSPEND: 2224 case UHF_C_PORT_OVER_CURRENT: 2225 err = USBD_IOERROR; 2226 goto ret; 2227 case UHF_C_PORT_RESET: 2228 xhci_op_write_4(sc, port, v | XHCI_PS_PRC); 2229 break; 2230 default: 2231 err = USBD_IOERROR; 2232 goto ret; 2233 } 2234 2235 break; 2236 case C(UR_GET_DESCRIPTOR, UT_READ_CLASS_DEVICE): 2237 if (len == 0) 2238 break; 2239 if ((value & 0xff) != 0) { 2240 err = USBD_IOERROR; 2241 goto ret; 2242 } 2243 hubd = xhci_hubd; 2244 hubd.bNbrPorts = sc->sc_hs_port_count; 2245 USETW(hubd.wHubCharacteristics, UHD_PWR_NO_SWITCH); 2246 hubd.bPwrOn2PwrGood = 200; 2247 for (i = 0, l = sc->sc_maxports; l > 0; i++, l -= 8) 2248 hubd.DeviceRemovable[i++] = 0; /* XXX can't find out? */ 2249 hubd.bDescLength = USB_HUB_DESCRIPTOR_SIZE + i; 2250 l = min(len, hubd.bDescLength); 2251 totlen = l; 2252 memcpy(buf, &hubd, l); 2253 break; 2254 case C(UR_GET_STATUS, UT_READ_CLASS_DEVICE): 2255 if (len != 4) { 2256 err = USBD_IOERROR; 2257 goto ret; 2258 } 2259 memset(buf, 0, len); /* ? XXX */ 2260 totlen = len; 2261 break; 2262 case C(UR_GET_STATUS, UT_READ_CLASS_OTHER): 2263 DPRINTFN(8,("xhci_root_ctrl_start: get port status i=%d\n", 2264 index)); 2265 if (index < 1 || index > sc->sc_maxports) { 2266 err = USBD_IOERROR; 2267 goto ret; 2268 } 2269 if (len != 4) { 2270 err = USBD_IOERROR; 2271 goto ret; 2272 } 2273 v = xhci_op_read_4(sc, XHCI_PORTSC(sc->sc_hs_port_start - 1 + 2274 index)); 2275 DPRINTF(("%s READ_CLASS_OTHER GET_STATUS PORTSC %d (%d) %08x\n", 2276 __func__, index, sc->sc_hs_port_start - 1 + index, v)); 2277 switch (XHCI_PS_SPEED_GET(v)) { 2278 case 1: 2279 i = UPS_FULL_SPEED; 2280 break; 2281 case 2: 2282 i = UPS_LOW_SPEED; 2283 break; 2284 case 3: 2285 i = UPS_HIGH_SPEED; 2286 break; 2287 default: 2288 i = 0; 2289 break; 2290 } 2291 if (v & XHCI_PS_CCS) i |= UPS_CURRENT_CONNECT_STATUS; 2292 if (v & XHCI_PS_PED) i |= UPS_PORT_ENABLED; 2293 if (v & XHCI_PS_OCA) i |= UPS_OVERCURRENT_INDICATOR; 2294 //if (v & XHCI_PS_SUSP) i |= UPS_SUSPEND; 2295 if (v & XHCI_PS_PR) i |= UPS_RESET; 2296 if (v & XHCI_PS_PP) i |= UPS_PORT_POWER; 2297 USETW(ps.wPortStatus, i); 2298 i = 0; 2299 if (v & XHCI_PS_CSC) i |= UPS_C_CONNECT_STATUS; 2300 if (v & XHCI_PS_PEC) i |= UPS_C_PORT_ENABLED; 2301 if (v & XHCI_PS_OCC) i |= UPS_C_OVERCURRENT_INDICATOR; 2302 if (v & XHCI_PS_PRC) i |= UPS_C_PORT_RESET; 2303 USETW(ps.wPortChange, i); 2304 l = min(len, sizeof ps); 2305 memcpy(buf, &ps, l); 2306 totlen = l; 2307 break; 2308 case C(UR_SET_DESCRIPTOR, UT_WRITE_CLASS_DEVICE): 2309 err = USBD_IOERROR; 2310 goto ret; 2311 case C(UR_SET_FEATURE, UT_WRITE_CLASS_DEVICE): 2312 break; 2313 case C(UR_SET_FEATURE, UT_WRITE_CLASS_OTHER): 2314 if (index < 1 || index > sc->sc_hs_port_count) { 2315 err = USBD_IOERROR; 2316 goto ret; 2317 } 2318 port = XHCI_PORTSC(sc->sc_hs_port_start - 1 + index); 2319 v = xhci_op_read_4(sc, port); 2320 DPRINTFN(4, ("xhci_root_ctrl_start: portsc=0x%08x\n", v)); 2321 v &= ~XHCI_PS_CLEAR; 2322 switch (value) { 2323 case UHF_PORT_ENABLE: 2324 xhci_op_write_4(sc, port, v | XHCI_PS_PED); 2325 break; 2326 case UHF_PORT_SUSPEND: 2327 /* XXX suspend */ 2328 break; 2329 case UHF_PORT_RESET: 2330 v &= ~ (XHCI_PS_PED | XHCI_PS_PR); 2331 xhci_op_write_4(sc, port, v | XHCI_PS_PR); 2332 /* Wait for reset to complete. */ 2333 usb_delay_ms(&sc->sc_bus, USB_PORT_ROOT_RESET_DELAY); 2334 if (sc->sc_dying) { 2335 err = USBD_IOERROR; 2336 goto ret; 2337 } 2338 v = xhci_op_read_4(sc, port); 2339 if (v & XHCI_PS_PR) { 2340 xhci_op_write_4(sc, port, v & ~XHCI_PS_PR); 2341 usb_delay_ms(&sc->sc_bus, 10); 2342 /* XXX */ 2343 } 2344 break; 2345 case UHF_PORT_POWER: 2346 /* XXX power control */ 2347 break; 2348 /* XXX more */ 2349 case UHF_C_PORT_RESET: 2350 xhci_op_write_4(sc, port, v | XHCI_PS_PRC); 2351 break; 2352 default: 2353 err = USBD_IOERROR; 2354 goto ret; 2355 } 2356 break; 2357 case C(UR_CLEAR_TT_BUFFER, UT_WRITE_CLASS_OTHER): 2358 case C(UR_RESET_TT, UT_WRITE_CLASS_OTHER): 2359 case C(UR_GET_TT_STATE, UT_READ_CLASS_OTHER): 2360 case C(UR_STOP_TT, UT_WRITE_CLASS_OTHER): 2361 break; 2362 default: 2363 err = USBD_IOERROR; 2364 goto ret; 2365 } 2366 xfer->actlen = totlen; 2367 err = USBD_NORMAL_COMPLETION; 2368 ret: 2369 xfer->status = err; 2370 mutex_enter(&sc->sc_lock); 2371 usb_transfer_complete(xfer); 2372 mutex_exit(&sc->sc_lock); 2373 return USBD_IN_PROGRESS; 2374 } 2375 2376 2377 static void 2378 xhci_root_ctrl_abort(usbd_xfer_handle xfer) 2379 { 2380 /* Nothing to do, all transfers are synchronous. */ 2381 } 2382 2383 2384 static void 2385 xhci_root_ctrl_close(usbd_pipe_handle pipe) 2386 { 2387 DPRINTF(("%s\n", __func__)); 2388 /* Nothing to do. */ 2389 } 2390 2391 static void 2392 xhci_root_ctrl_done(usbd_xfer_handle xfer) 2393 { 2394 xfer->hcpriv = NULL; 2395 } 2396 2397 /* root hub intrerrupt */ 2398 2399 static usbd_status 2400 xhci_root_intr_transfer(usbd_xfer_handle xfer) 2401 { 2402 struct xhci_softc * const sc = xfer->pipe->device->bus->hci_private; 2403 usbd_status err; 2404 2405 /* Insert last in queue. */ 2406 mutex_enter(&sc->sc_lock); 2407 err = usb_insert_transfer(xfer); 2408 mutex_exit(&sc->sc_lock); 2409 if (err) 2410 return err; 2411 2412 /* Pipe isn't running, start first */ 2413 return (xhci_root_intr_start(SIMPLEQ_FIRST(&xfer->pipe->queue))); 2414 } 2415 2416 static usbd_status 2417 xhci_root_intr_start(usbd_xfer_handle xfer) 2418 { 2419 struct xhci_softc * const sc = xfer->pipe->device->bus->hci_private; 2420 2421 if (sc->sc_dying) 2422 return USBD_IOERROR; 2423 2424 mutex_enter(&sc->sc_lock); 2425 sc->sc_intrxfer = xfer; 2426 mutex_exit(&sc->sc_lock); 2427 2428 return USBD_IN_PROGRESS; 2429 } 2430 2431 static void 2432 xhci_root_intr_abort(usbd_xfer_handle xfer) 2433 { 2434 #ifdef DIAGNOSTIC 2435 struct xhci_softc * const sc = xfer->pipe->device->bus->hci_private; 2436 #endif 2437 2438 KASSERT(mutex_owned(&sc->sc_lock)); 2439 if (xfer->pipe->intrxfer == xfer) { 2440 DPRINTF(("%s: remove\n", __func__)); 2441 xfer->pipe->intrxfer = NULL; 2442 } 2443 xfer->status = USBD_CANCELLED; 2444 usb_transfer_complete(xfer); 2445 } 2446 2447 static void 2448 xhci_root_intr_close(usbd_pipe_handle pipe) 2449 { 2450 struct xhci_softc * const sc = pipe->device->bus->hci_private; 2451 2452 KASSERT(mutex_owned(&sc->sc_lock)); 2453 2454 DPRINTF(("%s\n", __func__)); 2455 2456 sc->sc_intrxfer = NULL; 2457 } 2458 2459 static void 2460 xhci_root_intr_done(usbd_xfer_handle xfer) 2461 { 2462 xfer->hcpriv = NULL; 2463 } 2464 2465 /* -------------- */ 2466 /* device control */ 2467 2468 static usbd_status 2469 xhci_device_ctrl_transfer(usbd_xfer_handle xfer) 2470 { 2471 struct xhci_softc * const sc = xfer->pipe->device->bus->hci_private; 2472 usbd_status err; 2473 2474 /* Insert last in queue. */ 2475 mutex_enter(&sc->sc_lock); 2476 err = usb_insert_transfer(xfer); 2477 mutex_exit(&sc->sc_lock); 2478 if (err) 2479 return (err); 2480 2481 /* Pipe isn't running, start first */ 2482 return (xhci_device_ctrl_start(SIMPLEQ_FIRST(&xfer->pipe->queue))); 2483 } 2484 2485 static usbd_status 2486 xhci_device_ctrl_start(usbd_xfer_handle xfer) 2487 { 2488 struct xhci_softc * const sc = xfer->pipe->device->bus->hci_private; 2489 struct xhci_slot * const xs = xfer->pipe->device->hci_private; 2490 const u_int dci = xhci_ep_get_dci(xfer->pipe->endpoint->edesc); 2491 struct xhci_ring * const tr = &xs->xs_ep[dci].xe_tr; 2492 struct xhci_xfer * const xx = (void *)xfer; 2493 usb_device_request_t * const req = &xfer->request; 2494 const bool isread = UT_GET_DIR(req->bmRequestType) == UT_READ; 2495 const uint32_t len = UGETW(req->wLength); 2496 usb_dma_t * const dma = &xfer->dmabuf; 2497 uint64_t parameter; 2498 uint32_t status; 2499 uint32_t control; 2500 u_int i; 2501 2502 DPRINTF(("%s\n", __func__)); 2503 DPRINTF(("req: %02x %02x %04x %04x %04x\n", req->bmRequestType, 2504 req->bRequest, UGETW(req->wValue), UGETW(req->wIndex), 2505 UGETW(req->wLength))); 2506 2507 /* XXX */ 2508 if (tr->is_halted) { 2509 xhci_reset_endpoint(xfer->pipe); 2510 tr->is_halted = false; 2511 xhci_set_dequeue(xfer->pipe); 2512 } 2513 2514 /* we rely on the bottom bits for extra info */ 2515 KASSERT(((uintptr_t)xfer & 0x3) == 0x0); 2516 2517 KASSERT((xfer->rqflags & URQ_REQUEST) != 0); 2518 2519 i = 0; 2520 2521 /* setup phase */ 2522 memcpy(¶meter, req, sizeof(*req)); 2523 parameter = le64toh(parameter); 2524 status = XHCI_TRB_2_IRQ_SET(0) | XHCI_TRB_2_BYTES_SET(sizeof(*req)); 2525 control = ((len == 0) ? XHCI_TRB_3_TRT_NONE : 2526 (isread ? XHCI_TRB_3_TRT_IN : XHCI_TRB_3_TRT_OUT)) | 2527 XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_SETUP_STAGE) | 2528 XHCI_TRB_3_IDT_BIT; 2529 xhci_trb_put(&xx->xx_trb[i++], parameter, status, control); 2530 2531 if (len == 0) 2532 goto no_data; 2533 2534 /* data phase */ 2535 parameter = DMAADDR(dma, 0); 2536 KASSERT(len <= 0x10000); 2537 status = XHCI_TRB_2_IRQ_SET(0) | 2538 XHCI_TRB_2_TDSZ_SET(1) | 2539 XHCI_TRB_2_BYTES_SET(len); 2540 control = (isread ? XHCI_TRB_3_DIR_IN : 0) | 2541 XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_DATA_STAGE) | 2542 XHCI_TRB_3_CHAIN_BIT | XHCI_TRB_3_ENT_BIT; 2543 xhci_trb_put(&xx->xx_trb[i++], parameter, status, control); 2544 2545 parameter = (uintptr_t)xfer | 0x3; 2546 status = XHCI_TRB_2_IRQ_SET(0); 2547 control = XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_EVENT_DATA) | 2548 XHCI_TRB_3_IOC_BIT; 2549 xhci_trb_put(&xx->xx_trb[i++], parameter, status, control); 2550 2551 no_data: 2552 parameter = 0; 2553 status = XHCI_TRB_2_IRQ_SET(0) | XHCI_TRB_2_TDSZ_SET(1); 2554 /* the status stage has inverted direction */ 2555 control = (isread ? 0 : XHCI_TRB_3_DIR_IN) | 2556 XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_STATUS_STAGE) | 2557 XHCI_TRB_3_CHAIN_BIT | XHCI_TRB_3_ENT_BIT; 2558 xhci_trb_put(&xx->xx_trb[i++], parameter, status, control); 2559 2560 parameter = (uintptr_t)xfer | 0x0; 2561 status = XHCI_TRB_2_IRQ_SET(0); 2562 control = XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_EVENT_DATA) | 2563 XHCI_TRB_3_IOC_BIT; 2564 xhci_trb_put(&xx->xx_trb[i++], parameter, status, control); 2565 2566 mutex_enter(&tr->xr_lock); 2567 xhci_ring_put(sc, tr, xfer, xx->xx_trb, i); 2568 mutex_exit(&tr->xr_lock); 2569 2570 xhci_db_write_4(sc, XHCI_DOORBELL(xs->xs_idx), dci); 2571 2572 if (xfer->timeout && !sc->sc_bus.use_polling) { 2573 callout_reset(&xfer->timeout_handle, mstohz(xfer->timeout), 2574 xhci_timeout, xfer); 2575 } 2576 2577 if (sc->sc_bus.use_polling) { 2578 device_printf(sc->sc_dev, "%s polling\n", __func__); 2579 //xhci_waitintr(sc, xfer); 2580 } 2581 2582 return USBD_IN_PROGRESS; 2583 } 2584 2585 static void 2586 xhci_device_ctrl_done(usbd_xfer_handle xfer) 2587 { 2588 DPRINTF(("%s\n", __func__)); 2589 2590 callout_stop(&xfer->timeout_handle); /* XXX wrong place */ 2591 2592 } 2593 2594 static void 2595 xhci_device_ctrl_abort(usbd_xfer_handle xfer) 2596 { 2597 DPRINTF(("%s\n", __func__)); 2598 } 2599 2600 static void 2601 xhci_device_ctrl_close(usbd_pipe_handle pipe) 2602 { 2603 DPRINTF(("%s\n", __func__)); 2604 } 2605 2606 /* ----------------- */ 2607 /* device isochronus */ 2608 2609 /* ----------- */ 2610 /* device bulk */ 2611 2612 static usbd_status 2613 xhci_device_bulk_transfer(usbd_xfer_handle xfer) 2614 { 2615 struct xhci_softc * const sc = xfer->pipe->device->bus->hci_private; 2616 usbd_status err; 2617 2618 /* Insert last in queue. */ 2619 mutex_enter(&sc->sc_lock); 2620 err = usb_insert_transfer(xfer); 2621 mutex_exit(&sc->sc_lock); 2622 if (err) 2623 return err; 2624 2625 /* 2626 * Pipe isn't running (otherwise err would be USBD_INPROG), 2627 * so start it first. 2628 */ 2629 return (xhci_device_bulk_start(SIMPLEQ_FIRST(&xfer->pipe->queue))); 2630 } 2631 2632 static usbd_status 2633 xhci_device_bulk_start(usbd_xfer_handle xfer) 2634 { 2635 struct xhci_softc * const sc = xfer->pipe->device->bus->hci_private; 2636 struct xhci_slot * const xs = xfer->pipe->device->hci_private; 2637 const u_int dci = xhci_ep_get_dci(xfer->pipe->endpoint->edesc); 2638 struct xhci_ring * const tr = &xs->xs_ep[dci].xe_tr; 2639 struct xhci_xfer * const xx = (void *)xfer; 2640 const uint32_t len = xfer->length; 2641 usb_dma_t * const dma = &xfer->dmabuf; 2642 uint64_t parameter; 2643 uint32_t status; 2644 uint32_t control; 2645 u_int i = 0; 2646 2647 #if 0 2648 device_printf(sc->sc_dev, "%s %p slot %u dci %u\n", __func__, xfer, 2649 xs->xs_idx, dci); 2650 #endif 2651 2652 if (sc->sc_dying) 2653 return USBD_IOERROR; 2654 2655 KASSERT((xfer->rqflags & URQ_REQUEST) == 0); 2656 2657 parameter = DMAADDR(dma, 0); 2658 KASSERT(len <= 0x10000); 2659 status = XHCI_TRB_2_IRQ_SET(0) | 2660 XHCI_TRB_2_TDSZ_SET(1) | 2661 XHCI_TRB_2_BYTES_SET(len); 2662 control = XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_NORMAL) | 2663 XHCI_TRB_3_ISP_BIT | XHCI_TRB_3_IOC_BIT; 2664 xhci_trb_put(&xx->xx_trb[i++], parameter, status, control); 2665 2666 mutex_enter(&tr->xr_lock); 2667 xhci_ring_put(sc, tr, xfer, xx->xx_trb, i); 2668 mutex_exit(&tr->xr_lock); 2669 2670 xhci_db_write_4(sc, XHCI_DOORBELL(xs->xs_idx), dci); 2671 2672 if (sc->sc_bus.use_polling) { 2673 device_printf(sc->sc_dev, "%s polling\n", __func__); 2674 //xhci_waitintr(sc, xfer); 2675 } 2676 2677 return USBD_IN_PROGRESS; 2678 } 2679 2680 static void 2681 xhci_device_bulk_done(usbd_xfer_handle xfer) 2682 { 2683 //struct xhci_softc * const sc = xfer->pipe->device->bus->hci_private; 2684 //struct xhci_slot * const xs = xfer->pipe->device->hci_private; 2685 //const u_int dci = xhci_ep_get_dci(xfer->pipe->endpoint->edesc); 2686 const u_int endpt = xfer->pipe->endpoint->edesc->bEndpointAddress; 2687 const bool isread = UE_GET_DIR(endpt) == UE_DIR_IN; 2688 2689 DPRINTF(("%s\n", __func__)); 2690 2691 #if 0 2692 device_printf(sc->sc_dev, "%s %p slot %u dci %u\n", __func__, xfer, 2693 xs->xs_idx, dci); 2694 #endif 2695 2696 callout_stop(&xfer->timeout_handle); /* XXX wrong place */ 2697 2698 usb_syncmem(&xfer->dmabuf, 0, xfer->length, 2699 isread ? BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE); 2700 2701 2702 } 2703 2704 static void 2705 xhci_device_bulk_abort(usbd_xfer_handle xfer) 2706 { 2707 DPRINTF(("%s\n", __func__)); 2708 } 2709 2710 static void 2711 xhci_device_bulk_close(usbd_pipe_handle pipe) 2712 { 2713 DPRINTF(("%s\n", __func__)); 2714 } 2715 2716 /* --------------- */ 2717 /* device intrrupt */ 2718 2719 static usbd_status 2720 xhci_device_intr_transfer(usbd_xfer_handle xfer) 2721 { 2722 struct xhci_softc * const sc = xfer->pipe->device->bus->hci_private; 2723 usbd_status err; 2724 2725 /* Insert last in queue. */ 2726 mutex_enter(&sc->sc_lock); 2727 err = usb_insert_transfer(xfer); 2728 mutex_exit(&sc->sc_lock); 2729 if (err) 2730 return err; 2731 2732 /* 2733 * Pipe isn't running (otherwise err would be USBD_INPROG), 2734 * so start it first. 2735 */ 2736 return (xhci_device_intr_start(SIMPLEQ_FIRST(&xfer->pipe->queue))); 2737 } 2738 2739 static usbd_status 2740 xhci_device_intr_start(usbd_xfer_handle xfer) 2741 { 2742 struct xhci_softc * const sc = xfer->pipe->device->bus->hci_private; 2743 struct xhci_slot * const xs = xfer->pipe->device->hci_private; 2744 const u_int dci = xhci_ep_get_dci(xfer->pipe->endpoint->edesc); 2745 struct xhci_ring * const tr = &xs->xs_ep[dci].xe_tr; 2746 struct xhci_xfer * const xx = (void *)xfer; 2747 const uint32_t len = xfer->length; 2748 usb_dma_t * const dma = &xfer->dmabuf; 2749 uint64_t parameter; 2750 uint32_t status; 2751 uint32_t control; 2752 u_int i = 0; 2753 2754 #if 0 2755 device_printf(sc->sc_dev, "%s %p slot %u dci %u\n", __func__, xfer, 2756 xs->xs_idx, dci); 2757 #endif 2758 2759 if (sc->sc_dying) 2760 return USBD_IOERROR; 2761 2762 KASSERT((xfer->rqflags & URQ_REQUEST) == 0); 2763 2764 parameter = DMAADDR(dma, 0); 2765 KASSERT(len <= 0x10000); 2766 status = XHCI_TRB_2_IRQ_SET(0) | 2767 XHCI_TRB_2_TDSZ_SET(1) | 2768 XHCI_TRB_2_BYTES_SET(len); 2769 control = XHCI_TRB_3_TYPE_SET(XHCI_TRB_TYPE_NORMAL) | 2770 XHCI_TRB_3_ISP_BIT | XHCI_TRB_3_IOC_BIT; 2771 xhci_trb_put(&xx->xx_trb[i++], parameter, status, control); 2772 2773 mutex_enter(&tr->xr_lock); 2774 xhci_ring_put(sc, tr, xfer, xx->xx_trb, i); 2775 mutex_exit(&tr->xr_lock); 2776 2777 xhci_db_write_4(sc, XHCI_DOORBELL(xs->xs_idx), dci); 2778 2779 if (sc->sc_bus.use_polling) { 2780 device_printf(sc->sc_dev, "%s polling\n", __func__); 2781 //xhci_waitintr(sc, xfer); 2782 } 2783 2784 return USBD_IN_PROGRESS; 2785 } 2786 2787 static void 2788 xhci_device_intr_done(usbd_xfer_handle xfer) 2789 { 2790 struct xhci_softc * const sc = xfer->pipe->device->bus->hci_private; 2791 struct xhci_slot * const xs = xfer->pipe->device->hci_private; 2792 const u_int dci = xhci_ep_get_dci(xfer->pipe->endpoint->edesc); 2793 const u_int endpt = xfer->pipe->endpoint->edesc->bEndpointAddress; 2794 const bool isread = UE_GET_DIR(endpt) == UE_DIR_IN; 2795 DPRINTF(("%s\n", __func__)); 2796 2797 device_printf(sc->sc_dev, "%s %p slot %u dci %u\n", __func__, xfer, 2798 xs->xs_idx, dci); 2799 2800 KASSERT(sc->sc_bus.use_polling || mutex_owned(&sc->sc_lock)); 2801 2802 usb_syncmem(&xfer->dmabuf, 0, xfer->length, 2803 isread ? BUS_DMASYNC_POSTREAD : BUS_DMASYNC_POSTWRITE); 2804 2805 #if 0 2806 device_printf(sc->sc_dev, ""); 2807 for (size_t i = 0; i < xfer->length; i++) { 2808 printf(" %02x", ((uint8_t const *)xfer->buffer)[i]); 2809 } 2810 printf("\n"); 2811 #endif 2812 2813 if (xfer->pipe->repeat) { 2814 xfer->status = xhci_device_intr_start(xfer); 2815 } else { 2816 callout_stop(&xfer->timeout_handle); /* XXX */ 2817 } 2818 2819 } 2820 2821 static void 2822 xhci_device_intr_abort(usbd_xfer_handle xfer) 2823 { 2824 struct xhci_softc * const sc = xfer->pipe->device->bus->hci_private; 2825 DPRINTF(("%s\n", __func__)); 2826 device_printf(sc->sc_dev, "%s %p\n", __func__, xfer); 2827 /* XXX */ 2828 if (xfer->pipe->intrxfer == xfer) { 2829 xfer->pipe->intrxfer = NULL; 2830 } 2831 xfer->status = USBD_CANCELLED; 2832 mutex_enter(&sc->sc_lock); 2833 usb_transfer_complete(xfer); 2834 mutex_exit(&sc->sc_lock); 2835 } 2836 2837 static void 2838 xhci_device_intr_close(usbd_pipe_handle pipe) 2839 { 2840 struct xhci_softc * const sc = pipe->device->bus->hci_private; 2841 DPRINTF(("%s\n", __func__)); 2842 device_printf(sc->sc_dev, "%s %p\n", __func__, pipe); 2843 xhci_unconfigure_endpoint(pipe); 2844 } 2845 2846 /* ------------ */ 2847 2848 static void 2849 xhci_timeout(void *addr) 2850 { 2851 struct xhci_xfer * const xx = addr; 2852 usbd_xfer_handle const xfer = &xx->xx_xfer; 2853 struct xhci_softc * const sc = xfer->pipe->device->bus->hci_private; 2854 2855 if (sc->sc_dying) { 2856 return; 2857 } 2858 2859 usb_init_task(&xx->xx_abort_task, xhci_timeout_task, addr, 2860 USB_TASKQ_MPSAFE); 2861 usb_add_task(xx->xx_xfer.pipe->device, &xx->xx_abort_task, 2862 USB_TASKQ_HC); 2863 } 2864 2865 static void 2866 xhci_timeout_task(void *addr) 2867 { 2868 usbd_xfer_handle const xfer = addr; 2869 struct xhci_softc * const sc = xfer->pipe->device->bus->hci_private; 2870 2871 mutex_enter(&sc->sc_lock); 2872 #if 0 2873 xhci_abort_xfer(xfer, USBD_TIMEOUT); 2874 #else 2875 xfer->status = USBD_TIMEOUT; 2876 usb_transfer_complete(xfer); 2877 #endif 2878 mutex_exit(&sc->sc_lock); 2879 } 2880
Indexes created Tue Sep 23 14:10:03 GMT 2025