drivers/usb/mtu3/mtu3_gadget.c

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