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