77#include <dev/usb/controller/atmegadci.h> 78 79#define ATMEGA_BUS2SC(bus) \ 80 ((struct atmegadci_softc *)(((uint8_t *)(bus)) - \ 81 ((uint8_t *)&(((struct atmegadci_softc *)0)->sc_bus)))) 82 83#define ATMEGA_PC2SC(pc) \ 84 ATMEGA_BUS2SC(USB_DMATAG_TO_XROOT((pc)->tag_parent)->bus) 85 86#ifdef USB_DEBUG 87static int atmegadci_debug = 0; 88 89static SYSCTL_NODE(_hw_usb, OID_AUTO, atmegadci, CTLFLAG_RW, 0, 90 "USB ATMEGA DCI"); 91SYSCTL_INT(_hw_usb_atmegadci, OID_AUTO, debug, CTLFLAG_RW, 92 &atmegadci_debug, 0, "ATMEGA DCI debug level"); 93#endif 94 95#define ATMEGA_INTR_ENDPT 1 96 97/* prototypes */ 98 99struct usb_bus_methods atmegadci_bus_methods; 100struct usb_pipe_methods atmegadci_device_non_isoc_methods; 101struct usb_pipe_methods atmegadci_device_isoc_fs_methods; 102 103static atmegadci_cmd_t atmegadci_setup_rx; 104static atmegadci_cmd_t atmegadci_data_rx; 105static atmegadci_cmd_t atmegadci_data_tx; 106static atmegadci_cmd_t atmegadci_data_tx_sync; 107static void atmegadci_device_done(struct usb_xfer *, usb_error_t); 108static void atmegadci_do_poll(struct usb_bus *); 109static void atmegadci_standard_done(struct usb_xfer *); 110static void atmegadci_root_intr(struct atmegadci_softc *sc); 111 112/* 113 * Here is a list of what the chip supports: 114 */ 115static const struct usb_hw_ep_profile 116 atmegadci_ep_profile[2] = { 117 118 [0] = { 119 .max_in_frame_size = 64, 120 .max_out_frame_size = 64, 121 .is_simplex = 1, 122 .support_control = 1, 123 }, 124 [1] = { 125 .max_in_frame_size = 64, 126 .max_out_frame_size = 64, 127 .is_simplex = 1, 128 .support_bulk = 1, 129 .support_interrupt = 1, 130 .support_isochronous = 1, 131 .support_in = 1, 132 .support_out = 1, 133 }, 134}; 135 136static void 137atmegadci_get_hw_ep_profile(struct usb_device *udev, 138 const struct usb_hw_ep_profile **ppf, uint8_t ep_addr) 139{ 140 if (ep_addr == 0) 141 *ppf = atmegadci_ep_profile; 142 else if (ep_addr < ATMEGA_EP_MAX) 143 *ppf = atmegadci_ep_profile + 1; 144 else 145 *ppf = NULL; 146} 147 148static void 149atmegadci_clocks_on(struct atmegadci_softc *sc) 150{ 151 if (sc->sc_flags.clocks_off && 152 sc->sc_flags.port_powered) { 153 154 DPRINTFN(5, "\n"); 155 156 /* turn on clocks */ 157 (sc->sc_clocks_on) (&sc->sc_bus); 158 159 ATMEGA_WRITE_1(sc, ATMEGA_USBCON, 160 ATMEGA_USBCON_USBE | 161 ATMEGA_USBCON_OTGPADE | 162 ATMEGA_USBCON_VBUSTE); 163 164 sc->sc_flags.clocks_off = 0; 165 166 /* enable transceiver ? */ 167 } 168} 169 170static void 171atmegadci_clocks_off(struct atmegadci_softc *sc) 172{ 173 if (!sc->sc_flags.clocks_off) { 174 175 DPRINTFN(5, "\n"); 176 177 /* disable Transceiver ? */ 178 179 ATMEGA_WRITE_1(sc, ATMEGA_USBCON, 180 ATMEGA_USBCON_USBE | 181 ATMEGA_USBCON_OTGPADE | 182 ATMEGA_USBCON_FRZCLK | 183 ATMEGA_USBCON_VBUSTE); 184 185 /* turn clocks off */ 186 (sc->sc_clocks_off) (&sc->sc_bus); 187 188 sc->sc_flags.clocks_off = 1; 189 } 190} 191 192static void 193atmegadci_pull_up(struct atmegadci_softc *sc) 194{ 195 /* pullup D+, if possible */ 196 197 if (!sc->sc_flags.d_pulled_up && 198 sc->sc_flags.port_powered) { 199 sc->sc_flags.d_pulled_up = 1; 200 ATMEGA_WRITE_1(sc, ATMEGA_UDCON, 0); 201 } 202} 203 204static void 205atmegadci_pull_down(struct atmegadci_softc *sc) 206{ 207 /* pulldown D+, if possible */ 208 209 if (sc->sc_flags.d_pulled_up) { 210 sc->sc_flags.d_pulled_up = 0; 211 ATMEGA_WRITE_1(sc, ATMEGA_UDCON, ATMEGA_UDCON_DETACH); 212 } 213} 214 215static void 216atmegadci_wakeup_peer(struct atmegadci_softc *sc) 217{ 218 uint8_t temp; 219 220 if (!sc->sc_flags.status_suspend) { 221 return; 222 } 223 224 temp = ATMEGA_READ_1(sc, ATMEGA_UDCON); 225 ATMEGA_WRITE_1(sc, ATMEGA_UDCON, temp | ATMEGA_UDCON_RMWKUP); 226 227 /* wait 8 milliseconds */ 228 /* Wait for reset to complete. */ 229 usb_pause_mtx(&sc->sc_bus.bus_mtx, hz / 125); 230 231 /* hardware should have cleared RMWKUP bit */ 232} 233 234static void 235atmegadci_set_address(struct atmegadci_softc *sc, uint8_t addr) 236{ 237 DPRINTFN(5, "addr=%d\n", addr); 238 239 addr |= ATMEGA_UDADDR_ADDEN; 240 241 ATMEGA_WRITE_1(sc, ATMEGA_UDADDR, addr); 242} 243 244static uint8_t 245atmegadci_setup_rx(struct atmegadci_td *td) 246{ 247 struct atmegadci_softc *sc; 248 struct usb_device_request req; 249 uint16_t count; 250 uint8_t temp; 251 252 /* get pointer to softc */ 253 sc = ATMEGA_PC2SC(td->pc); 254 255 /* select endpoint number */ 256 ATMEGA_WRITE_1(sc, ATMEGA_UENUM, td->ep_no); 257 258 /* check endpoint status */ 259 temp = ATMEGA_READ_1(sc, ATMEGA_UEINTX); 260 261 DPRINTFN(5, "UEINTX=0x%02x\n", temp); 262 263 if (!(temp & ATMEGA_UEINTX_RXSTPI)) { 264 goto not_complete; 265 } 266 /* clear did stall */ 267 td->did_stall = 0; 268 /* get the packet byte count */ 269 count = 270 (ATMEGA_READ_1(sc, ATMEGA_UEBCHX) << 8) | 271 (ATMEGA_READ_1(sc, ATMEGA_UEBCLX)); 272 273 /* mask away undefined bits */ 274 count &= 0x7FF; 275 276 /* verify data length */ 277 if (count != td->remainder) { 278 DPRINTFN(0, "Invalid SETUP packet " 279 "length, %d bytes\n", count); 280 goto not_complete; 281 } 282 if (count != sizeof(req)) { 283 DPRINTFN(0, "Unsupported SETUP packet " 284 "length, %d bytes\n", count); 285 goto not_complete; 286 } 287 /* receive data */ 288 ATMEGA_READ_MULTI_1(sc, ATMEGA_UEDATX, 289 (void *)&req, sizeof(req)); 290 291 /* copy data into real buffer */ 292 usbd_copy_in(td->pc, 0, &req, sizeof(req)); 293 294 td->offset = sizeof(req); 295 td->remainder = 0; 296 297 /* sneak peek the set address */ 298 if ((req.bmRequestType == UT_WRITE_DEVICE) && 299 (req.bRequest == UR_SET_ADDRESS)) { 300 sc->sc_dv_addr = req.wValue[0] & 0x7F; 301 /* must write address before ZLP */ 302 ATMEGA_WRITE_1(sc, ATMEGA_UDADDR, sc->sc_dv_addr); 303 } else { 304 sc->sc_dv_addr = 0xFF; 305 } 306 307 /* Clear SETUP packet interrupt and all other previous interrupts */ 308 ATMEGA_WRITE_1(sc, ATMEGA_UEINTX, 0); 309 return (0); /* complete */ 310 311not_complete: 312 /* abort any ongoing transfer */ 313 if (!td->did_stall) { 314 DPRINTFN(5, "stalling\n"); 315 ATMEGA_WRITE_1(sc, ATMEGA_UECONX, 316 ATMEGA_UECONX_EPEN | 317 ATMEGA_UECONX_STALLRQ); 318 td->did_stall = 1; 319 } 320 if (temp & ATMEGA_UEINTX_RXSTPI) { 321 /* clear SETUP packet interrupt */ 322 ATMEGA_WRITE_1(sc, ATMEGA_UEINTX, ~ATMEGA_UEINTX_RXSTPI); 323 } 324 /* we only want to know if there is a SETUP packet */ 325 ATMEGA_WRITE_1(sc, ATMEGA_UEIENX, ATMEGA_UEIENX_RXSTPE); 326 return (1); /* not complete */ 327} 328 329static uint8_t 330atmegadci_data_rx(struct atmegadci_td *td) 331{ 332 struct atmegadci_softc *sc; 333 struct usb_page_search buf_res; 334 uint16_t count; 335 uint8_t temp; 336 uint8_t to; 337 uint8_t got_short; 338 339 to = 3; /* don't loop forever! */ 340 got_short = 0; 341 342 /* get pointer to softc */ 343 sc = ATMEGA_PC2SC(td->pc); 344 345 /* select endpoint number */ 346 ATMEGA_WRITE_1(sc, ATMEGA_UENUM, td->ep_no); 347 348repeat: 349 /* check if any of the FIFO banks have data */ 350 /* check endpoint status */ 351 temp = ATMEGA_READ_1(sc, ATMEGA_UEINTX); 352 353 DPRINTFN(5, "temp=0x%02x rem=%u\n", temp, td->remainder); 354 355 if (temp & ATMEGA_UEINTX_RXSTPI) { 356 if (td->remainder == 0) { 357 /* 358 * We are actually complete and have 359 * received the next SETUP 360 */ 361 DPRINTFN(5, "faking complete\n"); 362 return (0); /* complete */ 363 } 364 /* 365 * USB Host Aborted the transfer. 366 */ 367 td->error = 1; 368 return (0); /* complete */ 369 } 370 /* check status */ 371 if (!(temp & (ATMEGA_UEINTX_FIFOCON | 372 ATMEGA_UEINTX_RXOUTI))) { 373 /* no data */ 374 goto not_complete; 375 } 376 /* get the packet byte count */ 377 count = 378 (ATMEGA_READ_1(sc, ATMEGA_UEBCHX) << 8) | 379 (ATMEGA_READ_1(sc, ATMEGA_UEBCLX)); 380 381 /* mask away undefined bits */ 382 count &= 0x7FF; 383 384 /* verify the packet byte count */ 385 if (count != td->max_packet_size) { 386 if (count < td->max_packet_size) { 387 /* we have a short packet */ 388 td->short_pkt = 1; 389 got_short = 1; 390 } else { 391 /* invalid USB packet */ 392 td->error = 1; 393 return (0); /* we are complete */ 394 } 395 } 396 /* verify the packet byte count */ 397 if (count > td->remainder) { 398 /* invalid USB packet */ 399 td->error = 1; 400 return (0); /* we are complete */ 401 } 402 while (count > 0) { 403 usbd_get_page(td->pc, td->offset, &buf_res); 404 405 /* get correct length */ 406 if (buf_res.length > count) { 407 buf_res.length = count; 408 } 409 /* receive data */ 410 ATMEGA_READ_MULTI_1(sc, ATMEGA_UEDATX, 411 buf_res.buffer, buf_res.length); 412 413 /* update counters */ 414 count -= buf_res.length; 415 td->offset += buf_res.length; 416 td->remainder -= buf_res.length; 417 } 418 419 /* clear OUT packet interrupt */ 420 ATMEGA_WRITE_1(sc, ATMEGA_UEINTX, ATMEGA_UEINTX_RXOUTI ^ 0xFF); 421 422 /* release FIFO bank */ 423 ATMEGA_WRITE_1(sc, ATMEGA_UEINTX, ATMEGA_UEINTX_FIFOCON ^ 0xFF); 424 425 /* check if we are complete */ 426 if ((td->remainder == 0) || got_short) { 427 if (td->short_pkt) { 428 /* we are complete */ 429 return (0); 430 } 431 /* else need to receive a zero length packet */ 432 } 433 if (--to) { 434 goto repeat; 435 } 436not_complete: 437 /* we only want to know if there is a SETUP packet or OUT packet */ 438 ATMEGA_WRITE_1(sc, ATMEGA_UEIENX, 439 ATMEGA_UEIENX_RXSTPE | ATMEGA_UEIENX_RXOUTE); 440 return (1); /* not complete */ 441} 442 443static uint8_t 444atmegadci_data_tx(struct atmegadci_td *td) 445{ 446 struct atmegadci_softc *sc; 447 struct usb_page_search buf_res; 448 uint16_t count; 449 uint8_t to; 450 uint8_t temp; 451 452 to = 3; /* don't loop forever! */ 453 454 /* get pointer to softc */ 455 sc = ATMEGA_PC2SC(td->pc); 456 457 /* select endpoint number */ 458 ATMEGA_WRITE_1(sc, ATMEGA_UENUM, td->ep_no); 459 460repeat: 461 462 /* check endpoint status */ 463 temp = ATMEGA_READ_1(sc, ATMEGA_UEINTX); 464 465 DPRINTFN(5, "temp=0x%02x rem=%u\n", temp, td->remainder); 466 467 if (temp & ATMEGA_UEINTX_RXSTPI) { 468 /* 469 * The current transfer was aborted 470 * by the USB Host 471 */ 472 td->error = 1; 473 return (0); /* complete */ 474 } 475 476 temp = ATMEGA_READ_1(sc, ATMEGA_UESTA0X); 477 if (temp & 3) { 478 /* cannot write any data - a bank is busy */ 479 goto not_complete; 480 } 481 482 count = td->max_packet_size; 483 if (td->remainder < count) { 484 /* we have a short packet */ 485 td->short_pkt = 1; 486 count = td->remainder; 487 } 488 while (count > 0) { 489 490 usbd_get_page(td->pc, td->offset, &buf_res); 491 492 /* get correct length */ 493 if (buf_res.length > count) { 494 buf_res.length = count; 495 } 496 /* transmit data */ 497 ATMEGA_WRITE_MULTI_1(sc, ATMEGA_UEDATX, 498 buf_res.buffer, buf_res.length); 499 500 /* update counters */ 501 count -= buf_res.length; 502 td->offset += buf_res.length; 503 td->remainder -= buf_res.length; 504 } 505 506 /* clear IN packet interrupt */ 507 ATMEGA_WRITE_1(sc, ATMEGA_UEINTX, 0xFF ^ ATMEGA_UEINTX_TXINI); 508 509 /* allocate FIFO bank */ 510 ATMEGA_WRITE_1(sc, ATMEGA_UEINTX, 0xFF ^ ATMEGA_UEINTX_FIFOCON); 511 512 /* check remainder */ 513 if (td->remainder == 0) { 514 if (td->short_pkt) { 515 return (0); /* complete */ 516 } 517 /* else we need to transmit a short packet */ 518 } 519 if (--to) { 520 goto repeat; 521 } 522not_complete: 523 /* we only want to know if there is a SETUP packet or free IN packet */ 524 ATMEGA_WRITE_1(sc, ATMEGA_UEIENX, 525 ATMEGA_UEIENX_RXSTPE | ATMEGA_UEIENX_TXINE); 526 return (1); /* not complete */ 527} 528 529static uint8_t 530atmegadci_data_tx_sync(struct atmegadci_td *td) 531{ 532 struct atmegadci_softc *sc; 533 uint8_t temp; 534 535 /* get pointer to softc */ 536 sc = ATMEGA_PC2SC(td->pc); 537 538 /* select endpoint number */ 539 ATMEGA_WRITE_1(sc, ATMEGA_UENUM, td->ep_no); 540 541 /* check endpoint status */ 542 temp = ATMEGA_READ_1(sc, ATMEGA_UEINTX); 543 544 DPRINTFN(5, "temp=0x%02x\n", temp); 545 546 if (temp & ATMEGA_UEINTX_RXSTPI) { 547 DPRINTFN(5, "faking complete\n"); 548 /* Race condition */ 549 return (0); /* complete */ 550 } 551 /* 552 * The control endpoint has only got one bank, so if that bank 553 * is free the packet has been transferred! 554 */ 555 temp = ATMEGA_READ_1(sc, ATMEGA_UESTA0X); 556 if (temp & 3) { 557 /* cannot write any data - a bank is busy */ 558 goto not_complete; 559 } 560 if (sc->sc_dv_addr != 0xFF) { 561 /* set new address */ 562 atmegadci_set_address(sc, sc->sc_dv_addr); 563 } 564 return (0); /* complete */ 565 566not_complete: 567 /* we only want to know if there is a SETUP packet or free IN packet */ 568 ATMEGA_WRITE_1(sc, ATMEGA_UEIENX, 569 ATMEGA_UEIENX_RXSTPE | ATMEGA_UEIENX_TXINE); 570 return (1); /* not complete */ 571} 572 573static uint8_t 574atmegadci_xfer_do_fifo(struct usb_xfer *xfer) 575{ 576 struct atmegadci_td *td; 577 578 DPRINTFN(9, "\n"); 579 580 td = xfer->td_transfer_cache; 581 while (1) { 582 if ((td->func) (td)) { 583 /* operation in progress */ 584 break; 585 } 586 if (((void *)td) == xfer->td_transfer_last) { 587 goto done; 588 } 589 if (td->error) { 590 goto done; 591 } else if (td->remainder > 0) { 592 /* 593 * We had a short transfer. If there is no alternate 594 * next, stop processing ! 595 */ 596 if (!td->alt_next) { 597 goto done; 598 } 599 } 600 /* 601 * Fetch the next transfer descriptor and transfer 602 * some flags to the next transfer descriptor 603 */ 604 td = td->obj_next; 605 xfer->td_transfer_cache = td; 606 } 607 return (1); /* not complete */ 608 609done: 610 /* compute all actual lengths */ 611 612 atmegadci_standard_done(xfer); 613 return (0); /* complete */ 614} 615 616static void 617atmegadci_interrupt_poll(struct atmegadci_softc *sc) 618{ 619 struct usb_xfer *xfer; 620 621repeat: 622 TAILQ_FOREACH(xfer, &sc->sc_bus.intr_q.head, wait_entry) { 623 if (!atmegadci_xfer_do_fifo(xfer)) { 624 /* queue has been modified */ 625 goto repeat; 626 } 627 } 628} 629 630static void 631atmegadci_vbus_interrupt(struct atmegadci_softc *sc, uint8_t is_on) 632{ 633 DPRINTFN(5, "vbus = %u\n", is_on); 634 635 if (is_on) { 636 if (!sc->sc_flags.status_vbus) { 637 sc->sc_flags.status_vbus = 1; 638 639 /* complete root HUB interrupt endpoint */ 640 641 atmegadci_root_intr(sc); 642 } 643 } else { 644 if (sc->sc_flags.status_vbus) { 645 sc->sc_flags.status_vbus = 0; 646 sc->sc_flags.status_bus_reset = 0; 647 sc->sc_flags.status_suspend = 0; 648 sc->sc_flags.change_suspend = 0; 649 sc->sc_flags.change_connect = 1; 650 651 /* complete root HUB interrupt endpoint */ 652 653 atmegadci_root_intr(sc); 654 } 655 } 656} 657 658void 659atmegadci_interrupt(struct atmegadci_softc *sc) 660{ 661 uint8_t status; 662 663 USB_BUS_LOCK(&sc->sc_bus); 664 665 /* read interrupt status */ 666 status = ATMEGA_READ_1(sc, ATMEGA_UDINT); 667 668 /* clear all set interrupts */ 669 ATMEGA_WRITE_1(sc, ATMEGA_UDINT, (~status) & 0x7D); 670 671 DPRINTFN(14, "UDINT=0x%02x\n", status); 672 673 /* check for any bus state change interrupts */ 674 if (status & ATMEGA_UDINT_EORSTI) { 675 676 DPRINTFN(5, "end of reset\n"); 677 678 /* set correct state */ 679 sc->sc_flags.status_bus_reset = 1; 680 sc->sc_flags.status_suspend = 0; 681 sc->sc_flags.change_suspend = 0; 682 sc->sc_flags.change_connect = 1; 683 684 /* disable resume interrupt */ 685 ATMEGA_WRITE_1(sc, ATMEGA_UDIEN, 686 ATMEGA_UDINT_SUSPE | 687 ATMEGA_UDINT_EORSTE); 688 689 /* complete root HUB interrupt endpoint */ 690 atmegadci_root_intr(sc); 691 } 692 /* 693 * If resume and suspend is set at the same time we interpret 694 * that like RESUME. Resume is set when there is at least 3 695 * milliseconds of inactivity on the USB BUS. 696 */ 697 if (status & ATMEGA_UDINT_WAKEUPI) { 698 699 DPRINTFN(5, "resume interrupt\n"); 700 701 if (sc->sc_flags.status_suspend) { 702 /* update status bits */ 703 sc->sc_flags.status_suspend = 0; 704 sc->sc_flags.change_suspend = 1; 705 706 /* disable resume interrupt */ 707 ATMEGA_WRITE_1(sc, ATMEGA_UDIEN, 708 ATMEGA_UDINT_SUSPE | 709 ATMEGA_UDINT_EORSTE); 710 711 /* complete root HUB interrupt endpoint */ 712 atmegadci_root_intr(sc); 713 } 714 } else if (status & ATMEGA_UDINT_SUSPI) { 715 716 DPRINTFN(5, "suspend interrupt\n"); 717 718 if (!sc->sc_flags.status_suspend) { 719 /* update status bits */ 720 sc->sc_flags.status_suspend = 1; 721 sc->sc_flags.change_suspend = 1; 722 723 /* disable suspend interrupt */ 724 ATMEGA_WRITE_1(sc, ATMEGA_UDIEN, 725 ATMEGA_UDINT_WAKEUPE | 726 ATMEGA_UDINT_EORSTE); 727 728 /* complete root HUB interrupt endpoint */ 729 atmegadci_root_intr(sc); 730 } 731 } 732 /* check VBUS */ 733 status = ATMEGA_READ_1(sc, ATMEGA_USBINT); 734 735 /* clear all set interrupts */ 736 ATMEGA_WRITE_1(sc, ATMEGA_USBINT, (~status) & 0x03); 737 738 if (status & ATMEGA_USBINT_VBUSTI) { 739 uint8_t temp; 740 741 DPRINTFN(5, "USBINT=0x%02x\n", status); 742 743 temp = ATMEGA_READ_1(sc, ATMEGA_USBSTA); 744 atmegadci_vbus_interrupt(sc, temp & ATMEGA_USBSTA_VBUS); 745 } 746 /* check for any endpoint interrupts */ 747 status = ATMEGA_READ_1(sc, ATMEGA_UEINT); 748 /* the hardware will clear the UEINT bits automatically */ 749 if (status) { 750 751 DPRINTFN(5, "real endpoint interrupt UEINT=0x%02x\n", status); 752 753 atmegadci_interrupt_poll(sc); 754 } 755 USB_BUS_UNLOCK(&sc->sc_bus); 756} 757 758static void 759atmegadci_setup_standard_chain_sub(struct atmegadci_std_temp *temp) 760{ 761 struct atmegadci_td *td; 762 763 /* get current Transfer Descriptor */ 764 td = temp->td_next; 765 temp->td = td; 766 767 /* prepare for next TD */ 768 temp->td_next = td->obj_next; 769 770 /* fill out the Transfer Descriptor */ 771 td->func = temp->func; 772 td->pc = temp->pc; 773 td->offset = temp->offset; 774 td->remainder = temp->len; 775 td->error = 0; 776 td->did_stall = temp->did_stall; 777 td->short_pkt = temp->short_pkt; 778 td->alt_next = temp->setup_alt_next; 779} 780 781static void 782atmegadci_setup_standard_chain(struct usb_xfer *xfer) 783{ 784 struct atmegadci_std_temp temp; 785 struct atmegadci_softc *sc; 786 struct atmegadci_td *td; 787 uint32_t x; 788 uint8_t ep_no; 789 uint8_t need_sync; 790 791 DPRINTFN(9, "addr=%d endpt=%d sumlen=%d speed=%d\n", 792 xfer->address, UE_GET_ADDR(xfer->endpointno), 793 xfer->sumlen, usbd_get_speed(xfer->xroot->udev)); 794 795 temp.max_frame_size = xfer->max_frame_size; 796 797 td = xfer->td_start[0]; 798 xfer->td_transfer_first = td; 799 xfer->td_transfer_cache = td; 800 801 /* setup temp */ 802 803 temp.pc = NULL; 804 temp.td = NULL; 805 temp.td_next = xfer->td_start[0]; 806 temp.offset = 0; 807 temp.setup_alt_next = xfer->flags_int.short_frames_ok; 808 temp.did_stall = !xfer->flags_int.control_stall; 809 810 sc = ATMEGA_BUS2SC(xfer->xroot->bus); 811 ep_no = (xfer->endpointno & UE_ADDR); 812 813 /* check if we should prepend a setup message */ 814 815 if (xfer->flags_int.control_xfr) { 816 if (xfer->flags_int.control_hdr) { 817 818 temp.func = &atmegadci_setup_rx; 819 temp.len = xfer->frlengths[0]; 820 temp.pc = xfer->frbuffers + 0; 821 temp.short_pkt = temp.len ? 1 : 0; 822 /* check for last frame */ 823 if (xfer->nframes == 1) { 824 /* no STATUS stage yet, SETUP is last */ 825 if (xfer->flags_int.control_act) 826 temp.setup_alt_next = 0; 827 } 828 829 atmegadci_setup_standard_chain_sub(&temp); 830 } 831 x = 1; 832 } else { 833 x = 0; 834 } 835 836 if (x != xfer->nframes) { 837 if (xfer->endpointno & UE_DIR_IN) { 838 temp.func = &atmegadci_data_tx; 839 need_sync = 1; 840 } else { 841 temp.func = &atmegadci_data_rx; 842 need_sync = 0; 843 } 844 845 /* setup "pc" pointer */ 846 temp.pc = xfer->frbuffers + x; 847 } else { 848 need_sync = 0; 849 } 850 while (x != xfer->nframes) { 851 852 /* DATA0 / DATA1 message */ 853 854 temp.len = xfer->frlengths[x]; 855 856 x++; 857 858 if (x == xfer->nframes) { 859 if (xfer->flags_int.control_xfr) { 860 if (xfer->flags_int.control_act) { 861 temp.setup_alt_next = 0; 862 } 863 } else { 864 temp.setup_alt_next = 0; 865 } 866 } 867 if (temp.len == 0) { 868 869 /* make sure that we send an USB packet */ 870 871 temp.short_pkt = 0; 872 873 } else { 874 875 /* regular data transfer */ 876 877 temp.short_pkt = (xfer->flags.force_short_xfer) ? 0 : 1; 878 } 879 880 atmegadci_setup_standard_chain_sub(&temp); 881 882 if (xfer->flags_int.isochronous_xfr) { 883 temp.offset += temp.len; 884 } else { 885 /* get next Page Cache pointer */ 886 temp.pc = xfer->frbuffers + x; 887 } 888 } 889 890 if (xfer->flags_int.control_xfr) { 891 892 /* always setup a valid "pc" pointer for status and sync */ 893 temp.pc = xfer->frbuffers + 0; 894 temp.len = 0; 895 temp.short_pkt = 0; 896 temp.setup_alt_next = 0; 897 898 /* check if we need to sync */ 899 if (need_sync) { 900 /* we need a SYNC point after TX */ 901 temp.func = &atmegadci_data_tx_sync; 902 atmegadci_setup_standard_chain_sub(&temp); 903 } 904 905 /* check if we should append a status stage */ 906 if (!xfer->flags_int.control_act) { 907 908 /* 909 * Send a DATA1 message and invert the current 910 * endpoint direction. 911 */ 912 if (xfer->endpointno & UE_DIR_IN) { 913 temp.func = &atmegadci_data_rx; 914 need_sync = 0; 915 } else { 916 temp.func = &atmegadci_data_tx; 917 need_sync = 1; 918 } 919 920 atmegadci_setup_standard_chain_sub(&temp); 921 if (need_sync) { 922 /* we need a SYNC point after TX */ 923 temp.func = &atmegadci_data_tx_sync; 924 atmegadci_setup_standard_chain_sub(&temp); 925 } 926 } 927 } 928 /* must have at least one frame! */ 929 td = temp.td; 930 xfer->td_transfer_last = td; 931} 932 933static void 934atmegadci_timeout(void *arg) 935{ 936 struct usb_xfer *xfer = arg; 937 938 DPRINTF("xfer=%p\n", xfer); 939 940 USB_BUS_LOCK_ASSERT(xfer->xroot->bus, MA_OWNED); 941 942 /* transfer is transferred */ 943 atmegadci_device_done(xfer, USB_ERR_TIMEOUT); 944} 945 946static void 947atmegadci_start_standard_chain(struct usb_xfer *xfer) 948{ 949 DPRINTFN(9, "\n"); 950 951 /* poll one time - will turn on interrupts */ 952 if (atmegadci_xfer_do_fifo(xfer)) { 953 954 /* put transfer on interrupt queue */ 955 usbd_transfer_enqueue(&xfer->xroot->bus->intr_q, xfer); 956 957 /* start timeout, if any */ 958 if (xfer->timeout != 0) { 959 usbd_transfer_timeout_ms(xfer, 960 &atmegadci_timeout, xfer->timeout); 961 } 962 } 963} 964 965static void 966atmegadci_root_intr(struct atmegadci_softc *sc) 967{ 968 DPRINTFN(9, "\n"); 969 970 USB_BUS_LOCK_ASSERT(&sc->sc_bus, MA_OWNED); 971 972 /* set port bit */ 973 sc->sc_hub_idata[0] = 0x02; /* we only have one port */ 974 975 uhub_root_intr(&sc->sc_bus, sc->sc_hub_idata, 976 sizeof(sc->sc_hub_idata)); 977 } 978 979static usb_error_t 980atmegadci_standard_done_sub(struct usb_xfer *xfer) 981{ 982 struct atmegadci_td *td; 983 uint32_t len; 984 uint8_t error; 985 986 DPRINTFN(9, "\n"); 987 988 td = xfer->td_transfer_cache; 989 990 do { 991 len = td->remainder; 992 993 if (xfer->aframes != xfer->nframes) { 994 /* 995 * Verify the length and subtract 996 * the remainder from "frlengths[]": 997 */ 998 if (len > xfer->frlengths[xfer->aframes]) { 999 td->error = 1; 1000 } else { 1001 xfer->frlengths[xfer->aframes] -= len; 1002 } 1003 } 1004 /* Check for transfer error */ 1005 if (td->error) { 1006 /* the transfer is finished */ 1007 error = 1; 1008 td = NULL; 1009 break; 1010 } 1011 /* Check for short transfer */ 1012 if (len > 0) { 1013 if (xfer->flags_int.short_frames_ok) { 1014 /* follow alt next */ 1015 if (td->alt_next) { 1016 td = td->obj_next; 1017 } else { 1018 td = NULL; 1019 } 1020 } else { 1021 /* the transfer is finished */ 1022 td = NULL; 1023 } 1024 error = 0; 1025 break; 1026 } 1027 td = td->obj_next; 1028 1029 /* this USB frame is complete */ 1030 error = 0; 1031 break; 1032 1033 } while (0); 1034 1035 /* update transfer cache */ 1036 1037 xfer->td_transfer_cache = td; 1038 1039 return (error ? 1040 USB_ERR_STALLED : USB_ERR_NORMAL_COMPLETION); 1041} 1042 1043static void 1044atmegadci_standard_done(struct usb_xfer *xfer) 1045{ 1046 usb_error_t err = 0; 1047 1048 DPRINTFN(13, "xfer=%p endpoint=%p transfer done\n", 1049 xfer, xfer->endpoint); 1050 1051 /* reset scanner */ 1052 1053 xfer->td_transfer_cache = xfer->td_transfer_first; 1054 1055 if (xfer->flags_int.control_xfr) { 1056 1057 if (xfer->flags_int.control_hdr) { 1058 1059 err = atmegadci_standard_done_sub(xfer); 1060 } 1061 xfer->aframes = 1; 1062 1063 if (xfer->td_transfer_cache == NULL) { 1064 goto done; 1065 } 1066 } 1067 while (xfer->aframes != xfer->nframes) { 1068 1069 err = atmegadci_standard_done_sub(xfer); 1070 xfer->aframes++; 1071 1072 if (xfer->td_transfer_cache == NULL) { 1073 goto done; 1074 } 1075 } 1076 1077 if (xfer->flags_int.control_xfr && 1078 !xfer->flags_int.control_act) { 1079 1080 err = atmegadci_standard_done_sub(xfer); 1081 } 1082done: 1083 atmegadci_device_done(xfer, err); 1084} 1085 1086/*------------------------------------------------------------------------* 1087 * atmegadci_device_done 1088 * 1089 * NOTE: this function can be called more than one time on the 1090 * same USB transfer! 1091 *------------------------------------------------------------------------*/ 1092static void 1093atmegadci_device_done(struct usb_xfer *xfer, usb_error_t error) 1094{ 1095 struct atmegadci_softc *sc = ATMEGA_BUS2SC(xfer->xroot->bus); 1096 uint8_t ep_no; 1097 1098 USB_BUS_LOCK_ASSERT(&sc->sc_bus, MA_OWNED); 1099 1100 DPRINTFN(9, "xfer=%p, endpoint=%p, error=%d\n", 1101 xfer, xfer->endpoint, error); 1102 1103 if (xfer->flags_int.usb_mode == USB_MODE_DEVICE) { 1104 ep_no = (xfer->endpointno & UE_ADDR); 1105 1106 /* select endpoint number */ 1107 ATMEGA_WRITE_1(sc, ATMEGA_UENUM, ep_no); 1108 1109 /* disable endpoint interrupt */ 1110 ATMEGA_WRITE_1(sc, ATMEGA_UEIENX, 0); 1111 1112 DPRINTFN(15, "disabled interrupts!\n"); 1113 } 1114 /* dequeue transfer and start next transfer */ 1115 usbd_transfer_done(xfer, error); 1116} 1117 1118static void 1119atmegadci_xfer_stall(struct usb_xfer *xfer) 1120{ 1121 atmegadci_device_done(xfer, USB_ERR_STALLED); 1122} 1123 1124static void 1125atmegadci_set_stall(struct usb_device *udev, 1126 struct usb_endpoint *ep, uint8_t *did_stall) 1127{ 1128 struct atmegadci_softc *sc; 1129 uint8_t ep_no; 1130 1131 USB_BUS_LOCK_ASSERT(udev->bus, MA_OWNED); 1132 1133 DPRINTFN(5, "endpoint=%p\n", ep); 1134 1135 sc = ATMEGA_BUS2SC(udev->bus); 1136 /* get endpoint number */ 1137 ep_no = (ep->edesc->bEndpointAddress & UE_ADDR); 1138 /* select endpoint number */ 1139 ATMEGA_WRITE_1(sc, ATMEGA_UENUM, ep_no); 1140 /* set stall */ 1141 ATMEGA_WRITE_1(sc, ATMEGA_UECONX, 1142 ATMEGA_UECONX_EPEN | 1143 ATMEGA_UECONX_STALLRQ); 1144} 1145 1146static void 1147atmegadci_clear_stall_sub(struct atmegadci_softc *sc, uint8_t ep_no, 1148 uint8_t ep_type, uint8_t ep_dir) 1149{ 1150 uint8_t temp; 1151 1152 if (ep_type == UE_CONTROL) { 1153 /* clearing stall is not needed */ 1154 return; 1155 } 1156 /* select endpoint number */ 1157 ATMEGA_WRITE_1(sc, ATMEGA_UENUM, ep_no); 1158 1159 /* set endpoint reset */ 1160 ATMEGA_WRITE_1(sc, ATMEGA_UERST, ATMEGA_UERST_MASK(ep_no)); 1161 1162 /* clear endpoint reset */ 1163 ATMEGA_WRITE_1(sc, ATMEGA_UERST, 0); 1164 1165 /* set stall */ 1166 ATMEGA_WRITE_1(sc, ATMEGA_UECONX, 1167 ATMEGA_UECONX_EPEN | 1168 ATMEGA_UECONX_STALLRQ); 1169 1170 /* reset data toggle */ 1171 ATMEGA_WRITE_1(sc, ATMEGA_UECONX, 1172 ATMEGA_UECONX_EPEN | 1173 ATMEGA_UECONX_RSTDT); 1174 1175 /* clear stall */ 1176 ATMEGA_WRITE_1(sc, ATMEGA_UECONX, 1177 ATMEGA_UECONX_EPEN | 1178 ATMEGA_UECONX_STALLRQC); 1179 1180 do { 1181 if (ep_type == UE_BULK) { 1182 temp = ATMEGA_UECFG0X_EPTYPE2; 1183 } else if (ep_type == UE_INTERRUPT) { 1184 temp = ATMEGA_UECFG0X_EPTYPE3; 1185 } else { 1186 temp = ATMEGA_UECFG0X_EPTYPE1; 1187 } 1188 if (ep_dir & UE_DIR_IN) { 1189 temp |= ATMEGA_UECFG0X_EPDIR; 1190 } 1191 /* two banks, 64-bytes wMaxPacket */ 1192 ATMEGA_WRITE_1(sc, ATMEGA_UECFG0X, temp); 1193 ATMEGA_WRITE_1(sc, ATMEGA_UECFG1X, 1194 ATMEGA_UECFG1X_ALLOC | 1195 ATMEGA_UECFG1X_EPBK0 | /* one bank */ 1196 ATMEGA_UECFG1X_EPSIZE(3)); 1197 1198 temp = ATMEGA_READ_1(sc, ATMEGA_UESTA0X); 1199 if (!(temp & ATMEGA_UESTA0X_CFGOK)) { 1200 device_printf(sc->sc_bus.bdev, 1201 "Chip rejected configuration\n"); 1202 } 1203 } while (0); 1204} 1205 1206static void 1207atmegadci_clear_stall(struct usb_device *udev, struct usb_endpoint *ep) 1208{ 1209 struct atmegadci_softc *sc; 1210 struct usb_endpoint_descriptor *ed; 1211 1212 DPRINTFN(5, "endpoint=%p\n", ep); 1213 1214 USB_BUS_LOCK_ASSERT(udev->bus, MA_OWNED); 1215 1216 /* check mode */ 1217 if (udev->flags.usb_mode != USB_MODE_DEVICE) { 1218 /* not supported */ 1219 return; 1220 } 1221 /* get softc */ 1222 sc = ATMEGA_BUS2SC(udev->bus); 1223 1224 /* get endpoint descriptor */ 1225 ed = ep->edesc; 1226 1227 /* reset endpoint */ 1228 atmegadci_clear_stall_sub(sc, 1229 (ed->bEndpointAddress & UE_ADDR), 1230 (ed->bmAttributes & UE_XFERTYPE), 1231 (ed->bEndpointAddress & (UE_DIR_IN | UE_DIR_OUT))); 1232} 1233 1234usb_error_t 1235atmegadci_init(struct atmegadci_softc *sc) 1236{ 1237 uint8_t n; 1238 1239 DPRINTF("start\n"); 1240 1241 /* set up the bus structure */ 1242 sc->sc_bus.usbrev = USB_REV_1_1; 1243 sc->sc_bus.methods = &atmegadci_bus_methods; 1244 1245 USB_BUS_LOCK(&sc->sc_bus); 1246 1247 /* make sure USB is enabled */ 1248 ATMEGA_WRITE_1(sc, ATMEGA_USBCON, 1249 ATMEGA_USBCON_USBE | 1250 ATMEGA_USBCON_FRZCLK); 1251 1252 /* enable USB PAD regulator */ 1253 ATMEGA_WRITE_1(sc, ATMEGA_UHWCON, 1254 ATMEGA_UHWCON_UVREGE | 1255 ATMEGA_UHWCON_UIMOD); 1256 1257 /* the following register sets up the USB PLL, assuming 16MHz X-tal */ 1258 ATMEGA_WRITE_1(sc, 0x49 /* PLLCSR */, 0x14 | 0x02); 1259 1260 /* wait for PLL to lock */ 1261 for (n = 0; n != 20; n++) { 1262 if (ATMEGA_READ_1(sc, 0x49) & 0x01) 1263 break; 1264 /* wait a little bit for PLL to start */ 1265 usb_pause_mtx(&sc->sc_bus.bus_mtx, hz / 100); 1266 } 1267 1268 /* make sure USB is enabled */ 1269 ATMEGA_WRITE_1(sc, ATMEGA_USBCON, 1270 ATMEGA_USBCON_USBE | 1271 ATMEGA_USBCON_OTGPADE | 1272 ATMEGA_USBCON_VBUSTE); 1273 1274 /* turn on clocks */ 1275 (sc->sc_clocks_on) (&sc->sc_bus); 1276 1277 /* make sure device is re-enumerated */ 1278 ATMEGA_WRITE_1(sc, ATMEGA_UDCON, ATMEGA_UDCON_DETACH); 1279 1280 /* wait a little for things to stabilise */ 1281 usb_pause_mtx(&sc->sc_bus.bus_mtx, hz / 20); 1282 1283 /* enable interrupts */ 1284 ATMEGA_WRITE_1(sc, ATMEGA_UDIEN, 1285 ATMEGA_UDINT_SUSPE | 1286 ATMEGA_UDINT_EORSTE); 1287 1288 /* reset all endpoints */ 1289 ATMEGA_WRITE_1(sc, ATMEGA_UERST, 1290 (1 << ATMEGA_EP_MAX) - 1); 1291 1292 /* disable reset */ 1293 ATMEGA_WRITE_1(sc, ATMEGA_UERST, 0); 1294 1295 /* disable all endpoints */ 1296 for (n = 0; n != ATMEGA_EP_MAX; n++) { 1297 1298 /* select endpoint */ 1299 ATMEGA_WRITE_1(sc, ATMEGA_UENUM, n); 1300 1301 /* disable endpoint interrupt */ 1302 ATMEGA_WRITE_1(sc, ATMEGA_UEIENX, 0); 1303 1304 /* disable endpoint */ 1305 ATMEGA_WRITE_1(sc, ATMEGA_UECONX, 0); 1306 } 1307 1308 /* turn off clocks */ 1309 1310 atmegadci_clocks_off(sc); 1311 1312 /* read initial VBUS state */ 1313 1314 n = ATMEGA_READ_1(sc, ATMEGA_USBSTA); 1315 atmegadci_vbus_interrupt(sc, n & ATMEGA_USBSTA_VBUS); 1316 1317 USB_BUS_UNLOCK(&sc->sc_bus); 1318 1319 /* catch any lost interrupts */ 1320 1321 atmegadci_do_poll(&sc->sc_bus); 1322 1323 return (0); /* success */ 1324} 1325 1326void 1327atmegadci_uninit(struct atmegadci_softc *sc) 1328{ 1329 USB_BUS_LOCK(&sc->sc_bus); 1330 1331 /* turn on clocks */ 1332 (sc->sc_clocks_on) (&sc->sc_bus); 1333 1334 /* disable interrupts */ 1335 ATMEGA_WRITE_1(sc, ATMEGA_UDIEN, 0); 1336 1337 /* reset all endpoints */ 1338 ATMEGA_WRITE_1(sc, ATMEGA_UERST, 1339 (1 << ATMEGA_EP_MAX) - 1); 1340 1341 /* disable reset */ 1342 ATMEGA_WRITE_1(sc, ATMEGA_UERST, 0); 1343 1344 sc->sc_flags.port_powered = 0; 1345 sc->sc_flags.status_vbus = 0; 1346 sc->sc_flags.status_bus_reset = 0; 1347 sc->sc_flags.status_suspend = 0; 1348 sc->sc_flags.change_suspend = 0; 1349 sc->sc_flags.change_connect = 1; 1350 1351 atmegadci_pull_down(sc); 1352 atmegadci_clocks_off(sc); 1353 1354 /* disable USB PAD regulator */ 1355 ATMEGA_WRITE_1(sc, ATMEGA_UHWCON, 0); 1356 1357 USB_BUS_UNLOCK(&sc->sc_bus); 1358} 1359 1360static void 1361atmegadci_suspend(struct atmegadci_softc *sc) 1362{ 1363 /* TODO */ 1364} 1365 1366static void 1367atmegadci_resume(struct atmegadci_softc *sc) 1368{ 1369 /* TODO */ 1370} 1371 1372static void 1373atmegadci_do_poll(struct usb_bus *bus) 1374{ 1375 struct atmegadci_softc *sc = ATMEGA_BUS2SC(bus); 1376 1377 USB_BUS_LOCK(&sc->sc_bus); 1378 atmegadci_interrupt_poll(sc); 1379 USB_BUS_UNLOCK(&sc->sc_bus); 1380} 1381 1382/*------------------------------------------------------------------------* 1383 * at91dci bulk support 1384 * at91dci control support 1385 * at91dci interrupt support 1386 *------------------------------------------------------------------------*/ 1387static void 1388atmegadci_device_non_isoc_open(struct usb_xfer *xfer) 1389{ 1390 return; 1391} 1392 1393static void 1394atmegadci_device_non_isoc_close(struct usb_xfer *xfer) 1395{ 1396 atmegadci_device_done(xfer, USB_ERR_CANCELLED); 1397} 1398 1399static void 1400atmegadci_device_non_isoc_enter(struct usb_xfer *xfer) 1401{ 1402 return; 1403} 1404 1405static void 1406atmegadci_device_non_isoc_start(struct usb_xfer *xfer) 1407{ 1408 /* setup TDs */ 1409 atmegadci_setup_standard_chain(xfer); 1410 atmegadci_start_standard_chain(xfer); 1411} 1412 1413struct usb_pipe_methods atmegadci_device_non_isoc_methods = 1414{ 1415 .open = atmegadci_device_non_isoc_open, 1416 .close = atmegadci_device_non_isoc_close, 1417 .enter = atmegadci_device_non_isoc_enter, 1418 .start = atmegadci_device_non_isoc_start, 1419}; 1420 1421/*------------------------------------------------------------------------* 1422 * at91dci full speed isochronous support 1423 *------------------------------------------------------------------------*/ 1424static void 1425atmegadci_device_isoc_fs_open(struct usb_xfer *xfer) 1426{ 1427 return; 1428} 1429 1430static void 1431atmegadci_device_isoc_fs_close(struct usb_xfer *xfer) 1432{ 1433 atmegadci_device_done(xfer, USB_ERR_CANCELLED); 1434} 1435 1436static void 1437atmegadci_device_isoc_fs_enter(struct usb_xfer *xfer) 1438{ 1439 struct atmegadci_softc *sc = ATMEGA_BUS2SC(xfer->xroot->bus); 1440 uint32_t temp; 1441 uint32_t nframes; 1442 1443 DPRINTFN(6, "xfer=%p next=%d nframes=%d\n", 1444 xfer, xfer->endpoint->isoc_next, xfer->nframes); 1445 1446 /* get the current frame index */ 1447 1448 nframes = 1449 (ATMEGA_READ_1(sc, ATMEGA_UDFNUMH) << 8) | 1450 (ATMEGA_READ_1(sc, ATMEGA_UDFNUML)); 1451 1452 nframes &= ATMEGA_FRAME_MASK; 1453 1454 /* 1455 * check if the frame index is within the window where the frames 1456 * will be inserted 1457 */ 1458 temp = (nframes - xfer->endpoint->isoc_next) & ATMEGA_FRAME_MASK; 1459 1460 if ((xfer->endpoint->is_synced == 0) || 1461 (temp < xfer->nframes)) { 1462 /* 1463 * If there is data underflow or the pipe queue is 1464 * empty we schedule the transfer a few frames ahead 1465 * of the current frame position. Else two isochronous 1466 * transfers might overlap. 1467 */ 1468 xfer->endpoint->isoc_next = (nframes + 3) & ATMEGA_FRAME_MASK; 1469 xfer->endpoint->is_synced = 1; 1470 DPRINTFN(3, "start next=%d\n", xfer->endpoint->isoc_next); 1471 } 1472 /* 1473 * compute how many milliseconds the insertion is ahead of the 1474 * current frame position: 1475 */ 1476 temp = (xfer->endpoint->isoc_next - nframes) & ATMEGA_FRAME_MASK; 1477 1478 /* 1479 * pre-compute when the isochronous transfer will be finished: 1480 */ 1481 xfer->isoc_time_complete = 1482 usb_isoc_time_expand(&sc->sc_bus, nframes) + temp + 1483 xfer->nframes; 1484 1485 /* compute frame number for next insertion */ 1486 xfer->endpoint->isoc_next += xfer->nframes; 1487 1488 /* setup TDs */ 1489 atmegadci_setup_standard_chain(xfer); 1490} 1491 1492static void 1493atmegadci_device_isoc_fs_start(struct usb_xfer *xfer) 1494{ 1495 /* start TD chain */ 1496 atmegadci_start_standard_chain(xfer); 1497} 1498 1499struct usb_pipe_methods atmegadci_device_isoc_fs_methods = 1500{ 1501 .open = atmegadci_device_isoc_fs_open, 1502 .close = atmegadci_device_isoc_fs_close, 1503 .enter = atmegadci_device_isoc_fs_enter, 1504 .start = atmegadci_device_isoc_fs_start, 1505}; 1506 1507/*------------------------------------------------------------------------* 1508 * at91dci root control support 1509 *------------------------------------------------------------------------* 1510 * Simulate a hardware HUB by handling all the necessary requests. 1511 *------------------------------------------------------------------------*/ 1512 1513static const struct usb_device_descriptor atmegadci_devd = { 1514 .bLength = sizeof(struct usb_device_descriptor), 1515 .bDescriptorType = UDESC_DEVICE, 1516 .bcdUSB = {0x00, 0x02}, 1517 .bDeviceClass = UDCLASS_HUB, 1518 .bDeviceSubClass = UDSUBCLASS_HUB, 1519 .bDeviceProtocol = UDPROTO_FSHUB, 1520 .bMaxPacketSize = 64, 1521 .bcdDevice = {0x00, 0x01}, 1522 .iManufacturer = 1, 1523 .iProduct = 2, 1524 .bNumConfigurations = 1, 1525}; 1526 1527static const struct atmegadci_config_desc atmegadci_confd = { 1528 .confd = { 1529 .bLength = sizeof(struct usb_config_descriptor), 1530 .bDescriptorType = UDESC_CONFIG, 1531 .wTotalLength[0] = sizeof(atmegadci_confd), 1532 .bNumInterface = 1, 1533 .bConfigurationValue = 1, 1534 .iConfiguration = 0, 1535 .bmAttributes = UC_SELF_POWERED, 1536 .bMaxPower = 0, 1537 }, 1538 .ifcd = { 1539 .bLength = sizeof(struct usb_interface_descriptor), 1540 .bDescriptorType = UDESC_INTERFACE, 1541 .bNumEndpoints = 1, 1542 .bInterfaceClass = UICLASS_HUB, 1543 .bInterfaceSubClass = UISUBCLASS_HUB, 1544 .bInterfaceProtocol = 0, 1545 }, 1546 .endpd = { 1547 .bLength = sizeof(struct usb_endpoint_descriptor), 1548 .bDescriptorType = UDESC_ENDPOINT, 1549 .bEndpointAddress = (UE_DIR_IN | ATMEGA_INTR_ENDPT), 1550 .bmAttributes = UE_INTERRUPT, 1551 .wMaxPacketSize[0] = 8, 1552 .bInterval = 255, 1553 }, 1554}; 1555 1556#define HSETW(ptr, val) ptr = { (uint8_t)(val), (uint8_t)((val) >> 8) } 1557 1558static const struct usb_hub_descriptor_min atmegadci_hubd = { 1559 .bDescLength = sizeof(atmegadci_hubd), 1560 .bDescriptorType = UDESC_HUB, 1561 .bNbrPorts = 1, 1562 HSETW(.wHubCharacteristics, (UHD_PWR_NO_SWITCH | UHD_OC_INDIVIDUAL)), 1563 .bPwrOn2PwrGood = 50, 1564 .bHubContrCurrent = 0, 1565 .DeviceRemovable = {0}, /* port is removable */ 1566}; 1567 1568#define STRING_LANG \ 1569 0x09, 0x04, /* American English */ 1570 1571#define STRING_VENDOR \ 1572 'A', 0, 'T', 0, 'M', 0, 'E', 0, 'G', 0, 'A', 0 1573 1574#define STRING_PRODUCT \ 1575 'D', 0, 'C', 0, 'I', 0, ' ', 0, 'R', 0, \ 1576 'o', 0, 'o', 0, 't', 0, ' ', 0, 'H', 0, \ 1577 'U', 0, 'B', 0, 1578 1579USB_MAKE_STRING_DESC(STRING_LANG, atmegadci_langtab); 1580USB_MAKE_STRING_DESC(STRING_VENDOR, atmegadci_vendor); 1581USB_MAKE_STRING_DESC(STRING_PRODUCT, atmegadci_product); 1582 1583static usb_error_t 1584atmegadci_roothub_exec(struct usb_device *udev, 1585 struct usb_device_request *req, const void **pptr, uint16_t *plength) 1586{ 1587 struct atmegadci_softc *sc = ATMEGA_BUS2SC(udev->bus); 1588 const void *ptr; 1589 uint16_t len; 1590 uint16_t value; 1591 uint16_t index; 1592 uint8_t temp; 1593 usb_error_t err; 1594 1595 USB_BUS_LOCK_ASSERT(&sc->sc_bus, MA_OWNED); 1596 1597 /* buffer reset */ 1598 ptr = (const void *)&sc->sc_hub_temp; 1599 len = 0; 1600 err = 0; 1601 1602 value = UGETW(req->wValue); 1603 index = UGETW(req->wIndex); 1604 1605 /* demultiplex the control request */ 1606 1607 switch (req->bmRequestType) { 1608 case UT_READ_DEVICE: 1609 switch (req->bRequest) { 1610 case UR_GET_DESCRIPTOR: 1611 goto tr_handle_get_descriptor; 1612 case UR_GET_CONFIG: 1613 goto tr_handle_get_config; 1614 case UR_GET_STATUS: 1615 goto tr_handle_get_status; 1616 default: 1617 goto tr_stalled; 1618 } 1619 break; 1620 1621 case UT_WRITE_DEVICE: 1622 switch (req->bRequest) { 1623 case UR_SET_ADDRESS: 1624 goto tr_handle_set_address; 1625 case UR_SET_CONFIG: 1626 goto tr_handle_set_config; 1627 case UR_CLEAR_FEATURE: 1628 goto tr_valid; /* nop */ 1629 case UR_SET_DESCRIPTOR: 1630 goto tr_valid; /* nop */ 1631 case UR_SET_FEATURE: 1632 default: 1633 goto tr_stalled; 1634 } 1635 break; 1636 1637 case UT_WRITE_ENDPOINT: 1638 switch (req->bRequest) { 1639 case UR_CLEAR_FEATURE: 1640 switch (UGETW(req->wValue)) { 1641 case UF_ENDPOINT_HALT: 1642 goto tr_handle_clear_halt; 1643 case UF_DEVICE_REMOTE_WAKEUP: 1644 goto tr_handle_clear_wakeup; 1645 default: 1646 goto tr_stalled; 1647 } 1648 break; 1649 case UR_SET_FEATURE: 1650 switch (UGETW(req->wValue)) { 1651 case UF_ENDPOINT_HALT: 1652 goto tr_handle_set_halt; 1653 case UF_DEVICE_REMOTE_WAKEUP: 1654 goto tr_handle_set_wakeup; 1655 default: 1656 goto tr_stalled; 1657 } 1658 break; 1659 case UR_SYNCH_FRAME: 1660 goto tr_valid; /* nop */ 1661 default: 1662 goto tr_stalled; 1663 } 1664 break; 1665 1666 case UT_READ_ENDPOINT: 1667 switch (req->bRequest) { 1668 case UR_GET_STATUS: 1669 goto tr_handle_get_ep_status; 1670 default: 1671 goto tr_stalled; 1672 } 1673 break; 1674 1675 case UT_WRITE_INTERFACE: 1676 switch (req->bRequest) { 1677 case UR_SET_INTERFACE: 1678 goto tr_handle_set_interface; 1679 case UR_CLEAR_FEATURE: 1680 goto tr_valid; /* nop */ 1681 case UR_SET_FEATURE: 1682 default: 1683 goto tr_stalled; 1684 } 1685 break; 1686 1687 case UT_READ_INTERFACE: 1688 switch (req->bRequest) { 1689 case UR_GET_INTERFACE: 1690 goto tr_handle_get_interface; 1691 case UR_GET_STATUS: 1692 goto tr_handle_get_iface_status; 1693 default: 1694 goto tr_stalled; 1695 } 1696 break; 1697 1698 case UT_WRITE_CLASS_INTERFACE: 1699 case UT_WRITE_VENDOR_INTERFACE: 1700 /* XXX forward */ 1701 break; 1702 1703 case UT_READ_CLASS_INTERFACE: 1704 case UT_READ_VENDOR_INTERFACE: 1705 /* XXX forward */ 1706 break; 1707 1708 case UT_WRITE_CLASS_DEVICE: 1709 switch (req->bRequest) { 1710 case UR_CLEAR_FEATURE: 1711 goto tr_valid; 1712 case UR_SET_DESCRIPTOR: 1713 case UR_SET_FEATURE: 1714 break; 1715 default: 1716 goto tr_stalled; 1717 } 1718 break; 1719 1720 case UT_WRITE_CLASS_OTHER: 1721 switch (req->bRequest) { 1722 case UR_CLEAR_FEATURE: 1723 goto tr_handle_clear_port_feature; 1724 case UR_SET_FEATURE: 1725 goto tr_handle_set_port_feature; 1726 case UR_CLEAR_TT_BUFFER: 1727 case UR_RESET_TT: 1728 case UR_STOP_TT: 1729 goto tr_valid; 1730 1731 default: 1732 goto tr_stalled; 1733 } 1734 break; 1735 1736 case UT_READ_CLASS_OTHER: 1737 switch (req->bRequest) { 1738 case UR_GET_TT_STATE: 1739 goto tr_handle_get_tt_state; 1740 case UR_GET_STATUS: 1741 goto tr_handle_get_port_status; 1742 default: 1743 goto tr_stalled; 1744 } 1745 break; 1746 1747 case UT_READ_CLASS_DEVICE: 1748 switch (req->bRequest) { 1749 case UR_GET_DESCRIPTOR: 1750 goto tr_handle_get_class_descriptor; 1751 case UR_GET_STATUS: 1752 goto tr_handle_get_class_status; 1753 1754 default: 1755 goto tr_stalled; 1756 } 1757 break; 1758 default: 1759 goto tr_stalled; 1760 } 1761 goto tr_valid; 1762 1763tr_handle_get_descriptor: 1764 switch (value >> 8) { 1765 case UDESC_DEVICE: 1766 if (value & 0xff) { 1767 goto tr_stalled; 1768 } 1769 len = sizeof(atmegadci_devd); 1770 ptr = (const void *)&atmegadci_devd; 1771 goto tr_valid; 1772 case UDESC_CONFIG: 1773 if (value & 0xff) { 1774 goto tr_stalled; 1775 } 1776 len = sizeof(atmegadci_confd); 1777 ptr = (const void *)&atmegadci_confd; 1778 goto tr_valid; 1779 case UDESC_STRING: 1780 switch (value & 0xff) { 1781 case 0: /* Language table */ 1782 len = sizeof(atmegadci_langtab); 1783 ptr = (const void *)&atmegadci_langtab; 1784 goto tr_valid; 1785 1786 case 1: /* Vendor */ 1787 len = sizeof(atmegadci_vendor); 1788 ptr = (const void *)&atmegadci_vendor; 1789 goto tr_valid; 1790 1791 case 2: /* Product */ 1792 len = sizeof(atmegadci_product); 1793 ptr = (const void *)&atmegadci_product; 1794 goto tr_valid; 1795 default: 1796 break; 1797 } 1798 break; 1799 default: 1800 goto tr_stalled; 1801 } 1802 goto tr_stalled; 1803 1804tr_handle_get_config: 1805 len = 1; 1806 sc->sc_hub_temp.wValue[0] = sc->sc_conf; 1807 goto tr_valid; 1808 1809tr_handle_get_status: 1810 len = 2; 1811 USETW(sc->sc_hub_temp.wValue, UDS_SELF_POWERED); 1812 goto tr_valid; 1813 1814tr_handle_set_address: 1815 if (value & 0xFF00) { 1816 goto tr_stalled; 1817 } 1818 sc->sc_rt_addr = value; 1819 goto tr_valid; 1820 1821tr_handle_set_config: 1822 if (value >= 2) { 1823 goto tr_stalled; 1824 } 1825 sc->sc_conf = value; 1826 goto tr_valid; 1827 1828tr_handle_get_interface: 1829 len = 1; 1830 sc->sc_hub_temp.wValue[0] = 0; 1831 goto tr_valid; 1832 1833tr_handle_get_tt_state: 1834tr_handle_get_class_status: 1835tr_handle_get_iface_status: 1836tr_handle_get_ep_status: 1837 len = 2; 1838 USETW(sc->sc_hub_temp.wValue, 0); 1839 goto tr_valid; 1840 1841tr_handle_set_halt: 1842tr_handle_set_interface: 1843tr_handle_set_wakeup: 1844tr_handle_clear_wakeup: 1845tr_handle_clear_halt: 1846 goto tr_valid; 1847 1848tr_handle_clear_port_feature: 1849 if (index != 1) { 1850 goto tr_stalled; 1851 } 1852 DPRINTFN(9, "UR_CLEAR_PORT_FEATURE on port %d\n", index); 1853 1854 switch (value) { 1855 case UHF_PORT_SUSPEND: 1856 atmegadci_wakeup_peer(sc); 1857 break; 1858 1859 case UHF_PORT_ENABLE: 1860 sc->sc_flags.port_enabled = 0; 1861 break; 1862 1863 case UHF_PORT_TEST: 1864 case UHF_PORT_INDICATOR: 1865 case UHF_C_PORT_ENABLE: 1866 case UHF_C_PORT_OVER_CURRENT: 1867 case UHF_C_PORT_RESET: 1868 /* nops */ 1869 break; 1870 case UHF_PORT_POWER: 1871 sc->sc_flags.port_powered = 0; 1872 atmegadci_pull_down(sc); 1873 atmegadci_clocks_off(sc); 1874 break; 1875 case UHF_C_PORT_CONNECTION: 1876 /* clear connect change flag */ 1877 sc->sc_flags.change_connect = 0; 1878 1879 if (!sc->sc_flags.status_bus_reset) { 1880 /* we are not connected */ 1881 break; 1882 } 1883 1884 /* configure the control endpoint */ 1885 1886 /* select endpoint number */ 1887 ATMEGA_WRITE_1(sc, ATMEGA_UENUM, 0); 1888 1889 /* set endpoint reset */ 1890 ATMEGA_WRITE_1(sc, ATMEGA_UERST, ATMEGA_UERST_MASK(0)); 1891 1892 /* clear endpoint reset */ 1893 ATMEGA_WRITE_1(sc, ATMEGA_UERST, 0); 1894 1895 /* enable and stall endpoint */ 1896 ATMEGA_WRITE_1(sc, ATMEGA_UECONX, 1897 ATMEGA_UECONX_EPEN | 1898 ATMEGA_UECONX_STALLRQ); 1899 1900 /* one bank, 64-bytes wMaxPacket */ 1901 ATMEGA_WRITE_1(sc, ATMEGA_UECFG0X, 1902 ATMEGA_UECFG0X_EPTYPE0); 1903 ATMEGA_WRITE_1(sc, ATMEGA_UECFG1X, 1904 ATMEGA_UECFG1X_ALLOC | 1905 ATMEGA_UECFG1X_EPBK0 | 1906 ATMEGA_UECFG1X_EPSIZE(3)); 1907 1908 /* check valid config */ 1909 temp = ATMEGA_READ_1(sc, ATMEGA_UESTA0X); 1910 if (!(temp & ATMEGA_UESTA0X_CFGOK)) { 1911 device_printf(sc->sc_bus.bdev, 1912 "Chip rejected EP0 configuration\n"); 1913 } 1914 break; 1915 case UHF_C_PORT_SUSPEND: 1916 sc->sc_flags.change_suspend = 0; 1917 break; 1918 default: 1919 err = USB_ERR_IOERROR; 1920 goto done; 1921 } 1922 goto tr_valid; 1923 1924tr_handle_set_port_feature: 1925 if (index != 1) { 1926 goto tr_stalled; 1927 } 1928 DPRINTFN(9, "UR_SET_PORT_FEATURE\n"); 1929 1930 switch (value) { 1931 case UHF_PORT_ENABLE: 1932 sc->sc_flags.port_enabled = 1; 1933 break; 1934 case UHF_PORT_SUSPEND: 1935 case UHF_PORT_RESET: 1936 case UHF_PORT_TEST: 1937 case UHF_PORT_INDICATOR: 1938 /* nops */ 1939 break; 1940 case UHF_PORT_POWER: 1941 sc->sc_flags.port_powered = 1; 1942 break; 1943 default: 1944 err = USB_ERR_IOERROR; 1945 goto done; 1946 } 1947 goto tr_valid; 1948 1949tr_handle_get_port_status: 1950 1951 DPRINTFN(9, "UR_GET_PORT_STATUS\n"); 1952 1953 if (index != 1) { 1954 goto tr_stalled; 1955 } 1956 if (sc->sc_flags.status_vbus) { 1957 atmegadci_clocks_on(sc); 1958 atmegadci_pull_up(sc); 1959 } else { 1960 atmegadci_pull_down(sc); 1961 atmegadci_clocks_off(sc); 1962 } 1963 1964 /* Select FULL-speed and Device Side Mode */ 1965 1966 value = UPS_PORT_MODE_DEVICE; 1967 1968 if (sc->sc_flags.port_powered) { 1969 value |= UPS_PORT_POWER; 1970 } 1971 if (sc->sc_flags.port_enabled) { 1972 value |= UPS_PORT_ENABLED; 1973 } 1974 if (sc->sc_flags.status_vbus && 1975 sc->sc_flags.status_bus_reset) { 1976 value |= UPS_CURRENT_CONNECT_STATUS; 1977 } 1978 if (sc->sc_flags.status_suspend) { 1979 value |= UPS_SUSPEND; 1980 } 1981 USETW(sc->sc_hub_temp.ps.wPortStatus, value); 1982 1983 value = 0; 1984 1985 if (sc->sc_flags.change_connect) { 1986 value |= UPS_C_CONNECT_STATUS; 1987 } 1988 if (sc->sc_flags.change_suspend) { 1989 value |= UPS_C_SUSPEND; 1990 } 1991 USETW(sc->sc_hub_temp.ps.wPortChange, value); 1992 len = sizeof(sc->sc_hub_temp.ps); 1993 goto tr_valid; 1994 1995tr_handle_get_class_descriptor: 1996 if (value & 0xFF) { 1997 goto tr_stalled; 1998 } 1999 ptr = (const void *)&atmegadci_hubd; 2000 len = sizeof(atmegadci_hubd); 2001 goto tr_valid; 2002 2003tr_stalled: 2004 err = USB_ERR_STALLED; 2005tr_valid: 2006done: 2007 *plength = len; 2008 *pptr = ptr; 2009 return (err); 2010} 2011 2012static void 2013atmegadci_xfer_setup(struct usb_setup_params *parm) 2014{ 2015 const struct usb_hw_ep_profile *pf; 2016 struct atmegadci_softc *sc; 2017 struct usb_xfer *xfer; 2018 void *last_obj; 2019 uint32_t ntd; 2020 uint32_t n; 2021 uint8_t ep_no; 2022 2023 sc = ATMEGA_BUS2SC(parm->udev->bus); 2024 xfer = parm->curr_xfer; 2025 2026 /* 2027 * NOTE: This driver does not use any of the parameters that 2028 * are computed from the following values. Just set some 2029 * reasonable dummies: 2030 */ 2031 parm->hc_max_packet_size = 0x500; 2032 parm->hc_max_packet_count = 1; 2033 parm->hc_max_frame_size = 0x500; 2034 2035 usbd_transfer_setup_sub(parm); 2036 2037 /* 2038 * compute maximum number of TDs 2039 */ 2040 if ((xfer->endpoint->edesc->bmAttributes & UE_XFERTYPE) == UE_CONTROL) { 2041 2042 ntd = xfer->nframes + 1 /* STATUS */ + 1 /* SYNC 1 */ 2043 + 1 /* SYNC 2 */ ; 2044 } else { 2045 2046 ntd = xfer->nframes + 1 /* SYNC */ ; 2047 } 2048 2049 /* 2050 * check if "usbd_transfer_setup_sub" set an error 2051 */ 2052 if (parm->err) 2053 return; 2054 2055 /* 2056 * allocate transfer descriptors 2057 */ 2058 last_obj = NULL; 2059 2060 /* 2061 * get profile stuff 2062 */ 2063 ep_no = xfer->endpointno & UE_ADDR; 2064 atmegadci_get_hw_ep_profile(parm->udev, &pf, ep_no); 2065 2066 if (pf == NULL) { 2067 /* should not happen */ 2068 parm->err = USB_ERR_INVAL; 2069 return; 2070 } 2071 2072 /* align data */ 2073 parm->size[0] += ((-parm->size[0]) & (USB_HOST_ALIGN - 1)); 2074 2075 for (n = 0; n != ntd; n++) { 2076 2077 struct atmegadci_td *td; 2078 2079 if (parm->buf) { 2080 2081 td = USB_ADD_BYTES(parm->buf, parm->size[0]); 2082 2083 /* init TD */ 2084 td->max_packet_size = xfer->max_packet_size; 2085 td->ep_no = ep_no; 2086 if (pf->support_multi_buffer) { 2087 td->support_multi_buffer = 1; 2088 } 2089 td->obj_next = last_obj; 2090 2091 last_obj = td; 2092 } 2093 parm->size[0] += sizeof(*td); 2094 } 2095 2096 xfer->td_start[0] = last_obj; 2097} 2098 2099static void 2100atmegadci_xfer_unsetup(struct usb_xfer *xfer) 2101{ 2102 return; 2103} 2104 2105static void 2106atmegadci_ep_init(struct usb_device *udev, struct usb_endpoint_descriptor *edesc, 2107 struct usb_endpoint *ep) 2108{ 2109 struct atmegadci_softc *sc = ATMEGA_BUS2SC(udev->bus); 2110 2111 DPRINTFN(2, "endpoint=%p, addr=%d, endpt=%d, mode=%d (%d,%d)\n", 2112 ep, udev->address, 2113 edesc->bEndpointAddress, udev->flags.usb_mode, 2114 sc->sc_rt_addr, udev->device_index); 2115 2116 if (udev->device_index != sc->sc_rt_addr) { 2117 2118 if (udev->speed != USB_SPEED_FULL) { 2119 /* not supported */ 2120 return; 2121 } 2122 if ((edesc->bmAttributes & UE_XFERTYPE) == UE_ISOCHRONOUS) 2123 ep->methods = &atmegadci_device_isoc_fs_methods; 2124 else 2125 ep->methods = &atmegadci_device_non_isoc_methods; 2126 } 2127} 2128 2129static void 2130atmegadci_set_hw_power_sleep(struct usb_bus *bus, uint32_t state) 2131{ 2132 struct atmegadci_softc *sc = ATMEGA_BUS2SC(bus); 2133 2134 switch (state) { 2135 case USB_HW_POWER_SUSPEND: 2136 atmegadci_suspend(sc); 2137 break; 2138 case USB_HW_POWER_SHUTDOWN: 2139 atmegadci_uninit(sc); 2140 break; 2141 case USB_HW_POWER_RESUME: 2142 atmegadci_resume(sc); 2143 break; 2144 default: 2145 break; 2146 } 2147} 2148 2149struct usb_bus_methods atmegadci_bus_methods = 2150{ 2151 .endpoint_init = &atmegadci_ep_init, 2152 .xfer_setup = &atmegadci_xfer_setup, 2153 .xfer_unsetup = &atmegadci_xfer_unsetup, 2154 .get_hw_ep_profile = &atmegadci_get_hw_ep_profile, 2155 .xfer_stall = &atmegadci_xfer_stall, 2156 .set_stall = &atmegadci_set_stall, 2157 .clear_stall = &atmegadci_clear_stall, 2158 .roothub_exec = &atmegadci_roothub_exec, 2159 .xfer_poll = &atmegadci_do_poll, 2160 .set_hw_power_sleep = &atmegadci_set_hw_power_sleep, 2161};
|