1 /* $FreeBSD$ */ 2 /*- 3 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD 4 * 5 * Copyright (c) 2008 Hans Petter Selasky. All rights reserved. 6 * Copyright (c) 1998 The NetBSD Foundation, Inc. All rights reserved. 7 * Copyright (c) 1998 Lennart Augustsson. All rights reserved. 8 * 9 * Redistribution and use in source and binary forms, with or without 10 * modification, are permitted provided that the following conditions 11 * are met: 12 * 1. Redistributions of source code must retain the above copyright 13 * notice, this list of conditions and the following disclaimer. 14 * 2. Redistributions in binary form must reproduce the above copyright 15 * notice, this list of conditions and the following disclaimer in the 16 * documentation and/or other materials provided with the distribution. 17 * 18 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 19 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 20 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 21 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 22 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 23 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 24 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 25 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 26 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 27 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 28 * SUCH DAMAGE. 29 */ 30 31 /* 32 * USB Open Host Controller driver. 33 * 34 * OHCI spec: http://www.compaq.com/productinfo/development/openhci.html 35 * USB spec: http://www.usb.org/developers/docs/usbspec.zip 36 */ 37 38 #ifdef USB_GLOBAL_INCLUDE_FILE 39 #include USB_GLOBAL_INCLUDE_FILE 40 #else 41 #include <sys/stdint.h> 42 #include <sys/stddef.h> 43 #include <sys/param.h> 44 #include <sys/queue.h> 45 #include <sys/types.h> 46 #include <sys/systm.h> 47 #include <sys/kernel.h> 48 #include <sys/bus.h> 49 #include <sys/module.h> 50 #include <sys/lock.h> 51 #include <sys/mutex.h> 52 #include <sys/condvar.h> 53 #include <sys/sysctl.h> 54 #include <sys/sx.h> 55 #include <sys/unistd.h> 56 #include <sys/callout.h> 57 #include <sys/malloc.h> 58 #include <sys/priv.h> 59 60 #include <dev/usb/usb.h> 61 #include <dev/usb/usbdi.h> 62 63 #define USB_DEBUG_VAR ohcidebug 64 65 #include <dev/usb/usb_core.h> 66 #include <dev/usb/usb_debug.h> 67 #include <dev/usb/usb_busdma.h> 68 #include <dev/usb/usb_process.h> 69 #include <dev/usb/usb_transfer.h> 70 #include <dev/usb/usb_device.h> 71 #include <dev/usb/usb_hub.h> 72 #include <dev/usb/usb_util.h> 73 74 #include <dev/usb/usb_controller.h> 75 #include <dev/usb/usb_bus.h> 76 #endif /* USB_GLOBAL_INCLUDE_FILE */ 77 78 #include <dev/usb/controller/ohci.h> 79 #include <dev/usb/controller/ohcireg.h> 80 81 #define OHCI_BUS2SC(bus) \ 82 __containerof(bus, ohci_softc_t, sc_bus) 83 84 #ifdef USB_DEBUG 85 static int ohcidebug = 0; 86 87 static SYSCTL_NODE(_hw_usb, OID_AUTO, ohci, CTLFLAG_RW | CTLFLAG_MPSAFE, 0, 88 "USB ohci"); 89 SYSCTL_INT(_hw_usb_ohci, OID_AUTO, debug, CTLFLAG_RWTUN, 90 &ohcidebug, 0, "ohci debug level"); 91 92 static void ohci_dumpregs(ohci_softc_t *); 93 static void ohci_dump_tds(ohci_td_t *); 94 static uint8_t ohci_dump_td(ohci_td_t *); 95 static void ohci_dump_ed(ohci_ed_t *); 96 static uint8_t ohci_dump_itd(ohci_itd_t *); 97 static void ohci_dump_itds(ohci_itd_t *); 98 99 #endif 100 101 #define OBARR(sc) bus_space_barrier((sc)->sc_io_tag, (sc)->sc_io_hdl, 0, (sc)->sc_io_size, \ 102 BUS_SPACE_BARRIER_READ|BUS_SPACE_BARRIER_WRITE) 103 #define OWRITE1(sc, r, x) \ 104 do { OBARR(sc); bus_space_write_1((sc)->sc_io_tag, (sc)->sc_io_hdl, (r), (x)); } while (0) 105 #define OWRITE2(sc, r, x) \ 106 do { OBARR(sc); bus_space_write_2((sc)->sc_io_tag, (sc)->sc_io_hdl, (r), (x)); } while (0) 107 #define OWRITE4(sc, r, x) \ 108 do { OBARR(sc); bus_space_write_4((sc)->sc_io_tag, (sc)->sc_io_hdl, (r), (x)); } while (0) 109 #define OREAD1(sc, r) (OBARR(sc), bus_space_read_1((sc)->sc_io_tag, (sc)->sc_io_hdl, (r))) 110 #define OREAD2(sc, r) (OBARR(sc), bus_space_read_2((sc)->sc_io_tag, (sc)->sc_io_hdl, (r))) 111 #define OREAD4(sc, r) (OBARR(sc), bus_space_read_4((sc)->sc_io_tag, (sc)->sc_io_hdl, (r))) 112 113 #define OHCI_INTR_ENDPT 1 114 115 static const struct usb_bus_methods ohci_bus_methods; 116 static const struct usb_pipe_methods ohci_device_bulk_methods; 117 static const struct usb_pipe_methods ohci_device_ctrl_methods; 118 static const struct usb_pipe_methods ohci_device_intr_methods; 119 static const struct usb_pipe_methods ohci_device_isoc_methods; 120 121 static void ohci_do_poll(struct usb_bus *bus); 122 static void ohci_device_done(struct usb_xfer *xfer, usb_error_t error); 123 static void ohci_timeout(void *arg); 124 static uint8_t ohci_check_transfer(struct usb_xfer *xfer); 125 static void ohci_root_intr(ohci_softc_t *sc); 126 127 struct ohci_std_temp { 128 struct usb_page_cache *pc; 129 ohci_td_t *td; 130 ohci_td_t *td_next; 131 uint32_t average; 132 uint32_t td_flags; 133 uint32_t len; 134 uint16_t max_frame_size; 135 uint8_t shortpkt; 136 uint8_t setup_alt_next; 137 uint8_t last_frame; 138 }; 139 140 static struct ohci_hcca * 141 ohci_get_hcca(ohci_softc_t *sc) 142 { 143 usb_pc_cpu_invalidate(&sc->sc_hw.hcca_pc); 144 return (sc->sc_hcca_p); 145 } 146 147 void 148 ohci_iterate_hw_softc(struct usb_bus *bus, usb_bus_mem_sub_cb_t *cb) 149 { 150 struct ohci_softc *sc = OHCI_BUS2SC(bus); 151 uint32_t i; 152 153 cb(bus, &sc->sc_hw.hcca_pc, &sc->sc_hw.hcca_pg, 154 sizeof(ohci_hcca_t), OHCI_HCCA_ALIGN); 155 156 cb(bus, &sc->sc_hw.ctrl_start_pc, &sc->sc_hw.ctrl_start_pg, 157 sizeof(ohci_ed_t), OHCI_ED_ALIGN); 158 159 cb(bus, &sc->sc_hw.bulk_start_pc, &sc->sc_hw.bulk_start_pg, 160 sizeof(ohci_ed_t), OHCI_ED_ALIGN); 161 162 cb(bus, &sc->sc_hw.isoc_start_pc, &sc->sc_hw.isoc_start_pg, 163 sizeof(ohci_ed_t), OHCI_ED_ALIGN); 164 165 for (i = 0; i != OHCI_NO_EDS; i++) { 166 cb(bus, sc->sc_hw.intr_start_pc + i, sc->sc_hw.intr_start_pg + i, 167 sizeof(ohci_ed_t), OHCI_ED_ALIGN); 168 } 169 } 170 171 static usb_error_t 172 ohci_controller_init(ohci_softc_t *sc, int do_suspend) 173 { 174 struct usb_page_search buf_res; 175 uint32_t i; 176 uint32_t ctl; 177 uint32_t ival; 178 uint32_t hcr; 179 uint32_t fm; 180 uint32_t per; 181 uint32_t desca; 182 183 /* Determine in what context we are running. */ 184 ctl = OREAD4(sc, OHCI_CONTROL); 185 if (ctl & OHCI_IR) { 186 /* SMM active, request change */ 187 DPRINTF("SMM active, request owner change\n"); 188 OWRITE4(sc, OHCI_COMMAND_STATUS, OHCI_OCR); 189 for (i = 0; (i < 100) && (ctl & OHCI_IR); i++) { 190 usb_pause_mtx(NULL, hz / 1000); 191 ctl = OREAD4(sc, OHCI_CONTROL); 192 } 193 if (ctl & OHCI_IR) { 194 device_printf(sc->sc_bus.bdev, 195 "SMM does not respond, resetting\n"); 196 OWRITE4(sc, OHCI_CONTROL, OHCI_HCFS_RESET); 197 goto reset; 198 } 199 } else { 200 DPRINTF("cold started\n"); 201 reset: 202 /* controller was cold started */ 203 usb_pause_mtx(NULL, 204 USB_MS_TO_TICKS(USB_BUS_RESET_DELAY)); 205 } 206 207 /* 208 * This reset should not be necessary according to the OHCI spec, but 209 * without it some controllers do not start. 210 */ 211 DPRINTF("%s: resetting\n", device_get_nameunit(sc->sc_bus.bdev)); 212 OWRITE4(sc, OHCI_CONTROL, OHCI_HCFS_RESET); 213 214 usb_pause_mtx(NULL, 215 USB_MS_TO_TICKS(USB_BUS_RESET_DELAY)); 216 217 /* we now own the host controller and the bus has been reset */ 218 ival = OHCI_GET_IVAL(OREAD4(sc, OHCI_FM_INTERVAL)); 219 220 OWRITE4(sc, OHCI_COMMAND_STATUS, OHCI_HCR); /* Reset HC */ 221 /* nominal time for a reset is 10 us */ 222 for (i = 0; i < 10; i++) { 223 DELAY(10); 224 hcr = OREAD4(sc, OHCI_COMMAND_STATUS) & OHCI_HCR; 225 if (!hcr) { 226 break; 227 } 228 } 229 if (hcr) { 230 device_printf(sc->sc_bus.bdev, "reset timeout\n"); 231 return (USB_ERR_IOERROR); 232 } 233 #ifdef USB_DEBUG 234 if (ohcidebug > 15) { 235 ohci_dumpregs(sc); 236 } 237 #endif 238 239 if (do_suspend) { 240 OWRITE4(sc, OHCI_CONTROL, OHCI_HCFS_SUSPEND); 241 return (USB_ERR_NORMAL_COMPLETION); 242 } 243 244 /* The controller is now in SUSPEND state, we have 2ms to finish. */ 245 246 /* set up HC registers */ 247 usbd_get_page(&sc->sc_hw.hcca_pc, 0, &buf_res); 248 OWRITE4(sc, OHCI_HCCA, buf_res.physaddr); 249 250 usbd_get_page(&sc->sc_hw.ctrl_start_pc, 0, &buf_res); 251 OWRITE4(sc, OHCI_CONTROL_HEAD_ED, buf_res.physaddr); 252 253 usbd_get_page(&sc->sc_hw.bulk_start_pc, 0, &buf_res); 254 OWRITE4(sc, OHCI_BULK_HEAD_ED, buf_res.physaddr); 255 256 /* disable all interrupts and then switch on all desired interrupts */ 257 OWRITE4(sc, OHCI_INTERRUPT_DISABLE, OHCI_ALL_INTRS); 258 OWRITE4(sc, OHCI_INTERRUPT_ENABLE, sc->sc_eintrs | OHCI_MIE); 259 /* switch on desired functional features */ 260 ctl = OREAD4(sc, OHCI_CONTROL); 261 ctl &= ~(OHCI_CBSR_MASK | OHCI_LES | OHCI_HCFS_MASK | OHCI_IR); 262 ctl |= OHCI_PLE | OHCI_IE | OHCI_CLE | OHCI_BLE | 263 OHCI_RATIO_1_4 | OHCI_HCFS_OPERATIONAL; 264 /* And finally start it! */ 265 OWRITE4(sc, OHCI_CONTROL, ctl); 266 267 /* 268 * The controller is now OPERATIONAL. Set a some final 269 * registers that should be set earlier, but that the 270 * controller ignores when in the SUSPEND state. 271 */ 272 fm = (OREAD4(sc, OHCI_FM_INTERVAL) & OHCI_FIT) ^ OHCI_FIT; 273 fm |= OHCI_FSMPS(ival) | ival; 274 OWRITE4(sc, OHCI_FM_INTERVAL, fm); 275 per = OHCI_PERIODIC(ival); /* 90% periodic */ 276 OWRITE4(sc, OHCI_PERIODIC_START, per); 277 278 /* Fiddle the No OverCurrent Protection bit to avoid chip bug. */ 279 desca = OREAD4(sc, OHCI_RH_DESCRIPTOR_A); 280 OWRITE4(sc, OHCI_RH_DESCRIPTOR_A, desca | OHCI_NOCP); 281 OWRITE4(sc, OHCI_RH_STATUS, OHCI_LPSC); /* Enable port power */ 282 usb_pause_mtx(NULL, 283 USB_MS_TO_TICKS(OHCI_ENABLE_POWER_DELAY)); 284 OWRITE4(sc, OHCI_RH_DESCRIPTOR_A, desca); 285 286 /* 287 * The AMD756 requires a delay before re-reading the register, 288 * otherwise it will occasionally report 0 ports. 289 */ 290 sc->sc_noport = 0; 291 for (i = 0; (i < 10) && (sc->sc_noport == 0); i++) { 292 usb_pause_mtx(NULL, 293 USB_MS_TO_TICKS(OHCI_READ_DESC_DELAY)); 294 sc->sc_noport = OHCI_GET_NDP(OREAD4(sc, OHCI_RH_DESCRIPTOR_A)); 295 } 296 297 #ifdef USB_DEBUG 298 if (ohcidebug > 5) { 299 ohci_dumpregs(sc); 300 } 301 #endif 302 return (USB_ERR_NORMAL_COMPLETION); 303 } 304 305 static struct ohci_ed * 306 ohci_init_ed(struct usb_page_cache *pc) 307 { 308 struct usb_page_search buf_res; 309 struct ohci_ed *ed; 310 311 usbd_get_page(pc, 0, &buf_res); 312 313 ed = buf_res.buffer; 314 315 ed->ed_self = htole32(buf_res.physaddr); 316 ed->ed_flags = htole32(OHCI_ED_SKIP); 317 ed->page_cache = pc; 318 319 return (ed); 320 } 321 322 usb_error_t 323 ohci_init(ohci_softc_t *sc) 324 { 325 struct usb_page_search buf_res; 326 uint16_t i; 327 uint16_t bit; 328 uint16_t x; 329 uint16_t y; 330 331 DPRINTF("start\n"); 332 333 sc->sc_eintrs = OHCI_NORMAL_INTRS; 334 335 /* 336 * Setup all ED's 337 */ 338 339 sc->sc_ctrl_p_last = 340 ohci_init_ed(&sc->sc_hw.ctrl_start_pc); 341 342 sc->sc_bulk_p_last = 343 ohci_init_ed(&sc->sc_hw.bulk_start_pc); 344 345 sc->sc_isoc_p_last = 346 ohci_init_ed(&sc->sc_hw.isoc_start_pc); 347 348 for (i = 0; i != OHCI_NO_EDS; i++) { 349 sc->sc_intr_p_last[i] = 350 ohci_init_ed(sc->sc_hw.intr_start_pc + i); 351 } 352 353 /* 354 * the QHs are arranged to give poll intervals that are 355 * powers of 2 times 1ms 356 */ 357 bit = OHCI_NO_EDS / 2; 358 while (bit) { 359 x = bit; 360 while (x & bit) { 361 ohci_ed_t *ed_x; 362 ohci_ed_t *ed_y; 363 364 y = (x ^ bit) | (bit / 2); 365 366 /* 367 * the next QH has half the poll interval 368 */ 369 ed_x = sc->sc_intr_p_last[x]; 370 ed_y = sc->sc_intr_p_last[y]; 371 372 ed_x->next = NULL; 373 ed_x->ed_next = ed_y->ed_self; 374 375 x++; 376 } 377 bit >>= 1; 378 } 379 380 if (1) { 381 ohci_ed_t *ed_int; 382 ohci_ed_t *ed_isc; 383 384 ed_int = sc->sc_intr_p_last[0]; 385 ed_isc = sc->sc_isoc_p_last; 386 387 /* the last (1ms) QH */ 388 ed_int->next = ed_isc; 389 ed_int->ed_next = ed_isc->ed_self; 390 } 391 usbd_get_page(&sc->sc_hw.hcca_pc, 0, &buf_res); 392 393 sc->sc_hcca_p = buf_res.buffer; 394 395 /* 396 * Fill HCCA interrupt table. The bit reversal is to get 397 * the tree set up properly to spread the interrupts. 398 */ 399 for (i = 0; i != OHCI_NO_INTRS; i++) { 400 sc->sc_hcca_p->hcca_interrupt_table[i] = 401 sc->sc_intr_p_last[i | (OHCI_NO_EDS / 2)]->ed_self; 402 } 403 /* flush all cache into memory */ 404 405 usb_bus_mem_flush_all(&sc->sc_bus, &ohci_iterate_hw_softc); 406 407 /* set up the bus struct */ 408 sc->sc_bus.methods = &ohci_bus_methods; 409 410 usb_callout_init_mtx(&sc->sc_tmo_rhsc, &sc->sc_bus.bus_mtx, 0); 411 412 #ifdef USB_DEBUG 413 if (ohcidebug > 15) { 414 for (i = 0; i != OHCI_NO_EDS; i++) { 415 printf("ed#%d ", i); 416 ohci_dump_ed(sc->sc_intr_p_last[i]); 417 } 418 printf("iso "); 419 ohci_dump_ed(sc->sc_isoc_p_last); 420 } 421 #endif 422 423 sc->sc_bus.usbrev = USB_REV_1_0; 424 425 if (ohci_controller_init(sc, 0) != 0) 426 return (USB_ERR_INVAL); 427 428 /* catch any lost interrupts */ 429 ohci_do_poll(&sc->sc_bus); 430 return (USB_ERR_NORMAL_COMPLETION); 431 } 432 433 /* 434 * shut down the controller when the system is going down 435 */ 436 void 437 ohci_detach(struct ohci_softc *sc) 438 { 439 USB_BUS_LOCK(&sc->sc_bus); 440 441 usb_callout_stop(&sc->sc_tmo_rhsc); 442 443 OWRITE4(sc, OHCI_INTERRUPT_DISABLE, OHCI_ALL_INTRS); 444 OWRITE4(sc, OHCI_CONTROL, OHCI_HCFS_RESET); 445 446 USB_BUS_UNLOCK(&sc->sc_bus); 447 448 /* XXX let stray task complete */ 449 usb_pause_mtx(NULL, hz / 20); 450 451 usb_callout_drain(&sc->sc_tmo_rhsc); 452 } 453 454 static void 455 ohci_suspend(ohci_softc_t *sc) 456 { 457 DPRINTF("\n"); 458 459 #ifdef USB_DEBUG 460 if (ohcidebug > 2) 461 ohci_dumpregs(sc); 462 #endif 463 464 /* reset HC and leave it suspended */ 465 ohci_controller_init(sc, 1); 466 } 467 468 static void 469 ohci_resume(ohci_softc_t *sc) 470 { 471 DPRINTF("\n"); 472 473 #ifdef USB_DEBUG 474 if (ohcidebug > 2) 475 ohci_dumpregs(sc); 476 #endif 477 478 /* some broken BIOSes never initialize the Controller chip */ 479 ohci_controller_init(sc, 0); 480 481 /* catch any lost interrupts */ 482 ohci_do_poll(&sc->sc_bus); 483 } 484 485 #ifdef USB_DEBUG 486 static void 487 ohci_dumpregs(ohci_softc_t *sc) 488 { 489 struct ohci_hcca *hcca; 490 491 DPRINTF("ohci_dumpregs: rev=0x%08x control=0x%08x command=0x%08x\n", 492 OREAD4(sc, OHCI_REVISION), 493 OREAD4(sc, OHCI_CONTROL), 494 OREAD4(sc, OHCI_COMMAND_STATUS)); 495 DPRINTF(" intrstat=0x%08x intre=0x%08x intrd=0x%08x\n", 496 OREAD4(sc, OHCI_INTERRUPT_STATUS), 497 OREAD4(sc, OHCI_INTERRUPT_ENABLE), 498 OREAD4(sc, OHCI_INTERRUPT_DISABLE)); 499 DPRINTF(" hcca=0x%08x percur=0x%08x ctrlhd=0x%08x\n", 500 OREAD4(sc, OHCI_HCCA), 501 OREAD4(sc, OHCI_PERIOD_CURRENT_ED), 502 OREAD4(sc, OHCI_CONTROL_HEAD_ED)); 503 DPRINTF(" ctrlcur=0x%08x bulkhd=0x%08x bulkcur=0x%08x\n", 504 OREAD4(sc, OHCI_CONTROL_CURRENT_ED), 505 OREAD4(sc, OHCI_BULK_HEAD_ED), 506 OREAD4(sc, OHCI_BULK_CURRENT_ED)); 507 DPRINTF(" done=0x%08x fmival=0x%08x fmrem=0x%08x\n", 508 OREAD4(sc, OHCI_DONE_HEAD), 509 OREAD4(sc, OHCI_FM_INTERVAL), 510 OREAD4(sc, OHCI_FM_REMAINING)); 511 DPRINTF(" fmnum=0x%08x perst=0x%08x lsthrs=0x%08x\n", 512 OREAD4(sc, OHCI_FM_NUMBER), 513 OREAD4(sc, OHCI_PERIODIC_START), 514 OREAD4(sc, OHCI_LS_THRESHOLD)); 515 DPRINTF(" desca=0x%08x descb=0x%08x stat=0x%08x\n", 516 OREAD4(sc, OHCI_RH_DESCRIPTOR_A), 517 OREAD4(sc, OHCI_RH_DESCRIPTOR_B), 518 OREAD4(sc, OHCI_RH_STATUS)); 519 DPRINTF(" port1=0x%08x port2=0x%08x\n", 520 OREAD4(sc, OHCI_RH_PORT_STATUS(1)), 521 OREAD4(sc, OHCI_RH_PORT_STATUS(2))); 522 523 hcca = ohci_get_hcca(sc); 524 525 DPRINTF(" HCCA: frame_number=0x%04x done_head=0x%08x\n", 526 le32toh(hcca->hcca_frame_number), 527 le32toh(hcca->hcca_done_head)); 528 } 529 static void 530 ohci_dump_tds(ohci_td_t *std) 531 { 532 for (; std; std = std->obj_next) { 533 if (ohci_dump_td(std)) { 534 break; 535 } 536 } 537 } 538 539 static uint8_t 540 ohci_dump_td(ohci_td_t *std) 541 { 542 uint32_t td_flags; 543 uint8_t temp; 544 545 usb_pc_cpu_invalidate(std->page_cache); 546 547 td_flags = le32toh(std->td_flags); 548 temp = (std->td_next == 0); 549 550 printf("TD(%p) at 0x%08x: %s%s%s%s%s delay=%d ec=%d " 551 "cc=%d\ncbp=0x%08x next=0x%08x be=0x%08x\n", 552 std, le32toh(std->td_self), 553 (td_flags & OHCI_TD_R) ? "-R" : "", 554 (td_flags & OHCI_TD_OUT) ? "-OUT" : "", 555 (td_flags & OHCI_TD_IN) ? "-IN" : "", 556 ((td_flags & OHCI_TD_TOGGLE_MASK) == OHCI_TD_TOGGLE_1) ? "-TOG1" : "", 557 ((td_flags & OHCI_TD_TOGGLE_MASK) == OHCI_TD_TOGGLE_0) ? "-TOG0" : "", 558 OHCI_TD_GET_DI(td_flags), 559 OHCI_TD_GET_EC(td_flags), 560 OHCI_TD_GET_CC(td_flags), 561 le32toh(std->td_cbp), 562 le32toh(std->td_next), 563 le32toh(std->td_be)); 564 565 return (temp); 566 } 567 568 static uint8_t 569 ohci_dump_itd(ohci_itd_t *sitd) 570 { 571 uint32_t itd_flags; 572 uint16_t i; 573 uint8_t temp; 574 575 usb_pc_cpu_invalidate(sitd->page_cache); 576 577 itd_flags = le32toh(sitd->itd_flags); 578 temp = (sitd->itd_next == 0); 579 580 printf("ITD(%p) at 0x%08x: sf=%d di=%d fc=%d cc=%d\n" 581 "bp0=0x%08x next=0x%08x be=0x%08x\n", 582 sitd, le32toh(sitd->itd_self), 583 OHCI_ITD_GET_SF(itd_flags), 584 OHCI_ITD_GET_DI(itd_flags), 585 OHCI_ITD_GET_FC(itd_flags), 586 OHCI_ITD_GET_CC(itd_flags), 587 le32toh(sitd->itd_bp0), 588 le32toh(sitd->itd_next), 589 le32toh(sitd->itd_be)); 590 for (i = 0; i < OHCI_ITD_NOFFSET; i++) { 591 printf("offs[%d]=0x%04x ", i, 592 (uint32_t)le16toh(sitd->itd_offset[i])); 593 } 594 printf("\n"); 595 596 return (temp); 597 } 598 599 static void 600 ohci_dump_itds(ohci_itd_t *sitd) 601 { 602 for (; sitd; sitd = sitd->obj_next) { 603 if (ohci_dump_itd(sitd)) { 604 break; 605 } 606 } 607 } 608 609 static void 610 ohci_dump_ed(ohci_ed_t *sed) 611 { 612 uint32_t ed_flags; 613 uint32_t ed_headp; 614 615 usb_pc_cpu_invalidate(sed->page_cache); 616 617 ed_flags = le32toh(sed->ed_flags); 618 ed_headp = le32toh(sed->ed_headp); 619 620 printf("ED(%p) at 0x%08x: addr=%d endpt=%d maxp=%d flags=%s%s%s%s%s\n" 621 "tailp=0x%08x headflags=%s%s headp=0x%08x nexted=0x%08x\n", 622 sed, le32toh(sed->ed_self), 623 OHCI_ED_GET_FA(ed_flags), 624 OHCI_ED_GET_EN(ed_flags), 625 OHCI_ED_GET_MAXP(ed_flags), 626 (ed_flags & OHCI_ED_DIR_OUT) ? "-OUT" : "", 627 (ed_flags & OHCI_ED_DIR_IN) ? "-IN" : "", 628 (ed_flags & OHCI_ED_SPEED) ? "-LOWSPEED" : "", 629 (ed_flags & OHCI_ED_SKIP) ? "-SKIP" : "", 630 (ed_flags & OHCI_ED_FORMAT_ISO) ? "-ISO" : "", 631 le32toh(sed->ed_tailp), 632 (ed_headp & OHCI_HALTED) ? "-HALTED" : "", 633 (ed_headp & OHCI_TOGGLECARRY) ? "-CARRY" : "", 634 le32toh(sed->ed_headp), 635 le32toh(sed->ed_next)); 636 } 637 638 #endif 639 640 static void 641 ohci_transfer_intr_enqueue(struct usb_xfer *xfer) 642 { 643 /* check for early completion */ 644 if (ohci_check_transfer(xfer)) { 645 return; 646 } 647 /* put transfer on interrupt queue */ 648 usbd_transfer_enqueue(&xfer->xroot->bus->intr_q, xfer); 649 650 /* start timeout, if any */ 651 if (xfer->timeout != 0) { 652 usbd_transfer_timeout_ms(xfer, &ohci_timeout, xfer->timeout); 653 } 654 } 655 656 #define OHCI_APPEND_QH(sed,last) (last) = _ohci_append_qh(sed,last) 657 static ohci_ed_t * 658 _ohci_append_qh(ohci_ed_t *sed, ohci_ed_t *last) 659 { 660 DPRINTFN(11, "%p to %p\n", sed, last); 661 662 if (sed->prev != NULL) { 663 /* should not happen */ 664 DPRINTFN(0, "ED already linked!\n"); 665 return (last); 666 } 667 /* (sc->sc_bus.bus_mtx) must be locked */ 668 669 sed->next = last->next; 670 sed->ed_next = last->ed_next; 671 sed->ed_tailp = 0; 672 673 sed->prev = last; 674 675 usb_pc_cpu_flush(sed->page_cache); 676 677 /* 678 * the last->next->prev is never followed: sed->next->prev = sed; 679 */ 680 681 last->next = sed; 682 last->ed_next = sed->ed_self; 683 684 usb_pc_cpu_flush(last->page_cache); 685 686 return (sed); 687 } 688 689 #define OHCI_REMOVE_QH(sed,last) (last) = _ohci_remove_qh(sed,last) 690 static ohci_ed_t * 691 _ohci_remove_qh(ohci_ed_t *sed, ohci_ed_t *last) 692 { 693 DPRINTFN(11, "%p from %p\n", sed, last); 694 695 /* (sc->sc_bus.bus_mtx) must be locked */ 696 697 /* only remove if not removed from a queue */ 698 if (sed->prev) { 699 sed->prev->next = sed->next; 700 sed->prev->ed_next = sed->ed_next; 701 702 usb_pc_cpu_flush(sed->prev->page_cache); 703 704 if (sed->next) { 705 sed->next->prev = sed->prev; 706 usb_pc_cpu_flush(sed->next->page_cache); 707 } 708 last = ((last == sed) ? sed->prev : last); 709 710 sed->prev = 0; 711 712 usb_pc_cpu_flush(sed->page_cache); 713 } 714 return (last); 715 } 716 717 static void 718 ohci_isoc_done(struct usb_xfer *xfer) 719 { 720 uint8_t nframes; 721 uint32_t *plen = xfer->frlengths; 722 volatile uint16_t *olen; 723 uint16_t len = 0; 724 ohci_itd_t *td = xfer->td_transfer_first; 725 726 while (1) { 727 if (td == NULL) { 728 panic("%s:%d: out of TD's\n", 729 __FUNCTION__, __LINE__); 730 } 731 #ifdef USB_DEBUG 732 if (ohcidebug > 5) { 733 DPRINTF("isoc TD\n"); 734 ohci_dump_itd(td); 735 } 736 #endif 737 usb_pc_cpu_invalidate(td->page_cache); 738 739 nframes = td->frames; 740 olen = &td->itd_offset[0]; 741 742 if (nframes > 8) { 743 nframes = 8; 744 } 745 while (nframes--) { 746 len = le16toh(*olen); 747 748 if ((len >> 12) == OHCI_CC_NOT_ACCESSED) { 749 len = 0; 750 } else { 751 len &= ((1 << 12) - 1); 752 } 753 754 if (len > *plen) { 755 len = 0;/* invalid length */ 756 } 757 *plen = len; 758 plen++; 759 olen++; 760 } 761 762 if (((void *)td) == xfer->td_transfer_last) { 763 break; 764 } 765 td = td->obj_next; 766 } 767 768 xfer->aframes = xfer->nframes; 769 ohci_device_done(xfer, USB_ERR_NORMAL_COMPLETION); 770 } 771 772 #ifdef USB_DEBUG 773 static const char *const 774 ohci_cc_strs[] = 775 { 776 "NO_ERROR", 777 "CRC", 778 "BIT_STUFFING", 779 "DATA_TOGGLE_MISMATCH", 780 781 "STALL", 782 "DEVICE_NOT_RESPONDING", 783 "PID_CHECK_FAILURE", 784 "UNEXPECTED_PID", 785 786 "DATA_OVERRUN", 787 "DATA_UNDERRUN", 788 "BUFFER_OVERRUN", 789 "BUFFER_UNDERRUN", 790 791 "reserved", 792 "reserved", 793 "NOT_ACCESSED", 794 "NOT_ACCESSED" 795 }; 796 797 #endif 798 799 static usb_error_t 800 ohci_non_isoc_done_sub(struct usb_xfer *xfer) 801 { 802 ohci_td_t *td; 803 ohci_td_t *td_alt_next; 804 uint32_t temp; 805 uint32_t phy_start; 806 uint32_t phy_end; 807 uint32_t td_flags; 808 uint16_t cc; 809 810 td = xfer->td_transfer_cache; 811 td_alt_next = td->alt_next; 812 td_flags = 0; 813 814 if (xfer->aframes != xfer->nframes) { 815 usbd_xfer_set_frame_len(xfer, xfer->aframes, 0); 816 } 817 while (1) { 818 usb_pc_cpu_invalidate(td->page_cache); 819 phy_start = le32toh(td->td_cbp); 820 td_flags = le32toh(td->td_flags); 821 cc = OHCI_TD_GET_CC(td_flags); 822 823 if (phy_start) { 824 /* 825 * short transfer - compute the number of remaining 826 * bytes in the hardware buffer: 827 */ 828 phy_end = le32toh(td->td_be); 829 temp = (OHCI_PAGE(phy_start ^ phy_end) ? 830 (OHCI_PAGE_SIZE + 1) : 0x0001); 831 temp += OHCI_PAGE_OFFSET(phy_end); 832 temp -= OHCI_PAGE_OFFSET(phy_start); 833 834 if (temp > td->len) { 835 /* guard against corruption */ 836 cc = OHCI_CC_STALL; 837 } else if (xfer->aframes != xfer->nframes) { 838 /* 839 * Sum up total transfer length 840 * in "frlengths[]": 841 */ 842 xfer->frlengths[xfer->aframes] += td->len - temp; 843 } 844 } else { 845 if (xfer->aframes != xfer->nframes) { 846 /* transfer was complete */ 847 xfer->frlengths[xfer->aframes] += td->len; 848 } 849 } 850 /* Check for last transfer */ 851 if (((void *)td) == xfer->td_transfer_last) { 852 td = NULL; 853 break; 854 } 855 /* Check transfer status */ 856 if (cc) { 857 /* the transfer is finished */ 858 td = NULL; 859 break; 860 } 861 /* Check for short transfer */ 862 if (phy_start) { 863 if (xfer->flags_int.short_frames_ok) { 864 /* follow alt next */ 865 td = td->alt_next; 866 } else { 867 /* the transfer is finished */ 868 td = NULL; 869 } 870 break; 871 } 872 td = td->obj_next; 873 874 if (td->alt_next != td_alt_next) { 875 /* this USB frame is complete */ 876 break; 877 } 878 } 879 880 /* update transfer cache */ 881 882 xfer->td_transfer_cache = td; 883 884 DPRINTFN(16, "error cc=%d (%s)\n", 885 cc, ohci_cc_strs[cc]); 886 887 return ((cc == 0) ? USB_ERR_NORMAL_COMPLETION : 888 (cc == OHCI_CC_STALL) ? USB_ERR_STALLED : USB_ERR_IOERROR); 889 } 890 891 static void 892 ohci_non_isoc_done(struct usb_xfer *xfer) 893 { 894 usb_error_t err = 0; 895 896 DPRINTFN(13, "xfer=%p endpoint=%p transfer done\n", 897 xfer, xfer->endpoint); 898 899 #ifdef USB_DEBUG 900 if (ohcidebug > 10) { 901 ohci_dump_tds(xfer->td_transfer_first); 902 } 903 #endif 904 905 /* reset scanner */ 906 907 xfer->td_transfer_cache = xfer->td_transfer_first; 908 909 if (xfer->flags_int.control_xfr) { 910 if (xfer->flags_int.control_hdr) { 911 err = ohci_non_isoc_done_sub(xfer); 912 } 913 xfer->aframes = 1; 914 915 if (xfer->td_transfer_cache == NULL) { 916 goto done; 917 } 918 } 919 while (xfer->aframes != xfer->nframes) { 920 err = ohci_non_isoc_done_sub(xfer); 921 xfer->aframes++; 922 923 if (xfer->td_transfer_cache == NULL) { 924 goto done; 925 } 926 } 927 928 if (xfer->flags_int.control_xfr && 929 !xfer->flags_int.control_act) { 930 err = ohci_non_isoc_done_sub(xfer); 931 } 932 done: 933 ohci_device_done(xfer, err); 934 } 935 936 /*------------------------------------------------------------------------* 937 * ohci_check_transfer_sub 938 *------------------------------------------------------------------------*/ 939 static void 940 ohci_check_transfer_sub(struct usb_xfer *xfer) 941 { 942 ohci_td_t *td; 943 ohci_ed_t *ed; 944 uint32_t phy_start; 945 uint32_t td_flags; 946 uint32_t td_next; 947 uint16_t cc; 948 949 td = xfer->td_transfer_cache; 950 951 while (1) { 952 usb_pc_cpu_invalidate(td->page_cache); 953 phy_start = le32toh(td->td_cbp); 954 td_flags = le32toh(td->td_flags); 955 td_next = le32toh(td->td_next); 956 957 /* Check for last transfer */ 958 if (((void *)td) == xfer->td_transfer_last) { 959 /* the transfer is finished */ 960 td = NULL; 961 break; 962 } 963 /* Check transfer status */ 964 cc = OHCI_TD_GET_CC(td_flags); 965 if (cc) { 966 /* the transfer is finished */ 967 td = NULL; 968 break; 969 } 970 /* 971 * Check if we reached the last packet 972 * or if there is a short packet: 973 */ 974 975 if (((td_next & (~0xF)) == OHCI_TD_NEXT_END) || phy_start) { 976 /* follow alt next */ 977 td = td->alt_next; 978 break; 979 } 980 td = td->obj_next; 981 } 982 983 /* update transfer cache */ 984 985 xfer->td_transfer_cache = td; 986 987 if (td) { 988 ed = xfer->qh_start[xfer->flags_int.curr_dma_set]; 989 990 ed->ed_headp = td->td_self; 991 usb_pc_cpu_flush(ed->page_cache); 992 993 DPRINTFN(13, "xfer=%p following alt next\n", xfer); 994 995 /* 996 * Make sure that the OHCI re-scans the schedule by 997 * writing the BLF and CLF bits: 998 */ 999 1000 if (xfer->xroot->udev->flags.self_suspended) { 1001 /* nothing to do */ 1002 } else if (xfer->endpoint->methods == &ohci_device_bulk_methods) { 1003 ohci_softc_t *sc = OHCI_BUS2SC(xfer->xroot->bus); 1004 1005 OWRITE4(sc, OHCI_COMMAND_STATUS, OHCI_BLF); 1006 } else if (xfer->endpoint->methods == &ohci_device_ctrl_methods) { 1007 ohci_softc_t *sc = OHCI_BUS2SC(xfer->xroot->bus); 1008 1009 OWRITE4(sc, OHCI_COMMAND_STATUS, OHCI_CLF); 1010 } 1011 } 1012 } 1013 1014 /*------------------------------------------------------------------------* 1015 * ohci_check_transfer 1016 * 1017 * Return values: 1018 * 0: USB transfer is not finished 1019 * Else: USB transfer is finished 1020 *------------------------------------------------------------------------*/ 1021 static uint8_t 1022 ohci_check_transfer(struct usb_xfer *xfer) 1023 { 1024 ohci_ed_t *ed; 1025 uint32_t ed_headp; 1026 uint32_t ed_tailp; 1027 1028 DPRINTFN(13, "xfer=%p checking transfer\n", xfer); 1029 1030 ed = xfer->qh_start[xfer->flags_int.curr_dma_set]; 1031 1032 usb_pc_cpu_invalidate(ed->page_cache); 1033 ed_headp = le32toh(ed->ed_headp); 1034 ed_tailp = le32toh(ed->ed_tailp); 1035 1036 if ((ed_headp & OHCI_HALTED) || 1037 (((ed_headp ^ ed_tailp) & (~0xF)) == 0)) { 1038 if (xfer->endpoint->methods == &ohci_device_isoc_methods) { 1039 /* isochronous transfer */ 1040 ohci_isoc_done(xfer); 1041 } else { 1042 if (xfer->flags_int.short_frames_ok) { 1043 ohci_check_transfer_sub(xfer); 1044 if (xfer->td_transfer_cache) { 1045 /* not finished yet */ 1046 return (0); 1047 } 1048 } 1049 /* store data-toggle */ 1050 if (ed_headp & OHCI_TOGGLECARRY) { 1051 xfer->endpoint->toggle_next = 1; 1052 } else { 1053 xfer->endpoint->toggle_next = 0; 1054 } 1055 1056 /* non-isochronous transfer */ 1057 ohci_non_isoc_done(xfer); 1058 } 1059 return (1); 1060 } 1061 DPRINTFN(13, "xfer=%p is still active\n", xfer); 1062 return (0); 1063 } 1064 1065 static void 1066 ohci_rhsc_enable(ohci_softc_t *sc) 1067 { 1068 DPRINTFN(5, "\n"); 1069 1070 USB_BUS_LOCK_ASSERT(&sc->sc_bus, MA_OWNED); 1071 1072 sc->sc_eintrs |= OHCI_RHSC; 1073 OWRITE4(sc, OHCI_INTERRUPT_ENABLE, OHCI_RHSC); 1074 1075 /* acknowledge any RHSC interrupt */ 1076 OWRITE4(sc, OHCI_INTERRUPT_STATUS, OHCI_RHSC); 1077 1078 ohci_root_intr(sc); 1079 } 1080 1081 static void 1082 ohci_interrupt_poll(ohci_softc_t *sc) 1083 { 1084 struct usb_xfer *xfer; 1085 1086 repeat: 1087 TAILQ_FOREACH(xfer, &sc->sc_bus.intr_q.head, wait_entry) { 1088 /* 1089 * check if transfer is transferred 1090 */ 1091 if (ohci_check_transfer(xfer)) { 1092 /* queue has been modified */ 1093 goto repeat; 1094 } 1095 } 1096 } 1097 1098 /*------------------------------------------------------------------------* 1099 * ohci_interrupt - OHCI interrupt handler 1100 * 1101 * NOTE: Do not access "sc->sc_bus.bdev" inside the interrupt handler, 1102 * hence the interrupt handler will be setup before "sc->sc_bus.bdev" 1103 * is present ! 1104 *------------------------------------------------------------------------*/ 1105 void 1106 ohci_interrupt(ohci_softc_t *sc) 1107 { 1108 struct ohci_hcca *hcca; 1109 uint32_t status; 1110 uint32_t done; 1111 1112 USB_BUS_LOCK(&sc->sc_bus); 1113 1114 hcca = ohci_get_hcca(sc); 1115 1116 DPRINTFN(16, "real interrupt\n"); 1117 1118 #ifdef USB_DEBUG 1119 if (ohcidebug > 15) { 1120 ohci_dumpregs(sc); 1121 } 1122 #endif 1123 1124 done = le32toh(hcca->hcca_done_head); 1125 1126 /* 1127 * The LSb of done is used to inform the HC Driver that an interrupt 1128 * condition exists for both the Done list and for another event 1129 * recorded in HcInterruptStatus. On an interrupt from the HC, the 1130 * HC Driver checks the HccaDoneHead Value. If this value is 0, then 1131 * the interrupt was caused by other than the HccaDoneHead update 1132 * and the HcInterruptStatus register needs to be accessed to 1133 * determine that exact interrupt cause. If HccaDoneHead is nonzero, 1134 * then a Done list update interrupt is indicated and if the LSb of 1135 * done is nonzero, then an additional interrupt event is indicated 1136 * and HcInterruptStatus should be checked to determine its cause. 1137 */ 1138 if (done != 0) { 1139 status = 0; 1140 1141 if (done & ~OHCI_DONE_INTRS) { 1142 status |= OHCI_WDH; 1143 } 1144 if (done & OHCI_DONE_INTRS) { 1145 status |= OREAD4(sc, OHCI_INTERRUPT_STATUS); 1146 } 1147 hcca->hcca_done_head = 0; 1148 1149 usb_pc_cpu_flush(&sc->sc_hw.hcca_pc); 1150 } else { 1151 status = OREAD4(sc, OHCI_INTERRUPT_STATUS) & ~OHCI_WDH; 1152 } 1153 1154 status &= ~OHCI_MIE; 1155 if (status == 0) { 1156 /* 1157 * nothing to be done (PCI shared 1158 * interrupt) 1159 */ 1160 goto done; 1161 } 1162 OWRITE4(sc, OHCI_INTERRUPT_STATUS, status); /* Acknowledge */ 1163 1164 status &= sc->sc_eintrs; 1165 if (status == 0) { 1166 goto done; 1167 } 1168 if (status & (OHCI_SO | OHCI_RD | OHCI_UE | OHCI_RHSC)) { 1169 #if 0 1170 if (status & OHCI_SO) { 1171 /* XXX do what */ 1172 } 1173 #endif 1174 if (status & OHCI_RD) { 1175 printf("%s: resume detect\n", __FUNCTION__); 1176 /* XXX process resume detect */ 1177 } 1178 if (status & OHCI_UE) { 1179 printf("%s: unrecoverable error, " 1180 "controller halted\n", __FUNCTION__); 1181 OWRITE4(sc, OHCI_CONTROL, OHCI_HCFS_RESET); 1182 /* XXX what else */ 1183 } 1184 if (status & OHCI_RHSC) { 1185 /* 1186 * Disable RHSC interrupt for now, because it will be 1187 * on until the port has been reset. 1188 */ 1189 sc->sc_eintrs &= ~OHCI_RHSC; 1190 OWRITE4(sc, OHCI_INTERRUPT_DISABLE, OHCI_RHSC); 1191 1192 ohci_root_intr(sc); 1193 1194 /* do not allow RHSC interrupts > 1 per second */ 1195 usb_callout_reset(&sc->sc_tmo_rhsc, hz, 1196 (void *)&ohci_rhsc_enable, sc); 1197 } 1198 } 1199 status &= ~(OHCI_RHSC | OHCI_WDH | OHCI_SO); 1200 if (status != 0) { 1201 /* Block unprocessed interrupts. XXX */ 1202 OWRITE4(sc, OHCI_INTERRUPT_DISABLE, status); 1203 sc->sc_eintrs &= ~status; 1204 printf("%s: blocking intrs 0x%x\n", 1205 __FUNCTION__, status); 1206 } 1207 /* poll all the USB transfers */ 1208 ohci_interrupt_poll(sc); 1209 1210 done: 1211 USB_BUS_UNLOCK(&sc->sc_bus); 1212 } 1213 1214 /* 1215 * called when a request does not complete 1216 */ 1217 static void 1218 ohci_timeout(void *arg) 1219 { 1220 struct usb_xfer *xfer = arg; 1221 1222 DPRINTF("xfer=%p\n", xfer); 1223 1224 USB_BUS_LOCK_ASSERT(xfer->xroot->bus, MA_OWNED); 1225 1226 /* transfer is transferred */ 1227 ohci_device_done(xfer, USB_ERR_TIMEOUT); 1228 } 1229 1230 static void 1231 ohci_do_poll(struct usb_bus *bus) 1232 { 1233 struct ohci_softc *sc = OHCI_BUS2SC(bus); 1234 1235 USB_BUS_LOCK(&sc->sc_bus); 1236 ohci_interrupt_poll(sc); 1237 USB_BUS_UNLOCK(&sc->sc_bus); 1238 } 1239 1240 static void 1241 ohci_setup_standard_chain_sub(struct ohci_std_temp *temp) 1242 { 1243 struct usb_page_search buf_res; 1244 ohci_td_t *td; 1245 ohci_td_t *td_next; 1246 ohci_td_t *td_alt_next; 1247 uint32_t buf_offset; 1248 uint32_t average; 1249 uint32_t len_old; 1250 uint8_t shortpkt_old; 1251 uint8_t precompute; 1252 1253 td_alt_next = NULL; 1254 buf_offset = 0; 1255 shortpkt_old = temp->shortpkt; 1256 len_old = temp->len; 1257 precompute = 1; 1258 1259 /* software is used to detect short incoming transfers */ 1260 1261 if ((temp->td_flags & htole32(OHCI_TD_DP_MASK)) == htole32(OHCI_TD_IN)) { 1262 temp->td_flags |= htole32(OHCI_TD_R); 1263 } else { 1264 temp->td_flags &= ~htole32(OHCI_TD_R); 1265 } 1266 1267 restart: 1268 1269 td = temp->td; 1270 td_next = temp->td_next; 1271 1272 while (1) { 1273 if (temp->len == 0) { 1274 if (temp->shortpkt) { 1275 break; 1276 } 1277 /* send a Zero Length Packet, ZLP, last */ 1278 1279 temp->shortpkt = 1; 1280 average = 0; 1281 1282 } else { 1283 average = temp->average; 1284 1285 if (temp->len < average) { 1286 if (temp->len % temp->max_frame_size) { 1287 temp->shortpkt = 1; 1288 } 1289 average = temp->len; 1290 } 1291 } 1292 1293 if (td_next == NULL) { 1294 panic("%s: out of OHCI transfer descriptors!", __FUNCTION__); 1295 } 1296 /* get next TD */ 1297 1298 td = td_next; 1299 td_next = td->obj_next; 1300 1301 /* check if we are pre-computing */ 1302 1303 if (precompute) { 1304 /* update remaining length */ 1305 1306 temp->len -= average; 1307 1308 continue; 1309 } 1310 /* fill out current TD */ 1311 td->td_flags = temp->td_flags; 1312 1313 /* the next TD uses TOGGLE_CARRY */ 1314 temp->td_flags &= ~htole32(OHCI_TD_TOGGLE_MASK); 1315 1316 if (average == 0) { 1317 /* 1318 * The buffer start and end phys addresses should be 1319 * 0x0 for a zero length packet. 1320 */ 1321 td->td_cbp = 0; 1322 td->td_be = 0; 1323 td->len = 0; 1324 1325 } else { 1326 usbd_get_page(temp->pc, buf_offset, &buf_res); 1327 td->td_cbp = htole32(buf_res.physaddr); 1328 buf_offset += (average - 1); 1329 1330 usbd_get_page(temp->pc, buf_offset, &buf_res); 1331 td->td_be = htole32(buf_res.physaddr); 1332 buf_offset++; 1333 1334 td->len = average; 1335 1336 /* update remaining length */ 1337 1338 temp->len -= average; 1339 } 1340 1341 if ((td_next == td_alt_next) && temp->setup_alt_next) { 1342 /* we need to receive these frames one by one ! */ 1343 td->td_flags &= htole32(~OHCI_TD_INTR_MASK); 1344 td->td_flags |= htole32(OHCI_TD_SET_DI(1)); 1345 td->td_next = htole32(OHCI_TD_NEXT_END); 1346 } else { 1347 if (td_next) { 1348 /* link the current TD with the next one */ 1349 td->td_next = td_next->td_self; 1350 } 1351 } 1352 1353 td->alt_next = td_alt_next; 1354 1355 usb_pc_cpu_flush(td->page_cache); 1356 } 1357 1358 if (precompute) { 1359 precompute = 0; 1360 1361 /* setup alt next pointer, if any */ 1362 if (temp->last_frame) { 1363 /* no alternate next */ 1364 td_alt_next = NULL; 1365 } else { 1366 /* we use this field internally */ 1367 td_alt_next = td_next; 1368 } 1369 1370 /* restore */ 1371 temp->shortpkt = shortpkt_old; 1372 temp->len = len_old; 1373 goto restart; 1374 } 1375 temp->td = td; 1376 temp->td_next = td_next; 1377 } 1378 1379 static void 1380 ohci_setup_standard_chain(struct usb_xfer *xfer, ohci_ed_t **ed_last) 1381 { 1382 struct ohci_std_temp temp; 1383 const struct usb_pipe_methods *methods; 1384 ohci_ed_t *ed; 1385 ohci_td_t *td; 1386 uint32_t ed_flags; 1387 uint32_t x; 1388 1389 DPRINTFN(9, "addr=%d endpt=%d sumlen=%d speed=%d\n", 1390 xfer->address, UE_GET_ADDR(xfer->endpointno), 1391 xfer->sumlen, usbd_get_speed(xfer->xroot->udev)); 1392 1393 temp.average = xfer->max_hc_frame_size; 1394 temp.max_frame_size = xfer->max_frame_size; 1395 1396 /* toggle the DMA set we are using */ 1397 xfer->flags_int.curr_dma_set ^= 1; 1398 1399 /* get next DMA set */ 1400 td = xfer->td_start[xfer->flags_int.curr_dma_set]; 1401 1402 xfer->td_transfer_first = td; 1403 xfer->td_transfer_cache = td; 1404 1405 temp.td = NULL; 1406 temp.td_next = td; 1407 temp.last_frame = 0; 1408 temp.setup_alt_next = xfer->flags_int.short_frames_ok; 1409 1410 methods = xfer->endpoint->methods; 1411 1412 /* check if we should prepend a setup message */ 1413 1414 if (xfer->flags_int.control_xfr) { 1415 if (xfer->flags_int.control_hdr) { 1416 temp.td_flags = htole32(OHCI_TD_SETUP | OHCI_TD_NOCC | 1417 OHCI_TD_TOGGLE_0 | OHCI_TD_NOINTR); 1418 1419 temp.len = xfer->frlengths[0]; 1420 temp.pc = xfer->frbuffers + 0; 1421 temp.shortpkt = temp.len ? 1 : 0; 1422 /* check for last frame */ 1423 if (xfer->nframes == 1) { 1424 /* no STATUS stage yet, SETUP is last */ 1425 if (xfer->flags_int.control_act) { 1426 temp.last_frame = 1; 1427 temp.setup_alt_next = 0; 1428 } 1429 } 1430 ohci_setup_standard_chain_sub(&temp); 1431 1432 /* 1433 * XXX assume that the setup message is 1434 * contained within one USB packet: 1435 */ 1436 xfer->endpoint->toggle_next = 1; 1437 } 1438 x = 1; 1439 } else { 1440 x = 0; 1441 } 1442 temp.td_flags = htole32(OHCI_TD_NOCC | OHCI_TD_NOINTR); 1443 1444 /* set data toggle */ 1445 1446 if (xfer->endpoint->toggle_next) { 1447 temp.td_flags |= htole32(OHCI_TD_TOGGLE_1); 1448 } else { 1449 temp.td_flags |= htole32(OHCI_TD_TOGGLE_0); 1450 } 1451 1452 /* set endpoint direction */ 1453 1454 if (UE_GET_DIR(xfer->endpointno) == UE_DIR_IN) { 1455 temp.td_flags |= htole32(OHCI_TD_IN); 1456 } else { 1457 temp.td_flags |= htole32(OHCI_TD_OUT); 1458 } 1459 1460 while (x != xfer->nframes) { 1461 /* DATA0 / DATA1 message */ 1462 1463 temp.len = xfer->frlengths[x]; 1464 temp.pc = xfer->frbuffers + x; 1465 1466 x++; 1467 1468 if (x == xfer->nframes) { 1469 if (xfer->flags_int.control_xfr) { 1470 /* no STATUS stage yet, DATA is last */ 1471 if (xfer->flags_int.control_act) { 1472 temp.last_frame = 1; 1473 temp.setup_alt_next = 0; 1474 } 1475 } else { 1476 temp.last_frame = 1; 1477 temp.setup_alt_next = 0; 1478 } 1479 } 1480 if (temp.len == 0) { 1481 /* make sure that we send an USB packet */ 1482 1483 temp.shortpkt = 0; 1484 1485 } else { 1486 /* regular data transfer */ 1487 1488 temp.shortpkt = (xfer->flags.force_short_xfer) ? 0 : 1; 1489 } 1490 1491 ohci_setup_standard_chain_sub(&temp); 1492 } 1493 1494 /* check if we should append a status stage */ 1495 1496 if (xfer->flags_int.control_xfr && 1497 !xfer->flags_int.control_act) { 1498 /* 1499 * Send a DATA1 message and invert the current endpoint 1500 * direction. 1501 */ 1502 1503 /* set endpoint direction and data toggle */ 1504 1505 if (UE_GET_DIR(xfer->endpointno) == UE_DIR_IN) { 1506 temp.td_flags = htole32(OHCI_TD_OUT | 1507 OHCI_TD_NOCC | OHCI_TD_TOGGLE_1 | OHCI_TD_SET_DI(1)); 1508 } else { 1509 temp.td_flags = htole32(OHCI_TD_IN | 1510 OHCI_TD_NOCC | OHCI_TD_TOGGLE_1 | OHCI_TD_SET_DI(1)); 1511 } 1512 1513 temp.len = 0; 1514 temp.pc = NULL; 1515 temp.shortpkt = 0; 1516 temp.last_frame = 1; 1517 temp.setup_alt_next = 0; 1518 1519 ohci_setup_standard_chain_sub(&temp); 1520 } 1521 td = temp.td; 1522 1523 /* Ensure that last TD is terminating: */ 1524 td->td_next = htole32(OHCI_TD_NEXT_END); 1525 td->td_flags &= ~htole32(OHCI_TD_INTR_MASK); 1526 td->td_flags |= htole32(OHCI_TD_SET_DI(1)); 1527 1528 usb_pc_cpu_flush(td->page_cache); 1529 1530 /* must have at least one frame! */ 1531 1532 xfer->td_transfer_last = td; 1533 1534 #ifdef USB_DEBUG 1535 if (ohcidebug > 8) { 1536 DPRINTF("nexttog=%d; data before transfer:\n", 1537 xfer->endpoint->toggle_next); 1538 ohci_dump_tds(xfer->td_transfer_first); 1539 } 1540 #endif 1541 1542 ed = xfer->qh_start[xfer->flags_int.curr_dma_set]; 1543 1544 ed_flags = (OHCI_ED_SET_FA(xfer->address) | 1545 OHCI_ED_SET_EN(UE_GET_ADDR(xfer->endpointno)) | 1546 OHCI_ED_SET_MAXP(xfer->max_frame_size)); 1547 1548 ed_flags |= (OHCI_ED_FORMAT_GEN | OHCI_ED_DIR_TD); 1549 1550 if (xfer->xroot->udev->speed == USB_SPEED_LOW) { 1551 ed_flags |= OHCI_ED_SPEED; 1552 } 1553 ed->ed_flags = htole32(ed_flags); 1554 1555 td = xfer->td_transfer_first; 1556 1557 ed->ed_headp = td->td_self; 1558 1559 if (xfer->xroot->udev->flags.self_suspended == 0) { 1560 /* the append function will flush the endpoint descriptor */ 1561 OHCI_APPEND_QH(ed, *ed_last); 1562 1563 if (methods == &ohci_device_bulk_methods) { 1564 ohci_softc_t *sc = OHCI_BUS2SC(xfer->xroot->bus); 1565 1566 OWRITE4(sc, OHCI_COMMAND_STATUS, OHCI_BLF); 1567 } 1568 if (methods == &ohci_device_ctrl_methods) { 1569 ohci_softc_t *sc = OHCI_BUS2SC(xfer->xroot->bus); 1570 1571 OWRITE4(sc, OHCI_COMMAND_STATUS, OHCI_CLF); 1572 } 1573 } else { 1574 usb_pc_cpu_flush(ed->page_cache); 1575 } 1576 } 1577 1578 static void 1579 ohci_root_intr(ohci_softc_t *sc) 1580 { 1581 uint32_t hstatus; 1582 uint16_t i; 1583 uint16_t m; 1584 1585 USB_BUS_LOCK_ASSERT(&sc->sc_bus, MA_OWNED); 1586 1587 /* clear any old interrupt data */ 1588 memset(sc->sc_hub_idata, 0, sizeof(sc->sc_hub_idata)); 1589 1590 hstatus = OREAD4(sc, OHCI_RH_STATUS); 1591 DPRINTF("sc=%p hstatus=0x%08x\n", 1592 sc, hstatus); 1593 1594 /* set bits */ 1595 m = (sc->sc_noport + 1); 1596 if (m > (8 * sizeof(sc->sc_hub_idata))) { 1597 m = (8 * sizeof(sc->sc_hub_idata)); 1598 } 1599 for (i = 1; i < m; i++) { 1600 /* pick out CHANGE bits from the status register */ 1601 if (OREAD4(sc, OHCI_RH_PORT_STATUS(i)) >> 16) { 1602 sc->sc_hub_idata[i / 8] |= 1 << (i % 8); 1603 DPRINTF("port %d changed\n", i); 1604 } 1605 } 1606 1607 uhub_root_intr(&sc->sc_bus, sc->sc_hub_idata, 1608 sizeof(sc->sc_hub_idata)); 1609 } 1610 1611 /* NOTE: "done" can be run two times in a row, 1612 * from close and from interrupt 1613 */ 1614 static void 1615 ohci_device_done(struct usb_xfer *xfer, usb_error_t error) 1616 { 1617 const struct usb_pipe_methods *methods = xfer->endpoint->methods; 1618 ohci_softc_t *sc = OHCI_BUS2SC(xfer->xroot->bus); 1619 ohci_ed_t *ed; 1620 1621 USB_BUS_LOCK_ASSERT(&sc->sc_bus, MA_OWNED); 1622 1623 DPRINTFN(2, "xfer=%p, endpoint=%p, error=%d\n", 1624 xfer, xfer->endpoint, error); 1625 1626 ed = xfer->qh_start[xfer->flags_int.curr_dma_set]; 1627 if (ed) { 1628 usb_pc_cpu_invalidate(ed->page_cache); 1629 } 1630 if (methods == &ohci_device_bulk_methods) { 1631 OHCI_REMOVE_QH(ed, sc->sc_bulk_p_last); 1632 } 1633 if (methods == &ohci_device_ctrl_methods) { 1634 OHCI_REMOVE_QH(ed, sc->sc_ctrl_p_last); 1635 } 1636 if (methods == &ohci_device_intr_methods) { 1637 OHCI_REMOVE_QH(ed, sc->sc_intr_p_last[xfer->qh_pos]); 1638 } 1639 if (methods == &ohci_device_isoc_methods) { 1640 OHCI_REMOVE_QH(ed, sc->sc_isoc_p_last); 1641 } 1642 xfer->td_transfer_first = NULL; 1643 xfer->td_transfer_last = NULL; 1644 1645 /* dequeue transfer and start next transfer */ 1646 usbd_transfer_done(xfer, error); 1647 } 1648 1649 /*------------------------------------------------------------------------* 1650 * ohci bulk support 1651 *------------------------------------------------------------------------*/ 1652 static void 1653 ohci_device_bulk_open(struct usb_xfer *xfer) 1654 { 1655 return; 1656 } 1657 1658 static void 1659 ohci_device_bulk_close(struct usb_xfer *xfer) 1660 { 1661 ohci_device_done(xfer, USB_ERR_CANCELLED); 1662 } 1663 1664 static void 1665 ohci_device_bulk_enter(struct usb_xfer *xfer) 1666 { 1667 return; 1668 } 1669 1670 static void 1671 ohci_device_bulk_start(struct usb_xfer *xfer) 1672 { 1673 ohci_softc_t *sc = OHCI_BUS2SC(xfer->xroot->bus); 1674 1675 /* setup TD's and QH */ 1676 ohci_setup_standard_chain(xfer, &sc->sc_bulk_p_last); 1677 1678 /* put transfer on interrupt queue */ 1679 ohci_transfer_intr_enqueue(xfer); 1680 } 1681 1682 static const struct usb_pipe_methods ohci_device_bulk_methods = 1683 { 1684 .open = ohci_device_bulk_open, 1685 .close = ohci_device_bulk_close, 1686 .enter = ohci_device_bulk_enter, 1687 .start = ohci_device_bulk_start, 1688 }; 1689 1690 /*------------------------------------------------------------------------* 1691 * ohci control support 1692 *------------------------------------------------------------------------*/ 1693 static void 1694 ohci_device_ctrl_open(struct usb_xfer *xfer) 1695 { 1696 return; 1697 } 1698 1699 static void 1700 ohci_device_ctrl_close(struct usb_xfer *xfer) 1701 { 1702 ohci_device_done(xfer, USB_ERR_CANCELLED); 1703 } 1704 1705 static void 1706 ohci_device_ctrl_enter(struct usb_xfer *xfer) 1707 { 1708 return; 1709 } 1710 1711 static void 1712 ohci_device_ctrl_start(struct usb_xfer *xfer) 1713 { 1714 ohci_softc_t *sc = OHCI_BUS2SC(xfer->xroot->bus); 1715 1716 /* setup TD's and QH */ 1717 ohci_setup_standard_chain(xfer, &sc->sc_ctrl_p_last); 1718 1719 /* put transfer on interrupt queue */ 1720 ohci_transfer_intr_enqueue(xfer); 1721 } 1722 1723 static const struct usb_pipe_methods ohci_device_ctrl_methods = 1724 { 1725 .open = ohci_device_ctrl_open, 1726 .close = ohci_device_ctrl_close, 1727 .enter = ohci_device_ctrl_enter, 1728 .start = ohci_device_ctrl_start, 1729 }; 1730 1731 /*------------------------------------------------------------------------* 1732 * ohci interrupt support 1733 *------------------------------------------------------------------------*/ 1734 static void 1735 ohci_device_intr_open(struct usb_xfer *xfer) 1736 { 1737 ohci_softc_t *sc = OHCI_BUS2SC(xfer->xroot->bus); 1738 uint16_t best; 1739 uint16_t bit; 1740 uint16_t x; 1741 1742 best = 0; 1743 bit = OHCI_NO_EDS / 2; 1744 while (bit) { 1745 if (xfer->interval >= bit) { 1746 x = bit; 1747 best = bit; 1748 while (x & bit) { 1749 if (sc->sc_intr_stat[x] < 1750 sc->sc_intr_stat[best]) { 1751 best = x; 1752 } 1753 x++; 1754 } 1755 break; 1756 } 1757 bit >>= 1; 1758 } 1759 1760 sc->sc_intr_stat[best]++; 1761 xfer->qh_pos = best; 1762 1763 DPRINTFN(3, "best=%d interval=%d\n", 1764 best, xfer->interval); 1765 } 1766 1767 static void 1768 ohci_device_intr_close(struct usb_xfer *xfer) 1769 { 1770 ohci_softc_t *sc = OHCI_BUS2SC(xfer->xroot->bus); 1771 1772 sc->sc_intr_stat[xfer->qh_pos]--; 1773 1774 ohci_device_done(xfer, USB_ERR_CANCELLED); 1775 } 1776 1777 static void 1778 ohci_device_intr_enter(struct usb_xfer *xfer) 1779 { 1780 return; 1781 } 1782 1783 static void 1784 ohci_device_intr_start(struct usb_xfer *xfer) 1785 { 1786 ohci_softc_t *sc = OHCI_BUS2SC(xfer->xroot->bus); 1787 1788 /* setup TD's and QH */ 1789 ohci_setup_standard_chain(xfer, &sc->sc_intr_p_last[xfer->qh_pos]); 1790 1791 /* put transfer on interrupt queue */ 1792 ohci_transfer_intr_enqueue(xfer); 1793 } 1794 1795 static const struct usb_pipe_methods ohci_device_intr_methods = 1796 { 1797 .open = ohci_device_intr_open, 1798 .close = ohci_device_intr_close, 1799 .enter = ohci_device_intr_enter, 1800 .start = ohci_device_intr_start, 1801 }; 1802 1803 /*------------------------------------------------------------------------* 1804 * ohci isochronous support 1805 *------------------------------------------------------------------------*/ 1806 static void 1807 ohci_device_isoc_open(struct usb_xfer *xfer) 1808 { 1809 return; 1810 } 1811 1812 static void 1813 ohci_device_isoc_close(struct usb_xfer *xfer) 1814 { 1815 /**/ 1816 ohci_device_done(xfer, USB_ERR_CANCELLED); 1817 } 1818 1819 static void 1820 ohci_device_isoc_enter(struct usb_xfer *xfer) 1821 { 1822 struct usb_page_search buf_res; 1823 ohci_softc_t *sc = OHCI_BUS2SC(xfer->xroot->bus); 1824 struct ohci_hcca *hcca; 1825 uint32_t buf_offset; 1826 uint32_t nframes; 1827 uint32_t ed_flags; 1828 uint32_t *plen; 1829 uint16_t itd_offset[OHCI_ITD_NOFFSET]; 1830 uint16_t length; 1831 uint8_t ncur; 1832 ohci_itd_t *td; 1833 ohci_itd_t *td_last = NULL; 1834 ohci_ed_t *ed; 1835 1836 hcca = ohci_get_hcca(sc); 1837 1838 nframes = le32toh(hcca->hcca_frame_number); 1839 1840 DPRINTFN(6, "xfer=%p isoc_next=%u nframes=%u hcca_fn=%u\n", 1841 xfer, xfer->endpoint->isoc_next, xfer->nframes, nframes); 1842 1843 if ((xfer->endpoint->is_synced == 0) || 1844 (((nframes - xfer->endpoint->isoc_next) & 0xFFFF) < xfer->nframes) || 1845 (((xfer->endpoint->isoc_next - nframes) & 0xFFFF) >= 128)) { 1846 /* 1847 * If there is data underflow or the pipe queue is empty we 1848 * schedule the transfer a few frames ahead of the current 1849 * frame position. Else two isochronous transfers might 1850 * overlap. 1851 */ 1852 xfer->endpoint->isoc_next = (nframes + 3) & 0xFFFF; 1853 xfer->endpoint->is_synced = 1; 1854 DPRINTFN(3, "start next=%d\n", xfer->endpoint->isoc_next); 1855 } 1856 /* 1857 * compute how many milliseconds the insertion is ahead of the 1858 * current frame position: 1859 */ 1860 buf_offset = ((xfer->endpoint->isoc_next - nframes) & 0xFFFF); 1861 1862 /* 1863 * pre-compute when the isochronous transfer will be finished: 1864 */ 1865 xfer->isoc_time_complete = 1866 (usb_isoc_time_expand(&sc->sc_bus, nframes) + buf_offset + 1867 xfer->nframes); 1868 1869 /* get the real number of frames */ 1870 1871 nframes = xfer->nframes; 1872 1873 buf_offset = 0; 1874 1875 plen = xfer->frlengths; 1876 1877 /* toggle the DMA set we are using */ 1878 xfer->flags_int.curr_dma_set ^= 1; 1879 1880 /* get next DMA set */ 1881 td = xfer->td_start[xfer->flags_int.curr_dma_set]; 1882 1883 xfer->td_transfer_first = td; 1884 1885 ncur = 0; 1886 length = 0; 1887 1888 while (nframes--) { 1889 if (td == NULL) { 1890 panic("%s:%d: out of TD's\n", 1891 __FUNCTION__, __LINE__); 1892 } 1893 itd_offset[ncur] = length; 1894 buf_offset += *plen; 1895 length += *plen; 1896 plen++; 1897 ncur++; 1898 1899 if ( /* check if the ITD is full */ 1900 (ncur == OHCI_ITD_NOFFSET) || 1901 /* check if we have put more than 4K into the ITD */ 1902 (length & 0xF000) || 1903 /* check if it is the last frame */ 1904 (nframes == 0)) { 1905 /* fill current ITD */ 1906 td->itd_flags = htole32( 1907 OHCI_ITD_NOCC | 1908 OHCI_ITD_SET_SF(xfer->endpoint->isoc_next) | 1909 OHCI_ITD_NOINTR | 1910 OHCI_ITD_SET_FC(ncur)); 1911 1912 td->frames = ncur; 1913 xfer->endpoint->isoc_next += ncur; 1914 1915 if (length == 0) { 1916 /* all zero */ 1917 td->itd_bp0 = 0; 1918 td->itd_be = ~0; 1919 1920 while (ncur--) { 1921 td->itd_offset[ncur] = 1922 htole16(OHCI_ITD_MK_OFFS(0)); 1923 } 1924 } else { 1925 usbd_get_page(xfer->frbuffers, buf_offset - length, &buf_res); 1926 length = OHCI_PAGE_MASK(buf_res.physaddr); 1927 buf_res.physaddr = 1928 OHCI_PAGE(buf_res.physaddr); 1929 td->itd_bp0 = htole32(buf_res.physaddr); 1930 usbd_get_page(xfer->frbuffers, buf_offset - 1, &buf_res); 1931 td->itd_be = htole32(buf_res.physaddr); 1932 1933 while (ncur--) { 1934 itd_offset[ncur] += length; 1935 itd_offset[ncur] = 1936 OHCI_ITD_MK_OFFS(itd_offset[ncur]); 1937 td->itd_offset[ncur] = 1938 htole16(itd_offset[ncur]); 1939 } 1940 } 1941 ncur = 0; 1942 length = 0; 1943 td_last = td; 1944 td = td->obj_next; 1945 1946 if (td) { 1947 /* link the last TD with the next one */ 1948 td_last->itd_next = td->itd_self; 1949 } 1950 usb_pc_cpu_flush(td_last->page_cache); 1951 } 1952 } 1953 1954 /* update the last TD */ 1955 td_last->itd_flags &= ~htole32(OHCI_ITD_NOINTR); 1956 td_last->itd_flags |= htole32(OHCI_ITD_SET_DI(0)); 1957 td_last->itd_next = 0; 1958 1959 usb_pc_cpu_flush(td_last->page_cache); 1960 1961 xfer->td_transfer_last = td_last; 1962 1963 #ifdef USB_DEBUG 1964 if (ohcidebug > 8) { 1965 DPRINTF("data before transfer:\n"); 1966 ohci_dump_itds(xfer->td_transfer_first); 1967 } 1968 #endif 1969 ed = xfer->qh_start[xfer->flags_int.curr_dma_set]; 1970 1971 if (UE_GET_DIR(xfer->endpointno) == UE_DIR_IN) 1972 ed_flags = (OHCI_ED_DIR_IN | OHCI_ED_FORMAT_ISO); 1973 else 1974 ed_flags = (OHCI_ED_DIR_OUT | OHCI_ED_FORMAT_ISO); 1975 1976 ed_flags |= (OHCI_ED_SET_FA(xfer->address) | 1977 OHCI_ED_SET_EN(UE_GET_ADDR(xfer->endpointno)) | 1978 OHCI_ED_SET_MAXP(xfer->max_frame_size)); 1979 1980 if (xfer->xroot->udev->speed == USB_SPEED_LOW) { 1981 ed_flags |= OHCI_ED_SPEED; 1982 } 1983 ed->ed_flags = htole32(ed_flags); 1984 1985 td = xfer->td_transfer_first; 1986 1987 ed->ed_headp = td->itd_self; 1988 1989 /* isochronous transfers are not affected by suspend / resume */ 1990 /* the append function will flush the endpoint descriptor */ 1991 1992 OHCI_APPEND_QH(ed, sc->sc_isoc_p_last); 1993 } 1994 1995 static void 1996 ohci_device_isoc_start(struct usb_xfer *xfer) 1997 { 1998 /* put transfer on interrupt queue */ 1999 ohci_transfer_intr_enqueue(xfer); 2000 } 2001 2002 static const struct usb_pipe_methods ohci_device_isoc_methods = 2003 { 2004 .open = ohci_device_isoc_open, 2005 .close = ohci_device_isoc_close, 2006 .enter = ohci_device_isoc_enter, 2007 .start = ohci_device_isoc_start, 2008 }; 2009 2010 /*------------------------------------------------------------------------* 2011 * ohci root control support 2012 *------------------------------------------------------------------------* 2013 * Simulate a hardware hub by handling all the necessary requests. 2014 *------------------------------------------------------------------------*/ 2015 2016 static const 2017 struct usb_device_descriptor ohci_devd = 2018 { 2019 sizeof(struct usb_device_descriptor), 2020 UDESC_DEVICE, /* type */ 2021 {0x00, 0x01}, /* USB version */ 2022 UDCLASS_HUB, /* class */ 2023 UDSUBCLASS_HUB, /* subclass */ 2024 UDPROTO_FSHUB, /* protocol */ 2025 64, /* max packet */ 2026 {0}, {0}, {0x00, 0x01}, /* device id */ 2027 1, 2, 0, /* string indexes */ 2028 1 /* # of configurations */ 2029 }; 2030 2031 static const 2032 struct ohci_config_desc ohci_confd = 2033 { 2034 .confd = { 2035 .bLength = sizeof(struct usb_config_descriptor), 2036 .bDescriptorType = UDESC_CONFIG, 2037 .wTotalLength[0] = sizeof(ohci_confd), 2038 .bNumInterface = 1, 2039 .bConfigurationValue = 1, 2040 .iConfiguration = 0, 2041 .bmAttributes = UC_SELF_POWERED, 2042 .bMaxPower = 0, /* max power */ 2043 }, 2044 .ifcd = { 2045 .bLength = sizeof(struct usb_interface_descriptor), 2046 .bDescriptorType = UDESC_INTERFACE, 2047 .bNumEndpoints = 1, 2048 .bInterfaceClass = UICLASS_HUB, 2049 .bInterfaceSubClass = UISUBCLASS_HUB, 2050 .bInterfaceProtocol = 0, 2051 }, 2052 .endpd = { 2053 .bLength = sizeof(struct usb_endpoint_descriptor), 2054 .bDescriptorType = UDESC_ENDPOINT, 2055 .bEndpointAddress = UE_DIR_IN | OHCI_INTR_ENDPT, 2056 .bmAttributes = UE_INTERRUPT, 2057 .wMaxPacketSize[0] = 32,/* max packet (255 ports) */ 2058 .bInterval = 255, 2059 }, 2060 }; 2061 2062 static const 2063 struct usb_hub_descriptor ohci_hubd = 2064 { 2065 .bDescLength = 0, /* dynamic length */ 2066 .bDescriptorType = UDESC_HUB, 2067 }; 2068 2069 static usb_error_t 2070 ohci_roothub_exec(struct usb_device *udev, 2071 struct usb_device_request *req, const void **pptr, uint16_t *plength) 2072 { 2073 ohci_softc_t *sc = OHCI_BUS2SC(udev->bus); 2074 const void *ptr; 2075 const char *str_ptr; 2076 uint32_t port; 2077 uint32_t v; 2078 uint16_t len; 2079 uint16_t value; 2080 uint16_t index; 2081 uint8_t l; 2082 usb_error_t err; 2083 2084 USB_BUS_LOCK_ASSERT(&sc->sc_bus, MA_OWNED); 2085 2086 /* buffer reset */ 2087 ptr = (const void *)&sc->sc_hub_desc.temp; 2088 len = 0; 2089 err = 0; 2090 2091 value = UGETW(req->wValue); 2092 index = UGETW(req->wIndex); 2093 2094 DPRINTFN(3, "type=0x%02x request=0x%02x wLen=0x%04x " 2095 "wValue=0x%04x wIndex=0x%04x\n", 2096 req->bmRequestType, req->bRequest, 2097 UGETW(req->wLength), value, index); 2098 2099 #define C(x,y) ((x) | ((y) << 8)) 2100 switch (C(req->bRequest, req->bmRequestType)) { 2101 case C(UR_CLEAR_FEATURE, UT_WRITE_DEVICE): 2102 case C(UR_CLEAR_FEATURE, UT_WRITE_INTERFACE): 2103 case C(UR_CLEAR_FEATURE, UT_WRITE_ENDPOINT): 2104 /* 2105 * DEVICE_REMOTE_WAKEUP and ENDPOINT_HALT are no-ops 2106 * for the integrated root hub. 2107 */ 2108 break; 2109 case C(UR_GET_CONFIG, UT_READ_DEVICE): 2110 len = 1; 2111 sc->sc_hub_desc.temp[0] = sc->sc_conf; 2112 break; 2113 case C(UR_GET_DESCRIPTOR, UT_READ_DEVICE): 2114 switch (value >> 8) { 2115 case UDESC_DEVICE: 2116 if ((value & 0xff) != 0) { 2117 err = USB_ERR_IOERROR; 2118 goto done; 2119 } 2120 len = sizeof(ohci_devd); 2121 ptr = (const void *)&ohci_devd; 2122 break; 2123 2124 case UDESC_CONFIG: 2125 if ((value & 0xff) != 0) { 2126 err = USB_ERR_IOERROR; 2127 goto done; 2128 } 2129 len = sizeof(ohci_confd); 2130 ptr = (const void *)&ohci_confd; 2131 break; 2132 2133 case UDESC_STRING: 2134 switch (value & 0xff) { 2135 case 0: /* Language table */ 2136 str_ptr = "\001"; 2137 break; 2138 2139 case 1: /* Vendor */ 2140 str_ptr = sc->sc_vendor; 2141 break; 2142 2143 case 2: /* Product */ 2144 str_ptr = "OHCI root HUB"; 2145 break; 2146 2147 default: 2148 str_ptr = ""; 2149 break; 2150 } 2151 2152 len = usb_make_str_desc( 2153 sc->sc_hub_desc.temp, 2154 sizeof(sc->sc_hub_desc.temp), 2155 str_ptr); 2156 break; 2157 2158 default: 2159 err = USB_ERR_IOERROR; 2160 goto done; 2161 } 2162 break; 2163 case C(UR_GET_INTERFACE, UT_READ_INTERFACE): 2164 len = 1; 2165 sc->sc_hub_desc.temp[0] = 0; 2166 break; 2167 case C(UR_GET_STATUS, UT_READ_DEVICE): 2168 len = 2; 2169 USETW(sc->sc_hub_desc.stat.wStatus, UDS_SELF_POWERED); 2170 break; 2171 case C(UR_GET_STATUS, UT_READ_INTERFACE): 2172 case C(UR_GET_STATUS, UT_READ_ENDPOINT): 2173 len = 2; 2174 USETW(sc->sc_hub_desc.stat.wStatus, 0); 2175 break; 2176 case C(UR_SET_ADDRESS, UT_WRITE_DEVICE): 2177 if (value >= OHCI_MAX_DEVICES) { 2178 err = USB_ERR_IOERROR; 2179 goto done; 2180 } 2181 sc->sc_addr = value; 2182 break; 2183 case C(UR_SET_CONFIG, UT_WRITE_DEVICE): 2184 if ((value != 0) && (value != 1)) { 2185 err = USB_ERR_IOERROR; 2186 goto done; 2187 } 2188 sc->sc_conf = value; 2189 break; 2190 case C(UR_SET_DESCRIPTOR, UT_WRITE_DEVICE): 2191 break; 2192 case C(UR_SET_FEATURE, UT_WRITE_DEVICE): 2193 case C(UR_SET_FEATURE, UT_WRITE_INTERFACE): 2194 case C(UR_SET_FEATURE, UT_WRITE_ENDPOINT): 2195 err = USB_ERR_IOERROR; 2196 goto done; 2197 case C(UR_SET_INTERFACE, UT_WRITE_INTERFACE): 2198 break; 2199 case C(UR_SYNCH_FRAME, UT_WRITE_ENDPOINT): 2200 break; 2201 /* Hub requests */ 2202 case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_DEVICE): 2203 break; 2204 case C(UR_CLEAR_FEATURE, UT_WRITE_CLASS_OTHER): 2205 DPRINTFN(9, "UR_CLEAR_PORT_FEATURE " 2206 "port=%d feature=%d\n", 2207 index, value); 2208 if ((index < 1) || 2209 (index > sc->sc_noport)) { 2210 err = USB_ERR_IOERROR; 2211 goto done; 2212 } 2213 port = OHCI_RH_PORT_STATUS(index); 2214 switch (value) { 2215 case UHF_PORT_ENABLE: 2216 OWRITE4(sc, port, UPS_CURRENT_CONNECT_STATUS); 2217 break; 2218 case UHF_PORT_SUSPEND: 2219 OWRITE4(sc, port, UPS_OVERCURRENT_INDICATOR); 2220 break; 2221 case UHF_PORT_POWER: 2222 /* Yes, writing to the LOW_SPEED bit clears power. */ 2223 OWRITE4(sc, port, UPS_LOW_SPEED); 2224 break; 2225 case UHF_C_PORT_CONNECTION: 2226 OWRITE4(sc, port, UPS_C_CONNECT_STATUS << 16); 2227 break; 2228 case UHF_C_PORT_ENABLE: 2229 OWRITE4(sc, port, UPS_C_PORT_ENABLED << 16); 2230 break; 2231 case UHF_C_PORT_SUSPEND: 2232 OWRITE4(sc, port, UPS_C_SUSPEND << 16); 2233 break; 2234 case UHF_C_PORT_OVER_CURRENT: 2235 OWRITE4(sc, port, UPS_C_OVERCURRENT_INDICATOR << 16); 2236 break; 2237 case UHF_C_PORT_RESET: 2238 OWRITE4(sc, port, UPS_C_PORT_RESET << 16); 2239 break; 2240 default: 2241 err = USB_ERR_IOERROR; 2242 goto done; 2243 } 2244 switch (value) { 2245 case UHF_C_PORT_CONNECTION: 2246 case UHF_C_PORT_ENABLE: 2247 case UHF_C_PORT_SUSPEND: 2248 case UHF_C_PORT_OVER_CURRENT: 2249 case UHF_C_PORT_RESET: 2250 /* enable RHSC interrupt if condition is cleared. */ 2251 if ((OREAD4(sc, port) >> 16) == 0) 2252 ohci_rhsc_enable(sc); 2253 break; 2254 default: 2255 break; 2256 } 2257 break; 2258 case C(UR_GET_DESCRIPTOR, UT_READ_CLASS_DEVICE): 2259 if ((value & 0xff) != 0) { 2260 err = USB_ERR_IOERROR; 2261 goto done; 2262 } 2263 v = OREAD4(sc, OHCI_RH_DESCRIPTOR_A); 2264 2265 sc->sc_hub_desc.hubd = ohci_hubd; 2266 sc->sc_hub_desc.hubd.bNbrPorts = sc->sc_noport; 2267 USETW(sc->sc_hub_desc.hubd.wHubCharacteristics, 2268 (v & OHCI_NPS ? UHD_PWR_NO_SWITCH : 2269 v & OHCI_PSM ? UHD_PWR_GANGED : UHD_PWR_INDIVIDUAL) 2270 /* XXX overcurrent */ 2271 ); 2272 sc->sc_hub_desc.hubd.bPwrOn2PwrGood = OHCI_GET_POTPGT(v); 2273 v = OREAD4(sc, OHCI_RH_DESCRIPTOR_B); 2274 2275 for (l = 0; l < sc->sc_noport; l++) { 2276 if (v & 1) { 2277 sc->sc_hub_desc.hubd.DeviceRemovable[l / 8] |= (1 << (l % 8)); 2278 } 2279 v >>= 1; 2280 } 2281 sc->sc_hub_desc.hubd.bDescLength = 2282 8 + ((sc->sc_noport + 7) / 8); 2283 len = sc->sc_hub_desc.hubd.bDescLength; 2284 break; 2285 2286 case C(UR_GET_STATUS, UT_READ_CLASS_DEVICE): 2287 len = 16; 2288 memset(sc->sc_hub_desc.temp, 0, 16); 2289 break; 2290 case C(UR_GET_STATUS, UT_READ_CLASS_OTHER): 2291 DPRINTFN(9, "get port status i=%d\n", 2292 index); 2293 if ((index < 1) || 2294 (index > sc->sc_noport)) { 2295 err = USB_ERR_IOERROR; 2296 goto done; 2297 } 2298 v = OREAD4(sc, OHCI_RH_PORT_STATUS(index)); 2299 DPRINTFN(9, "port status=0x%04x\n", v); 2300 v &= ~UPS_PORT_MODE_DEVICE; /* force host mode */ 2301 USETW(sc->sc_hub_desc.ps.wPortStatus, v); 2302 USETW(sc->sc_hub_desc.ps.wPortChange, v >> 16); 2303 len = sizeof(sc->sc_hub_desc.ps); 2304 break; 2305 case C(UR_SET_DESCRIPTOR, UT_WRITE_CLASS_DEVICE): 2306 err = USB_ERR_IOERROR; 2307 goto done; 2308 case C(UR_SET_FEATURE, UT_WRITE_CLASS_DEVICE): 2309 break; 2310 case C(UR_SET_FEATURE, UT_WRITE_CLASS_OTHER): 2311 if ((index < 1) || 2312 (index > sc->sc_noport)) { 2313 err = USB_ERR_IOERROR; 2314 goto done; 2315 } 2316 port = OHCI_RH_PORT_STATUS(index); 2317 switch (value) { 2318 case UHF_PORT_ENABLE: 2319 OWRITE4(sc, port, UPS_PORT_ENABLED); 2320 break; 2321 case UHF_PORT_SUSPEND: 2322 OWRITE4(sc, port, UPS_SUSPEND); 2323 break; 2324 case UHF_PORT_RESET: 2325 DPRINTFN(6, "reset port %d\n", index); 2326 OWRITE4(sc, port, UPS_RESET); 2327 for (v = 0;; v++) { 2328 if (v < 12) { 2329 usb_pause_mtx(&sc->sc_bus.bus_mtx, 2330 USB_MS_TO_TICKS(usb_port_root_reset_delay)); 2331 2332 if ((OREAD4(sc, port) & UPS_RESET) == 0) { 2333 break; 2334 } 2335 } else { 2336 err = USB_ERR_TIMEOUT; 2337 goto done; 2338 } 2339 } 2340 DPRINTFN(9, "ohci port %d reset, status = 0x%04x\n", 2341 index, OREAD4(sc, port)); 2342 break; 2343 case UHF_PORT_POWER: 2344 DPRINTFN(3, "set port power %d\n", index); 2345 OWRITE4(sc, port, UPS_PORT_POWER); 2346 break; 2347 default: 2348 err = USB_ERR_IOERROR; 2349 goto done; 2350 } 2351 break; 2352 default: 2353 err = USB_ERR_IOERROR; 2354 goto done; 2355 } 2356 done: 2357 *plength = len; 2358 *pptr = ptr; 2359 return (err); 2360 } 2361 2362 static void 2363 ohci_xfer_setup(struct usb_setup_params *parm) 2364 { 2365 struct usb_page_search page_info; 2366 struct usb_page_cache *pc; 2367 struct usb_xfer *xfer; 2368 void *last_obj; 2369 uint32_t ntd; 2370 uint32_t nitd; 2371 uint32_t nqh; 2372 uint32_t n; 2373 2374 xfer = parm->curr_xfer; 2375 2376 parm->hc_max_packet_size = 0x500; 2377 parm->hc_max_packet_count = 1; 2378 parm->hc_max_frame_size = OHCI_PAGE_SIZE; 2379 2380 /* 2381 * calculate ntd and nqh 2382 */ 2383 if (parm->methods == &ohci_device_ctrl_methods) { 2384 xfer->flags_int.bdma_enable = 1; 2385 2386 usbd_transfer_setup_sub(parm); 2387 2388 nitd = 0; 2389 ntd = ((2 * xfer->nframes) + 1 /* STATUS */ 2390 + (xfer->max_data_length / xfer->max_hc_frame_size)); 2391 nqh = 1; 2392 2393 } else if (parm->methods == &ohci_device_bulk_methods) { 2394 xfer->flags_int.bdma_enable = 1; 2395 2396 usbd_transfer_setup_sub(parm); 2397 2398 nitd = 0; 2399 ntd = ((2 * xfer->nframes) 2400 + (xfer->max_data_length / xfer->max_hc_frame_size)); 2401 nqh = 1; 2402 2403 } else if (parm->methods == &ohci_device_intr_methods) { 2404 xfer->flags_int.bdma_enable = 1; 2405 2406 usbd_transfer_setup_sub(parm); 2407 2408 nitd = 0; 2409 ntd = ((2 * xfer->nframes) 2410 + (xfer->max_data_length / xfer->max_hc_frame_size)); 2411 nqh = 1; 2412 2413 } else if (parm->methods == &ohci_device_isoc_methods) { 2414 xfer->flags_int.bdma_enable = 1; 2415 2416 usbd_transfer_setup_sub(parm); 2417 2418 nitd = ((xfer->max_data_length / OHCI_PAGE_SIZE) + 2419 howmany(xfer->nframes, OHCI_ITD_NOFFSET) + 2420 1 /* EXTRA */ ); 2421 ntd = 0; 2422 nqh = 1; 2423 2424 } else { 2425 usbd_transfer_setup_sub(parm); 2426 2427 nitd = 0; 2428 ntd = 0; 2429 nqh = 0; 2430 } 2431 2432 alloc_dma_set: 2433 2434 if (parm->err) { 2435 return; 2436 } 2437 last_obj = NULL; 2438 2439 if (usbd_transfer_setup_sub_malloc( 2440 parm, &pc, sizeof(ohci_td_t), 2441 OHCI_TD_ALIGN, ntd)) { 2442 parm->err = USB_ERR_NOMEM; 2443 return; 2444 } 2445 if (parm->buf) { 2446 for (n = 0; n != ntd; n++) { 2447 ohci_td_t *td; 2448 2449 usbd_get_page(pc + n, 0, &page_info); 2450 2451 td = page_info.buffer; 2452 2453 /* init TD */ 2454 td->td_self = htole32(page_info.physaddr); 2455 td->obj_next = last_obj; 2456 td->page_cache = pc + n; 2457 2458 last_obj = td; 2459 2460 usb_pc_cpu_flush(pc + n); 2461 } 2462 } 2463 if (usbd_transfer_setup_sub_malloc( 2464 parm, &pc, sizeof(ohci_itd_t), 2465 OHCI_ITD_ALIGN, nitd)) { 2466 parm->err = USB_ERR_NOMEM; 2467 return; 2468 } 2469 if (parm->buf) { 2470 for (n = 0; n != nitd; n++) { 2471 ohci_itd_t *itd; 2472 2473 usbd_get_page(pc + n, 0, &page_info); 2474 2475 itd = page_info.buffer; 2476 2477 /* init TD */ 2478 itd->itd_self = htole32(page_info.physaddr); 2479 itd->obj_next = last_obj; 2480 itd->page_cache = pc + n; 2481 2482 last_obj = itd; 2483 2484 usb_pc_cpu_flush(pc + n); 2485 } 2486 } 2487 xfer->td_start[xfer->flags_int.curr_dma_set] = last_obj; 2488 2489 last_obj = NULL; 2490 2491 if (usbd_transfer_setup_sub_malloc( 2492 parm, &pc, sizeof(ohci_ed_t), 2493 OHCI_ED_ALIGN, nqh)) { 2494 parm->err = USB_ERR_NOMEM; 2495 return; 2496 } 2497 if (parm->buf) { 2498 for (n = 0; n != nqh; n++) { 2499 ohci_ed_t *ed; 2500 2501 usbd_get_page(pc + n, 0, &page_info); 2502 2503 ed = page_info.buffer; 2504 2505 /* init QH */ 2506 ed->ed_self = htole32(page_info.physaddr); 2507 ed->obj_next = last_obj; 2508 ed->page_cache = pc + n; 2509 2510 last_obj = ed; 2511 2512 usb_pc_cpu_flush(pc + n); 2513 } 2514 } 2515 xfer->qh_start[xfer->flags_int.curr_dma_set] = last_obj; 2516 2517 if (!xfer->flags_int.curr_dma_set) { 2518 xfer->flags_int.curr_dma_set = 1; 2519 goto alloc_dma_set; 2520 } 2521 } 2522 2523 static void 2524 ohci_ep_init(struct usb_device *udev, struct usb_endpoint_descriptor *edesc, 2525 struct usb_endpoint *ep) 2526 { 2527 ohci_softc_t *sc = OHCI_BUS2SC(udev->bus); 2528 2529 DPRINTFN(2, "endpoint=%p, addr=%d, endpt=%d, mode=%d (%d)\n", 2530 ep, udev->address, 2531 edesc->bEndpointAddress, udev->flags.usb_mode, 2532 sc->sc_addr); 2533 2534 if (udev->device_index != sc->sc_addr) { 2535 switch (edesc->bmAttributes & UE_XFERTYPE) { 2536 case UE_CONTROL: 2537 ep->methods = &ohci_device_ctrl_methods; 2538 break; 2539 case UE_INTERRUPT: 2540 ep->methods = &ohci_device_intr_methods; 2541 break; 2542 case UE_ISOCHRONOUS: 2543 if (udev->speed == USB_SPEED_FULL) { 2544 ep->methods = &ohci_device_isoc_methods; 2545 } 2546 break; 2547 case UE_BULK: 2548 ep->methods = &ohci_device_bulk_methods; 2549 break; 2550 default: 2551 /* do nothing */ 2552 break; 2553 } 2554 } 2555 } 2556 2557 static void 2558 ohci_xfer_unsetup(struct usb_xfer *xfer) 2559 { 2560 return; 2561 } 2562 2563 static void 2564 ohci_get_dma_delay(struct usb_device *udev, uint32_t *pus) 2565 { 2566 /* 2567 * Wait until hardware has finished any possible use of the 2568 * transfer descriptor(s) and QH 2569 */ 2570 *pus = (1125); /* microseconds */ 2571 } 2572 2573 static void 2574 ohci_device_resume(struct usb_device *udev) 2575 { 2576 struct ohci_softc *sc = OHCI_BUS2SC(udev->bus); 2577 struct usb_xfer *xfer; 2578 const struct usb_pipe_methods *methods; 2579 ohci_ed_t *ed; 2580 2581 DPRINTF("\n"); 2582 2583 USB_BUS_LOCK(udev->bus); 2584 2585 TAILQ_FOREACH(xfer, &sc->sc_bus.intr_q.head, wait_entry) { 2586 if (xfer->xroot->udev == udev) { 2587 methods = xfer->endpoint->methods; 2588 ed = xfer->qh_start[xfer->flags_int.curr_dma_set]; 2589 2590 if (methods == &ohci_device_bulk_methods) { 2591 OHCI_APPEND_QH(ed, sc->sc_bulk_p_last); 2592 OWRITE4(sc, OHCI_COMMAND_STATUS, OHCI_BLF); 2593 } 2594 if (methods == &ohci_device_ctrl_methods) { 2595 OHCI_APPEND_QH(ed, sc->sc_ctrl_p_last); 2596 OWRITE4(sc, OHCI_COMMAND_STATUS, OHCI_CLF); 2597 } 2598 if (methods == &ohci_device_intr_methods) { 2599 OHCI_APPEND_QH(ed, sc->sc_intr_p_last[xfer->qh_pos]); 2600 } 2601 } 2602 } 2603 2604 USB_BUS_UNLOCK(udev->bus); 2605 2606 return; 2607 } 2608 2609 static void 2610 ohci_device_suspend(struct usb_device *udev) 2611 { 2612 struct ohci_softc *sc = OHCI_BUS2SC(udev->bus); 2613 struct usb_xfer *xfer; 2614 const struct usb_pipe_methods *methods; 2615 ohci_ed_t *ed; 2616 2617 DPRINTF("\n"); 2618 2619 USB_BUS_LOCK(udev->bus); 2620 2621 TAILQ_FOREACH(xfer, &sc->sc_bus.intr_q.head, wait_entry) { 2622 if (xfer->xroot->udev == udev) { 2623 methods = xfer->endpoint->methods; 2624 ed = xfer->qh_start[xfer->flags_int.curr_dma_set]; 2625 2626 if (methods == &ohci_device_bulk_methods) { 2627 OHCI_REMOVE_QH(ed, sc->sc_bulk_p_last); 2628 } 2629 if (methods == &ohci_device_ctrl_methods) { 2630 OHCI_REMOVE_QH(ed, sc->sc_ctrl_p_last); 2631 } 2632 if (methods == &ohci_device_intr_methods) { 2633 OHCI_REMOVE_QH(ed, sc->sc_intr_p_last[xfer->qh_pos]); 2634 } 2635 } 2636 } 2637 2638 USB_BUS_UNLOCK(udev->bus); 2639 2640 return; 2641 } 2642 2643 static void 2644 ohci_set_hw_power_sleep(struct usb_bus *bus, uint32_t state) 2645 { 2646 struct ohci_softc *sc = OHCI_BUS2SC(bus); 2647 2648 switch (state) { 2649 case USB_HW_POWER_SUSPEND: 2650 case USB_HW_POWER_SHUTDOWN: 2651 ohci_suspend(sc); 2652 break; 2653 case USB_HW_POWER_RESUME: 2654 ohci_resume(sc); 2655 break; 2656 default: 2657 break; 2658 } 2659 } 2660 2661 static void 2662 ohci_set_hw_power(struct usb_bus *bus) 2663 { 2664 struct ohci_softc *sc = OHCI_BUS2SC(bus); 2665 uint32_t temp; 2666 uint32_t flags; 2667 2668 DPRINTF("\n"); 2669 2670 USB_BUS_LOCK(bus); 2671 2672 flags = bus->hw_power_state; 2673 2674 temp = OREAD4(sc, OHCI_CONTROL); 2675 temp &= ~(OHCI_PLE | OHCI_IE | OHCI_CLE | OHCI_BLE); 2676 2677 if (flags & USB_HW_POWER_CONTROL) 2678 temp |= OHCI_CLE; 2679 2680 if (flags & USB_HW_POWER_BULK) 2681 temp |= OHCI_BLE; 2682 2683 if (flags & USB_HW_POWER_INTERRUPT) 2684 temp |= OHCI_PLE; 2685 2686 if (flags & USB_HW_POWER_ISOC) 2687 temp |= OHCI_IE | OHCI_PLE; 2688 2689 OWRITE4(sc, OHCI_CONTROL, temp); 2690 2691 USB_BUS_UNLOCK(bus); 2692 2693 return; 2694 } 2695 2696 static const struct usb_bus_methods ohci_bus_methods = 2697 { 2698 .endpoint_init = ohci_ep_init, 2699 .xfer_setup = ohci_xfer_setup, 2700 .xfer_unsetup = ohci_xfer_unsetup, 2701 .get_dma_delay = ohci_get_dma_delay, 2702 .device_resume = ohci_device_resume, 2703 .device_suspend = ohci_device_suspend, 2704 .set_hw_power = ohci_set_hw_power, 2705 .set_hw_power_sleep = ohci_set_hw_power_sleep, 2706 .roothub_exec = ohci_roothub_exec, 2707 .xfer_poll = ohci_do_poll, 2708 }; 2709