1 /* 2 * mtu3_gadget.c - MediaTek usb3 DRD peripheral support 3 * 4 * Copyright (C) 2016 MediaTek Inc. 5 * 6 * Author: Chunfeng Yun <chunfeng.yun@mediatek.com> 7 * 8 * This software is licensed under the terms of the GNU General Public 9 * License version 2, as published by the Free Software Foundation, and 10 * may be copied, distributed, and modified under those terms. 11 * 12 * This program is distributed in the hope that it will be useful, 13 * but WITHOUT ANY WARRANTY; without even the implied warranty of 14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 15 * GNU General Public License for more details. 16 * 17 */ 18 19 #include "mtu3.h" 20 21 void mtu3_req_complete(struct mtu3_ep *mep, 22 struct usb_request *req, int status) 23 __releases(mep->mtu->lock) 24 __acquires(mep->mtu->lock) 25 { 26 struct mtu3_request *mreq; 27 struct mtu3 *mtu; 28 int busy = mep->busy; 29 30 mreq = to_mtu3_request(req); 31 list_del(&mreq->list); 32 if (mreq->request.status == -EINPROGRESS) 33 mreq->request.status = status; 34 35 mtu = mreq->mtu; 36 mep->busy = 1; 37 spin_unlock(&mtu->lock); 38 39 /* ep0 makes use of PIO, needn't unmap it */ 40 if (mep->epnum) 41 usb_gadget_unmap_request(&mtu->g, req, mep->is_in); 42 43 dev_dbg(mtu->dev, "%s complete req: %p, sts %d, %d/%d\n", mep->name, 44 req, req->status, mreq->request.actual, mreq->request.length); 45 46 usb_gadget_giveback_request(&mep->ep, &mreq->request); 47 48 spin_lock(&mtu->lock); 49 mep->busy = busy; 50 } 51 52 static void nuke(struct mtu3_ep *mep, const int status) 53 { 54 struct mtu3_request *mreq = NULL; 55 56 mep->busy = 1; 57 if (list_empty(&mep->req_list)) 58 return; 59 60 dev_dbg(mep->mtu->dev, "abort %s's req: sts %d\n", mep->name, status); 61 62 /* exclude EP0 */ 63 if (mep->epnum) 64 mtu3_qmu_flush(mep); 65 66 while (!list_empty(&mep->req_list)) { 67 mreq = list_first_entry(&mep->req_list, 68 struct mtu3_request, list); 69 mtu3_req_complete(mep, &mreq->request, status); 70 } 71 } 72 73 static int mtu3_ep_enable(struct mtu3_ep *mep) 74 { 75 const struct usb_endpoint_descriptor *desc; 76 const struct usb_ss_ep_comp_descriptor *comp_desc; 77 struct mtu3 *mtu = mep->mtu; 78 u32 interval = 0; 79 u32 mult = 0; 80 u32 burst = 0; 81 int max_packet; 82 int ret; 83 84 desc = mep->desc; 85 comp_desc = mep->comp_desc; 86 mep->type = usb_endpoint_type(desc); 87 max_packet = usb_endpoint_maxp(desc); 88 mep->maxp = max_packet & GENMASK(10, 0); 89 90 switch (mtu->g.speed) { 91 case USB_SPEED_SUPER: 92 if (usb_endpoint_xfer_int(desc) || 93 usb_endpoint_xfer_isoc(desc)) { 94 interval = desc->bInterval; 95 interval = clamp_val(interval, 1, 16) - 1; 96 if (usb_endpoint_xfer_isoc(desc) && comp_desc) 97 mult = comp_desc->bmAttributes; 98 } 99 if (comp_desc) 100 burst = comp_desc->bMaxBurst; 101 102 break; 103 case USB_SPEED_HIGH: 104 if (usb_endpoint_xfer_isoc(desc) || 105 usb_endpoint_xfer_int(desc)) { 106 interval = desc->bInterval; 107 interval = clamp_val(interval, 1, 16) - 1; 108 burst = (max_packet & GENMASK(12, 11)) >> 11; 109 } 110 break; 111 default: 112 break; /*others are ignored */ 113 } 114 115 dev_dbg(mtu->dev, "%s maxp:%d, interval:%d, burst:%d, mult:%d\n", 116 __func__, mep->maxp, interval, burst, mult); 117 118 mep->ep.maxpacket = mep->maxp; 119 mep->ep.desc = desc; 120 mep->ep.comp_desc = comp_desc; 121 122 /* slot mainly affects bulk/isoc transfer, so ignore int */ 123 mep->slot = usb_endpoint_xfer_int(desc) ? 0 : mtu->slot; 124 125 ret = mtu3_config_ep(mtu, mep, interval, burst, mult); 126 if (ret < 0) 127 return ret; 128 129 ret = mtu3_gpd_ring_alloc(mep); 130 if (ret < 0) { 131 mtu3_deconfig_ep(mtu, mep); 132 return ret; 133 } 134 135 mtu3_qmu_start(mep); 136 137 return 0; 138 } 139 140 static int mtu3_ep_disable(struct mtu3_ep *mep) 141 { 142 struct mtu3 *mtu = mep->mtu; 143 144 mtu3_qmu_stop(mep); 145 146 /* abort all pending requests */ 147 nuke(mep, -ESHUTDOWN); 148 mtu3_deconfig_ep(mtu, mep); 149 mtu3_gpd_ring_free(mep); 150 151 mep->desc = NULL; 152 mep->ep.desc = NULL; 153 mep->comp_desc = NULL; 154 mep->type = 0; 155 mep->flags = 0; 156 157 return 0; 158 } 159 160 static int mtu3_gadget_ep_enable(struct usb_ep *ep, 161 const struct usb_endpoint_descriptor *desc) 162 { 163 struct mtu3_ep *mep; 164 struct mtu3 *mtu; 165 unsigned long flags; 166 int ret = -EINVAL; 167 168 if (!ep || !desc || desc->bDescriptorType != USB_DT_ENDPOINT) { 169 pr_debug("%s invalid parameters\n", __func__); 170 return -EINVAL; 171 } 172 173 if (!desc->wMaxPacketSize) { 174 pr_debug("%s missing wMaxPacketSize\n", __func__); 175 return -EINVAL; 176 } 177 mep = to_mtu3_ep(ep); 178 mtu = mep->mtu; 179 180 /* check ep number and direction against endpoint */ 181 if (usb_endpoint_num(desc) != mep->epnum) 182 return -EINVAL; 183 184 if (!!usb_endpoint_dir_in(desc) ^ !!mep->is_in) 185 return -EINVAL; 186 187 dev_dbg(mtu->dev, "%s %s\n", __func__, ep->name); 188 189 if (mep->flags & MTU3_EP_ENABLED) { 190 dev_WARN_ONCE(mtu->dev, true, "%s is already enabled\n", 191 mep->name); 192 return 0; 193 } 194 195 spin_lock_irqsave(&mtu->lock, flags); 196 mep->desc = desc; 197 mep->comp_desc = ep->comp_desc; 198 199 ret = mtu3_ep_enable(mep); 200 if (ret) 201 goto error; 202 203 mep->busy = 0; 204 mep->wedged = 0; 205 mep->flags |= MTU3_EP_ENABLED; 206 mtu->active_ep++; 207 208 error: 209 spin_unlock_irqrestore(&mtu->lock, flags); 210 211 dev_dbg(mtu->dev, "%s active_ep=%d\n", __func__, mtu->active_ep); 212 213 return ret; 214 } 215 216 static int mtu3_gadget_ep_disable(struct usb_ep *ep) 217 { 218 struct mtu3_ep *mep = to_mtu3_ep(ep); 219 struct mtu3 *mtu = mep->mtu; 220 unsigned long flags; 221 222 dev_dbg(mtu->dev, "%s %s\n", __func__, mep->name); 223 224 if (!(mep->flags & MTU3_EP_ENABLED)) { 225 dev_warn(mtu->dev, "%s is already disabled\n", mep->name); 226 return 0; 227 } 228 229 spin_lock_irqsave(&mtu->lock, flags); 230 mtu3_ep_disable(mep); 231 mep->flags &= ~MTU3_EP_ENABLED; 232 mtu->active_ep--; 233 spin_unlock_irqrestore(&(mtu->lock), flags); 234 235 dev_dbg(mtu->dev, "%s active_ep=%d, mtu3 is_active=%d\n", 236 __func__, mtu->active_ep, mtu->is_active); 237 238 return 0; 239 } 240 241 struct usb_request *mtu3_alloc_request(struct usb_ep *ep, gfp_t gfp_flags) 242 { 243 struct mtu3_ep *mep = to_mtu3_ep(ep); 244 struct mtu3_request *mreq; 245 246 mreq = kzalloc(sizeof(*mreq), gfp_flags); 247 if (!mreq) 248 return NULL; 249 250 mreq->request.dma = DMA_ADDR_INVALID; 251 mreq->epnum = mep->epnum; 252 mreq->mep = mep; 253 254 return &mreq->request; 255 } 256 257 void mtu3_free_request(struct usb_ep *ep, struct usb_request *req) 258 { 259 kfree(to_mtu3_request(req)); 260 } 261 262 static int mtu3_gadget_queue(struct usb_ep *ep, 263 struct usb_request *req, gfp_t gfp_flags) 264 { 265 struct mtu3_ep *mep; 266 struct mtu3_request *mreq; 267 struct mtu3 *mtu; 268 unsigned long flags; 269 int ret = 0; 270 271 if (!ep || !req) 272 return -EINVAL; 273 274 if (!req->buf) 275 return -ENODATA; 276 277 mep = to_mtu3_ep(ep); 278 mtu = mep->mtu; 279 mreq = to_mtu3_request(req); 280 mreq->mtu = mtu; 281 282 if (mreq->mep != mep) 283 return -EINVAL; 284 285 dev_dbg(mtu->dev, "%s %s EP%d(%s), req=%p, maxp=%d, len#%d\n", 286 __func__, mep->is_in ? "TX" : "RX", mreq->epnum, ep->name, 287 mreq, ep->maxpacket, mreq->request.length); 288 289 if (req->length > GPD_BUF_SIZE) { 290 dev_warn(mtu->dev, 291 "req length > supported MAX:%d requested:%d\n", 292 GPD_BUF_SIZE, req->length); 293 return -EOPNOTSUPP; 294 } 295 296 /* don't queue if the ep is down */ 297 if (!mep->desc) { 298 dev_dbg(mtu->dev, "req=%p queued to %s while it's disabled\n", 299 req, ep->name); 300 return -ESHUTDOWN; 301 } 302 303 mreq->request.actual = 0; 304 mreq->request.status = -EINPROGRESS; 305 306 ret = usb_gadget_map_request(&mtu->g, req, mep->is_in); 307 if (ret) { 308 dev_err(mtu->dev, "dma mapping failed\n"); 309 return ret; 310 } 311 312 spin_lock_irqsave(&mtu->lock, flags); 313 314 if (mtu3_prepare_transfer(mep)) { 315 ret = -EAGAIN; 316 goto error; 317 } 318 319 list_add_tail(&mreq->list, &mep->req_list); 320 mtu3_insert_gpd(mep, mreq); 321 mtu3_qmu_resume(mep); 322 323 error: 324 spin_unlock_irqrestore(&mtu->lock, flags); 325 326 return ret; 327 } 328 329 static int mtu3_gadget_dequeue(struct usb_ep *ep, struct usb_request *req) 330 { 331 struct mtu3_ep *mep = to_mtu3_ep(ep); 332 struct mtu3_request *mreq = to_mtu3_request(req); 333 struct mtu3_request *r; 334 unsigned long flags; 335 int ret = 0; 336 struct mtu3 *mtu = mep->mtu; 337 338 if (!ep || !req || mreq->mep != mep) 339 return -EINVAL; 340 341 dev_dbg(mtu->dev, "%s : req=%p\n", __func__, req); 342 343 spin_lock_irqsave(&mtu->lock, flags); 344 345 list_for_each_entry(r, &mep->req_list, list) { 346 if (r == mreq) 347 break; 348 } 349 if (r != mreq) { 350 dev_dbg(mtu->dev, "req=%p not queued to %s\n", req, ep->name); 351 ret = -EINVAL; 352 goto done; 353 } 354 355 mtu3_qmu_flush(mep); /* REVISIT: set BPS ?? */ 356 mtu3_req_complete(mep, req, -ECONNRESET); 357 mtu3_qmu_start(mep); 358 359 done: 360 spin_unlock_irqrestore(&mtu->lock, flags); 361 362 return ret; 363 } 364 365 /* 366 * Set or clear the halt bit of an EP. 367 * A halted EP won't TX/RX any data but will queue requests. 368 */ 369 static int mtu3_gadget_ep_set_halt(struct usb_ep *ep, int value) 370 { 371 struct mtu3_ep *mep = to_mtu3_ep(ep); 372 struct mtu3 *mtu = mep->mtu; 373 struct mtu3_request *mreq; 374 unsigned long flags; 375 int ret = 0; 376 377 if (!ep) 378 return -EINVAL; 379 380 dev_dbg(mtu->dev, "%s : %s...", __func__, ep->name); 381 382 spin_lock_irqsave(&mtu->lock, flags); 383 384 if (mep->type == USB_ENDPOINT_XFER_ISOC) { 385 ret = -EINVAL; 386 goto done; 387 } 388 389 mreq = next_request(mep); 390 if (value) { 391 /* 392 * If there is not request for TX-EP, QMU will not transfer 393 * data to TX-FIFO, so no need check whether TX-FIFO 394 * holds bytes or not here 395 */ 396 if (mreq) { 397 dev_dbg(mtu->dev, "req in progress, cannot halt %s\n", 398 ep->name); 399 ret = -EAGAIN; 400 goto done; 401 } 402 } else { 403 mep->wedged = 0; 404 } 405 406 dev_dbg(mtu->dev, "%s %s stall\n", ep->name, value ? "set" : "clear"); 407 408 mtu3_ep_stall_set(mep, value); 409 410 done: 411 spin_unlock_irqrestore(&mtu->lock, flags); 412 413 return ret; 414 } 415 416 /* Sets the halt feature with the clear requests ignored */ 417 static int mtu3_gadget_ep_set_wedge(struct usb_ep *ep) 418 { 419 struct mtu3_ep *mep = to_mtu3_ep(ep); 420 421 if (!ep) 422 return -EINVAL; 423 424 mep->wedged = 1; 425 426 return usb_ep_set_halt(ep); 427 } 428 429 static const struct usb_ep_ops mtu3_ep_ops = { 430 .enable = mtu3_gadget_ep_enable, 431 .disable = mtu3_gadget_ep_disable, 432 .alloc_request = mtu3_alloc_request, 433 .free_request = mtu3_free_request, 434 .queue = mtu3_gadget_queue, 435 .dequeue = mtu3_gadget_dequeue, 436 .set_halt = mtu3_gadget_ep_set_halt, 437 .set_wedge = mtu3_gadget_ep_set_wedge, 438 }; 439 440 static int mtu3_gadget_get_frame(struct usb_gadget *gadget) 441 { 442 struct mtu3 *mtu = gadget_to_mtu3(gadget); 443 444 return (int)mtu3_readl(mtu->mac_base, U3D_USB20_FRAME_NUM); 445 } 446 447 static int mtu3_gadget_wakeup(struct usb_gadget *gadget) 448 { 449 struct mtu3 *mtu = gadget_to_mtu3(gadget); 450 unsigned long flags; 451 452 dev_dbg(mtu->dev, "%s\n", __func__); 453 454 /* remote wakeup feature is not enabled by host */ 455 if (!mtu->may_wakeup) 456 return -EOPNOTSUPP; 457 458 spin_lock_irqsave(&mtu->lock, flags); 459 if (mtu->g.speed == USB_SPEED_SUPER) { 460 mtu3_setbits(mtu->mac_base, U3D_LINK_POWER_CONTROL, UX_EXIT); 461 } else { 462 mtu3_setbits(mtu->mac_base, U3D_POWER_MANAGEMENT, RESUME); 463 spin_unlock_irqrestore(&mtu->lock, flags); 464 usleep_range(10000, 11000); 465 spin_lock_irqsave(&mtu->lock, flags); 466 mtu3_clrbits(mtu->mac_base, U3D_POWER_MANAGEMENT, RESUME); 467 } 468 spin_unlock_irqrestore(&mtu->lock, flags); 469 return 0; 470 } 471 472 static int mtu3_gadget_set_self_powered(struct usb_gadget *gadget, 473 int is_selfpowered) 474 { 475 struct mtu3 *mtu = gadget_to_mtu3(gadget); 476 477 mtu->is_self_powered = !!is_selfpowered; 478 return 0; 479 } 480 481 static int mtu3_gadget_pullup(struct usb_gadget *gadget, int is_on) 482 { 483 struct mtu3 *mtu = gadget_to_mtu3(gadget); 484 unsigned long flags; 485 486 dev_dbg(mtu->dev, "%s (%s) for %sactive device\n", __func__, 487 is_on ? "on" : "off", mtu->is_active ? "" : "in"); 488 489 /* we'd rather not pullup unless the device is active. */ 490 spin_lock_irqsave(&mtu->lock, flags); 491 492 is_on = !!is_on; 493 if (!mtu->is_active) { 494 /* save it for mtu3_start() to process the request */ 495 mtu->softconnect = is_on; 496 } else if (is_on != mtu->softconnect) { 497 mtu->softconnect = is_on; 498 mtu3_dev_on_off(mtu, is_on); 499 } 500 501 spin_unlock_irqrestore(&mtu->lock, flags); 502 503 return 0; 504 } 505 506 static int mtu3_gadget_start(struct usb_gadget *gadget, 507 struct usb_gadget_driver *driver) 508 { 509 struct mtu3 *mtu = gadget_to_mtu3(gadget); 510 unsigned long flags; 511 512 if (mtu->gadget_driver) { 513 dev_err(mtu->dev, "%s is already bound to %s\n", 514 mtu->g.name, mtu->gadget_driver->driver.name); 515 return -EBUSY; 516 } 517 518 dev_dbg(mtu->dev, "bind driver %s\n", driver->function); 519 520 spin_lock_irqsave(&mtu->lock, flags); 521 522 mtu->softconnect = 0; 523 mtu->gadget_driver = driver; 524 525 if (mtu->ssusb->dr_mode == USB_DR_MODE_PERIPHERAL) 526 mtu3_start(mtu); 527 528 spin_unlock_irqrestore(&mtu->lock, flags); 529 530 return 0; 531 } 532 533 static void stop_activity(struct mtu3 *mtu) 534 { 535 struct usb_gadget_driver *driver = mtu->gadget_driver; 536 int i; 537 538 /* don't disconnect if it's not connected */ 539 if (mtu->g.speed == USB_SPEED_UNKNOWN) 540 driver = NULL; 541 else 542 mtu->g.speed = USB_SPEED_UNKNOWN; 543 544 /* deactivate the hardware */ 545 if (mtu->softconnect) { 546 mtu->softconnect = 0; 547 mtu3_dev_on_off(mtu, 0); 548 } 549 550 /* 551 * killing any outstanding requests will quiesce the driver; 552 * then report disconnect 553 */ 554 nuke(mtu->ep0, -ESHUTDOWN); 555 for (i = 1; i < mtu->num_eps; i++) { 556 nuke(mtu->in_eps + i, -ESHUTDOWN); 557 nuke(mtu->out_eps + i, -ESHUTDOWN); 558 } 559 560 if (driver) { 561 spin_unlock(&mtu->lock); 562 driver->disconnect(&mtu->g); 563 spin_lock(&mtu->lock); 564 } 565 } 566 567 static int mtu3_gadget_stop(struct usb_gadget *g) 568 { 569 struct mtu3 *mtu = gadget_to_mtu3(g); 570 unsigned long flags; 571 572 dev_dbg(mtu->dev, "%s\n", __func__); 573 574 spin_lock_irqsave(&mtu->lock, flags); 575 576 stop_activity(mtu); 577 mtu->gadget_driver = NULL; 578 579 if (mtu->ssusb->dr_mode == USB_DR_MODE_PERIPHERAL) 580 mtu3_stop(mtu); 581 582 spin_unlock_irqrestore(&mtu->lock, flags); 583 584 return 0; 585 } 586 587 static const struct usb_gadget_ops mtu3_gadget_ops = { 588 .get_frame = mtu3_gadget_get_frame, 589 .wakeup = mtu3_gadget_wakeup, 590 .set_selfpowered = mtu3_gadget_set_self_powered, 591 .pullup = mtu3_gadget_pullup, 592 .udc_start = mtu3_gadget_start, 593 .udc_stop = mtu3_gadget_stop, 594 }; 595 596 static void init_hw_ep(struct mtu3 *mtu, struct mtu3_ep *mep, 597 u32 epnum, u32 is_in) 598 { 599 mep->epnum = epnum; 600 mep->mtu = mtu; 601 mep->is_in = is_in; 602 603 INIT_LIST_HEAD(&mep->req_list); 604 605 sprintf(mep->name, "ep%d%s", epnum, 606 !epnum ? "" : (is_in ? "in" : "out")); 607 608 mep->ep.name = mep->name; 609 INIT_LIST_HEAD(&mep->ep.ep_list); 610 611 /* initialize maxpacket as SS */ 612 if (!epnum) { 613 usb_ep_set_maxpacket_limit(&mep->ep, 512); 614 mep->ep.caps.type_control = true; 615 mep->ep.ops = &mtu3_ep0_ops; 616 mtu->g.ep0 = &mep->ep; 617 } else { 618 usb_ep_set_maxpacket_limit(&mep->ep, 1024); 619 mep->ep.caps.type_iso = true; 620 mep->ep.caps.type_bulk = true; 621 mep->ep.caps.type_int = true; 622 mep->ep.ops = &mtu3_ep_ops; 623 list_add_tail(&mep->ep.ep_list, &mtu->g.ep_list); 624 } 625 626 dev_dbg(mtu->dev, "%s, name=%s, maxp=%d\n", __func__, mep->ep.name, 627 mep->ep.maxpacket); 628 629 if (!epnum) { 630 mep->ep.caps.dir_in = true; 631 mep->ep.caps.dir_out = true; 632 } else if (is_in) { 633 mep->ep.caps.dir_in = true; 634 } else { 635 mep->ep.caps.dir_out = true; 636 } 637 } 638 639 static void mtu3_gadget_init_eps(struct mtu3 *mtu) 640 { 641 u8 epnum; 642 643 /* initialize endpoint list just once */ 644 INIT_LIST_HEAD(&(mtu->g.ep_list)); 645 646 dev_dbg(mtu->dev, "%s num_eps(1 for a pair of tx&rx ep)=%d\n", 647 __func__, mtu->num_eps); 648 649 init_hw_ep(mtu, mtu->ep0, 0, 0); 650 for (epnum = 1; epnum < mtu->num_eps; epnum++) { 651 init_hw_ep(mtu, mtu->in_eps + epnum, epnum, 1); 652 init_hw_ep(mtu, mtu->out_eps + epnum, epnum, 0); 653 } 654 } 655 656 int mtu3_gadget_setup(struct mtu3 *mtu) 657 { 658 int ret; 659 660 mtu->g.ops = &mtu3_gadget_ops; 661 mtu->g.max_speed = mtu->max_speed; 662 mtu->g.speed = USB_SPEED_UNKNOWN; 663 mtu->g.sg_supported = 0; 664 mtu->g.name = MTU3_DRIVER_NAME; 665 mtu->is_active = 0; 666 mtu->delayed_status = false; 667 668 mtu3_gadget_init_eps(mtu); 669 670 ret = usb_add_gadget_udc(mtu->dev, &mtu->g); 671 if (ret) { 672 dev_err(mtu->dev, "failed to register udc\n"); 673 return ret; 674 } 675 676 usb_gadget_set_state(&mtu->g, USB_STATE_NOTATTACHED); 677 678 return 0; 679 } 680 681 void mtu3_gadget_cleanup(struct mtu3 *mtu) 682 { 683 usb_del_gadget_udc(&mtu->g); 684 } 685 686 void mtu3_gadget_resume(struct mtu3 *mtu) 687 { 688 dev_dbg(mtu->dev, "gadget RESUME\n"); 689 if (mtu->gadget_driver && mtu->gadget_driver->resume) { 690 spin_unlock(&mtu->lock); 691 mtu->gadget_driver->resume(&mtu->g); 692 spin_lock(&mtu->lock); 693 } 694 } 695 696 /* called when SOF packets stop for 3+ msec or enters U3 */ 697 void mtu3_gadget_suspend(struct mtu3 *mtu) 698 { 699 dev_dbg(mtu->dev, "gadget SUSPEND\n"); 700 if (mtu->gadget_driver && mtu->gadget_driver->suspend) { 701 spin_unlock(&mtu->lock); 702 mtu->gadget_driver->suspend(&mtu->g); 703 spin_lock(&mtu->lock); 704 } 705 } 706 707 /* called when VBUS drops below session threshold, and in other cases */ 708 void mtu3_gadget_disconnect(struct mtu3 *mtu) 709 { 710 dev_dbg(mtu->dev, "gadget DISCONNECT\n"); 711 if (mtu->gadget_driver && mtu->gadget_driver->disconnect) { 712 spin_unlock(&mtu->lock); 713 mtu->gadget_driver->disconnect(&mtu->g); 714 spin_lock(&mtu->lock); 715 } 716 717 usb_gadget_set_state(&mtu->g, USB_STATE_NOTATTACHED); 718 } 719 720 void mtu3_gadget_reset(struct mtu3 *mtu) 721 { 722 dev_dbg(mtu->dev, "gadget RESET\n"); 723 724 /* report disconnect, if we didn't flush EP state */ 725 if (mtu->g.speed != USB_SPEED_UNKNOWN) 726 mtu3_gadget_disconnect(mtu); 727 728 mtu->address = 0; 729 mtu->ep0_state = MU3D_EP0_STATE_SETUP; 730 mtu->may_wakeup = 0; 731 mtu->u1_enable = 0; 732 mtu->u2_enable = 0; 733 mtu->delayed_status = false; 734 } 735