target/linux/ramips/files-3.7/drivers/usb/dwc_otg/dwc_otg_hcd_queue.c

   1 /* ==========================================================================
   2  * $File: //dwh/usb_iip/dev/software/otg_ipmate/linux/drivers/dwc_otg_hcd_queue.c $
   3  * $Revision: 1.5 $
   4  * $Date: 2008-12-15 06:51:32 $
   5  * $Change: 537387 $
   6  *
   7  * Synopsys HS OTG Linux Software Driver and documentation (hereinafter,
   8  * "Software") is an Unsupported proprietary work of Synopsys, Inc. unless
   9  * otherwise expressly agreed to in writing between Synopsys and you.
  10  *
  11  * The Software IS NOT an item of Licensed Software or Licensed Product under
  12  * any End User Software License Agreement or Agreement for Licensed Product
  13  * with Synopsys or any supplement thereto. You are permitted to use and
  14  * redistribute this Software in source and binary forms, with or without
  15  * modification, provided that redistributions of source code must retain this
  16  * notice. You may not view, use, disclose, copy or distribute this file or
  17  * any information contained herein except pursuant to this license grant from
  18  * Synopsys. If you do not agree with this notice, including the disclaimer
  19  * below, then you are not authorized to use the Software.
  20  *
  21  * THIS SOFTWARE IS BEING DISTRIBUTED BY SYNOPSYS SOLELY ON AN "AS IS" BASIS
  22  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  23  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  24  * ARE HEREBY DISCLAIMED. IN NO EVENT SHALL SYNOPSYS BE LIABLE FOR ANY DIRECT,
  25  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
  26  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
  27  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
  28  * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  29  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  30  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH
  31  * DAMAGE.
  32  * ========================================================================== */
  33 #ifndef DWC_DEVICE_ONLY
  34
  35 /**
  36  * @file
  37  *
  38  * This file contains the functions to manage Queue Heads and Queue
  39  * Transfer Descriptors.
  40  */
  41 #include <linux/kernel.h>
  42 #include <linux/module.h>
  43 #include <linux/moduleparam.h>
  44 #include <linux/init.h>
  45 #include <linux/device.h>
  46 #include <linux/errno.h>
  47 #include <linux/list.h>
  48 #include <linux/interrupt.h>
  49 #include <linux/string.h>
  50 #include <linux/dma-mapping.h>
  51
  52 #include "dwc_otg_driver.h"
  53 #include "dwc_otg_hcd.h"
  54 #include "dwc_otg_regs.h"
  55
  56 /**
  57  * This function allocates and initializes a QH.
  58  *
  59  * @param hcd The HCD state structure for the DWC OTG controller.
  60  * @param[in] urb Holds the information about the device/endpoint that we need
  61  * to initialize the QH.
  62  *
  63  * @return Returns pointer to the newly allocated QH, or NULL on error. */
  64 dwc_otg_qh_t *dwc_otg_hcd_qh_create (dwc_otg_hcd_t *hcd, struct urb *urb)
  65 {
  66         dwc_otg_qh_t *qh;
  67
  68         /* Allocate memory */
  69         /** @todo add memflags argument */
  70         qh = dwc_otg_hcd_qh_alloc ();
  71         if (qh == NULL) {
  72                 return NULL;
  73         }
  74
  75         dwc_otg_hcd_qh_init (hcd, qh, urb);
  76         return qh;
  77 }
  78
  79 /** Free each QTD in the QH's QTD-list then free the QH.  QH should already be
  80  * removed from a list.  QTD list should already be empty if called from URB
  81  * Dequeue.
  82  *
  83  * @param[in] hcd HCD instance.
  84  * @param[in] qh The QH to free.
  85  */
  86 void dwc_otg_hcd_qh_free (dwc_otg_hcd_t *hcd, dwc_otg_qh_t *qh)
  87 {
  88         dwc_otg_qtd_t *qtd;
  89         struct list_head *pos;
  90         unsigned long flags;
  91
  92         /* Free each QTD in the QTD list */
  93         SPIN_LOCK_IRQSAVE(&hcd->lock, flags)
  94         for (pos = qh->qtd_list.next;
  95              pos != &qh->qtd_list;
  96              pos = qh->qtd_list.next)
  97         {
  98                 list_del (pos);
  99                 qtd = dwc_list_to_qtd (pos);
 100                 dwc_otg_hcd_qtd_free (qtd);
 101         }
 102         SPIN_UNLOCK_IRQRESTORE(&hcd->lock, flags)
 103
 104         if (qh->dw_align_buf) {
 105                 dma_free_coherent((dwc_otg_hcd_to_hcd(hcd))->self.controller,
 106                                   hcd->core_if->core_params->max_transfer_size,
 107                                   qh->dw_align_buf,
 108                                   qh->dw_align_buf_dma);
 109         }
 110
 111         kfree (qh);
 112         return;
 113 }
 114
 115 /** Initializes a QH structure.
 116  *
 117  * @param[in] hcd The HCD state structure for the DWC OTG controller.
 118  * @param[in] qh The QH to init.
 119  * @param[in] urb Holds the information about the device/endpoint that we need
 120  * to initialize the QH. */
 121 #define SCHEDULE_SLOP 10
 122 void dwc_otg_hcd_qh_init(dwc_otg_hcd_t *hcd, dwc_otg_qh_t *qh, struct urb *urb)
 123 {
 124         char *speed, *type;
 125         memset (qh, 0, sizeof (dwc_otg_qh_t));
 126
 127         /* Initialize QH */
 128         switch (usb_pipetype(urb->pipe)) {
 129         case PIPE_CONTROL:
 130                 qh->ep_type = USB_ENDPOINT_XFER_CONTROL;
 131                 break;
 132         case PIPE_BULK:
 133                 qh->ep_type = USB_ENDPOINT_XFER_BULK;
 134                 break;
 135         case PIPE_ISOCHRONOUS:
 136                 qh->ep_type = USB_ENDPOINT_XFER_ISOC;
 137                 break;
 138         case PIPE_INTERRUPT:
 139                 qh->ep_type = USB_ENDPOINT_XFER_INT;
 140                 break;
 141         }
 142
 143         qh->ep_is_in = usb_pipein(urb->pipe) ? 1 : 0;
 144
 145         qh->data_toggle = DWC_OTG_HC_PID_DATA0;
 146         qh->maxp = usb_maxpacket(urb->dev, urb->pipe, !(usb_pipein(urb->pipe)));
 147         INIT_LIST_HEAD(&qh->qtd_list);
 148         INIT_LIST_HEAD(&qh->qh_list_entry);
 149         qh->channel = NULL;
 150
 151         /* FS/LS Enpoint on HS Hub
 152          * NOT virtual root hub */
 153         qh->do_split = 0;
 154         if (((urb->dev->speed == USB_SPEED_LOW) ||
 155              (urb->dev->speed == USB_SPEED_FULL)) &&
 156              (urb->dev->tt) && (urb->dev->tt->hub) && (urb->dev->tt->hub->devnum != 1))
 157         {
 158                 DWC_DEBUGPL(DBG_HCD, "QH init: EP %d: TT found at hub addr %d, for port %d\n",
 159                            usb_pipeendpoint(urb->pipe), urb->dev->tt->hub->devnum,
 160                            urb->dev->ttport);
 161                 qh->do_split = 1;
 162         }
 163
 164         if (qh->ep_type == USB_ENDPOINT_XFER_INT ||
 165             qh->ep_type == USB_ENDPOINT_XFER_ISOC) {
 166                 /* Compute scheduling parameters once and save them. */
 167                 hprt0_data_t hprt;
 168
 169                 /** @todo Account for split transfers in the bus time. */
 170                 int bytecount = dwc_hb_mult(qh->maxp) * dwc_max_packet(qh->maxp);
 171
 172                 /* FIXME: work-around patch by Steven */
 173                 qh->usecs = NS_TO_US(usb_calc_bus_time(urb->dev->speed,
 174                                                usb_pipein(urb->pipe),
 175                                                (qh->ep_type == USB_ENDPOINT_XFER_ISOC),
 176                                                bytecount));
 177
 178                 /* Start in a slightly future (micro)frame. */
 179                 qh->sched_frame = dwc_frame_num_inc(hcd->frame_number,
 180                                                      SCHEDULE_SLOP);
 181                 qh->interval = urb->interval;
 182 #if 0
 183                 /* Increase interrupt polling rate for debugging. */
 184                 if (qh->ep_type == USB_ENDPOINT_XFER_INT) {
 185                         qh->interval = 8;
 186                 }
 187 #endif
 188                 hprt.d32 = dwc_read_reg32(hcd->core_if->host_if->hprt0);
 189                 if ((hprt.b.prtspd == DWC_HPRT0_PRTSPD_HIGH_SPEED) &&
 190                     ((urb->dev->speed == USB_SPEED_LOW) ||
 191                      (urb->dev->speed == USB_SPEED_FULL))) {
 192                         qh->interval *= 8;
 193                         qh->sched_frame |= 0x7;
 194                         qh->start_split_frame = qh->sched_frame;
 195                 }
 196
 197         }
 198
 199         DWC_DEBUGPL(DBG_HCD, "DWC OTG HCD QH Initialized\n");
 200         DWC_DEBUGPL(DBG_HCDV, "DWC OTG HCD QH  - qh = %p\n", qh);
 201         DWC_DEBUGPL(DBG_HCDV, "DWC OTG HCD QH  - Device Address = %d\n",
 202                     urb->dev->devnum);
 203         DWC_DEBUGPL(DBG_HCDV, "DWC OTG HCD QH  - Endpoint %d, %s\n",
 204                     usb_pipeendpoint(urb->pipe),
 205                     usb_pipein(urb->pipe) == USB_DIR_IN ? "IN" : "OUT");
 206
 207         switch(urb->dev->speed) {
 208         case USB_SPEED_LOW:
 209                 speed = "low";
 210                 break;
 211         case USB_SPEED_FULL:
 212                 speed = "full";
 213                 break;
 214         case USB_SPEED_HIGH:
 215                 speed = "high";
 216                 break;
 217         default:
 218                 speed = "?";
 219                 break;
 220         }
 221         DWC_DEBUGPL(DBG_HCDV, "DWC OTG HCD QH  - Speed = %s\n", speed);
 222
 223         switch (qh->ep_type) {
 224         case USB_ENDPOINT_XFER_ISOC:
 225                 type = "isochronous";
 226                 break;
 227         case USB_ENDPOINT_XFER_INT:
 228                 type = "interrupt";
 229                 break;
 230         case USB_ENDPOINT_XFER_CONTROL:
 231                 type = "control";
 232                 break;
 233         case USB_ENDPOINT_XFER_BULK:
 234                 type = "bulk";
 235                 break;
 236         default:
 237                 type = "?";
 238                 break;
 239         }
 240         DWC_DEBUGPL(DBG_HCDV, "DWC OTG HCD QH  - Type = %s\n",type);
 241
 242 #ifdef DEBUG
 243         if (qh->ep_type == USB_ENDPOINT_XFER_INT) {
 244                 DWC_DEBUGPL(DBG_HCDV, "DWC OTG HCD QH - usecs = %d\n",
 245                             qh->usecs);
 246                 DWC_DEBUGPL(DBG_HCDV, "DWC OTG HCD QH - interval = %d\n",
 247                             qh->interval);
 248         }
 249 #endif
 250         qh->dw_align_buf = NULL;
 251         return;
 252 }
 253
 254 /**
 255  * Checks that a channel is available for a periodic transfer.
 256  *
 257  * @return 0 if successful, negative error code otherise.
 258  */
 259 static int periodic_channel_available(dwc_otg_hcd_t *hcd)
 260 {
 261         /*
 262          * Currently assuming that there is a dedicated host channnel for each
 263          * periodic transaction plus at least one host channel for
 264          * non-periodic transactions.
 265          */
 266         int status;
 267         int num_channels;
 268
 269         num_channels = hcd->core_if->core_params->host_channels;
 270         if ((hcd->periodic_channels + hcd->non_periodic_channels < num_channels) &&
 271             (hcd->periodic_channels < num_channels - 1)) {
 272                 status = 0;
 273         }
 274         else {
 275                 DWC_NOTICE("%s: Total channels: %d, Periodic: %d, Non-periodic: %d\n",
 276                            __func__, num_channels, hcd->periodic_channels,
 277                            hcd->non_periodic_channels);
 278                 status = -ENOSPC;
 279         }
 280
 281         return status;
 282 }
 283
 284 /**
 285  * Checks that there is sufficient bandwidth for the specified QH in the
 286  * periodic schedule. For simplicity, this calculation assumes that all the
 287  * transfers in the periodic schedule may occur in the same (micro)frame.
 288  *
 289  * @param hcd The HCD state structure for the DWC OTG controller.
 290  * @param qh QH containing periodic bandwidth required.
 291  *
 292  * @return 0 if successful, negative error code otherwise.
 293  */
 294 static int check_periodic_bandwidth(dwc_otg_hcd_t *hcd, dwc_otg_qh_t *qh)
 295 {
 296         int             status;
 297         uint16_t        max_claimed_usecs;
 298
 299         status = 0;
 300
 301         if (hcd->core_if->core_params->speed == DWC_SPEED_PARAM_HIGH) {
 302                 /*
 303                  * High speed mode.
 304                  * Max periodic usecs is 80% x 125 usec = 100 usec.
 305                  */
 306                 max_claimed_usecs = 100 - qh->usecs;
 307         } else {
 308                 /*
 309                  * Full speed mode.
 310                  * Max periodic usecs is 90% x 1000 usec = 900 usec.
 311                  */
 312                 max_claimed_usecs = 900 - qh->usecs;
 313         }
 314
 315         if (hcd->periodic_usecs > max_claimed_usecs) {
 316                 DWC_NOTICE("%s: already claimed usecs %d, required usecs %d\n",
 317                            __func__, hcd->periodic_usecs, qh->usecs);
 318                 status = -ENOSPC;
 319         }
 320
 321         return status;
 322 }
 323
 324 /**
 325  * Checks that the max transfer size allowed in a host channel is large enough
 326  * to handle the maximum data transfer in a single (micro)frame for a periodic
 327  * transfer.
 328  *
 329  * @param hcd The HCD state structure for the DWC OTG controller.
 330  * @param qh QH for a periodic endpoint.
 331  *
 332  * @return 0 if successful, negative error code otherwise.
 333  */
 334 static int check_max_xfer_size(dwc_otg_hcd_t *hcd, dwc_otg_qh_t *qh)
 335 {
 336         int             status;
 337         uint32_t        max_xfer_size;
 338         uint32_t        max_channel_xfer_size;
 339
 340         status = 0;
 341
 342         max_xfer_size = dwc_max_packet(qh->maxp) * dwc_hb_mult(qh->maxp);
 343         max_channel_xfer_size = hcd->core_if->core_params->max_transfer_size;
 344
 345         if (max_xfer_size > max_channel_xfer_size) {
 346                 DWC_NOTICE("%s: Periodic xfer length %d > "
 347                             "max xfer length for channel %d\n",
 348                             __func__, max_xfer_size, max_channel_xfer_size);
 349                 status = -ENOSPC;
 350         }
 351
 352         return status;
 353 }
 354
 355 /**
 356  * Schedules an interrupt or isochronous transfer in the periodic schedule.
 357  *
 358  * @param hcd The HCD state structure for the DWC OTG controller.
 359  * @param qh QH for the periodic transfer. The QH should already contain the
 360  * scheduling information.
 361  *
 362  * @return 0 if successful, negative error code otherwise.
 363  */
 364 static int schedule_periodic(dwc_otg_hcd_t *hcd, dwc_otg_qh_t *qh)
 365 {
 366         int status = 0;
 367
 368         status = periodic_channel_available(hcd);
 369         if (status) {
 370                 DWC_NOTICE("%s: No host channel available for periodic "
 371                            "transfer.\n", __func__);
 372                 return status;
 373         }
 374
 375         status = check_periodic_bandwidth(hcd, qh);
 376         if (status) {
 377                 DWC_NOTICE("%s: Insufficient periodic bandwidth for "
 378                            "periodic transfer.\n", __func__);
 379                 return status;
 380         }
 381
 382         status = check_max_xfer_size(hcd, qh);
 383         if (status) {
 384                 DWC_NOTICE("%s: Channel max transfer size too small "
 385                             "for periodic transfer.\n", __func__);
 386                 return status;
 387         }
 388
 389         /* Always start in the inactive schedule. */
 390         list_add_tail(&qh->qh_list_entry, &hcd->periodic_sched_inactive);
 391
 392         /* Reserve the periodic channel. */
 393         hcd->periodic_channels++;
 394
 395         /* Update claimed usecs per (micro)frame. */
 396         hcd->periodic_usecs += qh->usecs;
 397
 398         /* Update average periodic bandwidth claimed and # periodic reqs for usbfs. */
 399         hcd_to_bus(dwc_otg_hcd_to_hcd(hcd))->bandwidth_allocated += qh->usecs / qh->interval;
 400         if (qh->ep_type == USB_ENDPOINT_XFER_INT) {
 401                 hcd_to_bus(dwc_otg_hcd_to_hcd(hcd))->bandwidth_int_reqs++;
 402                 DWC_DEBUGPL(DBG_HCD, "Scheduled intr: qh %p, usecs %d, period %d\n",
 403                             qh, qh->usecs, qh->interval);
 404         } else {
 405                 hcd_to_bus(dwc_otg_hcd_to_hcd(hcd))->bandwidth_isoc_reqs++;
 406                 DWC_DEBUGPL(DBG_HCD, "Scheduled isoc: qh %p, usecs %d, period %d\n",
 407                             qh, qh->usecs, qh->interval);
 408         }
 409
 410         return status;
 411 }
 412
 413 /**
 414  * This function adds a QH to either the non periodic or periodic schedule if
 415  * it is not already in the schedule. If the QH is already in the schedule, no
 416  * action is taken.
 417  *
 418  * @return 0 if successful, negative error code otherwise.
 419  */
 420 int dwc_otg_hcd_qh_add (dwc_otg_hcd_t *hcd, dwc_otg_qh_t *qh)
 421 {
 422         unsigned long flags;
 423         int status = 0;
 424
 425         SPIN_LOCK_IRQSAVE(&hcd->lock, flags)
 426
 427         if (!list_empty(&qh->qh_list_entry)) {
 428                 /* QH already in a schedule. */
 429                 goto done;
 430         }
 431
 432         /* Add the new QH to the appropriate schedule */
 433         if (dwc_qh_is_non_per(qh)) {
 434                 /* Always start in the inactive schedule. */
 435                 list_add_tail(&qh->qh_list_entry, &hcd->non_periodic_sched_inactive);
 436         } else {
 437                 status = schedule_periodic(hcd, qh);
 438         }
 439
 440  done:
 441         SPIN_UNLOCK_IRQRESTORE(&hcd->lock, flags)
 442
 443         return status;
 444 }
 445
 446 /**
 447  * Removes an interrupt or isochronous transfer from the periodic schedule.
 448  *
 449  * @param hcd The HCD state structure for the DWC OTG controller.
 450  * @param qh QH for the periodic transfer.
 451  */
 452 static void deschedule_periodic(dwc_otg_hcd_t *hcd, dwc_otg_qh_t *qh)
 453 {
 454         list_del_init(&qh->qh_list_entry);
 455
 456         /* Release the periodic channel reservation. */
 457         hcd->periodic_channels--;
 458
 459         /* Update claimed usecs per (micro)frame. */
 460         hcd->periodic_usecs -= qh->usecs;
 461
 462         /* Update average periodic bandwidth claimed and # periodic reqs for usbfs. */
 463         hcd_to_bus(dwc_otg_hcd_to_hcd(hcd))->bandwidth_allocated -= qh->usecs / qh->interval;
 464
 465         if (qh->ep_type == USB_ENDPOINT_XFER_INT) {
 466                 hcd_to_bus(dwc_otg_hcd_to_hcd(hcd))->bandwidth_int_reqs--;
 467                 DWC_DEBUGPL(DBG_HCD, "Descheduled intr: qh %p, usecs %d, period %d\n",
 468                             qh, qh->usecs, qh->interval);
 469         } else {
 470                 hcd_to_bus(dwc_otg_hcd_to_hcd(hcd))->bandwidth_isoc_reqs--;
 471                 DWC_DEBUGPL(DBG_HCD, "Descheduled isoc: qh %p, usecs %d, period %d\n",
 472                             qh, qh->usecs, qh->interval);
 473         }
 474 }
 475
 476 /**
 477  * Removes a QH from either the non-periodic or periodic schedule.  Memory is
 478  * not freed.
 479  *
 480  * @param[in] hcd The HCD state structure.
 481  * @param[in] qh QH to remove from schedule. */
 482 void dwc_otg_hcd_qh_remove (dwc_otg_hcd_t *hcd, dwc_otg_qh_t *qh)
 483 {
 484         unsigned long flags;
 485
 486         SPIN_LOCK_IRQSAVE(&hcd->lock, flags);
 487
 488         if (list_empty(&qh->qh_list_entry)) {
 489                 /* QH is not in a schedule. */
 490                 goto done;
 491         }
 492
 493         if (dwc_qh_is_non_per(qh)) {
 494                 if (hcd->non_periodic_qh_ptr == &qh->qh_list_entry) {
 495                         hcd->non_periodic_qh_ptr = hcd->non_periodic_qh_ptr->next;
 496                 }
 497                 list_del_init(&qh->qh_list_entry);
 498         } else {
 499                 deschedule_periodic(hcd, qh);
 500         }
 501
 502  done:
 503         SPIN_UNLOCK_IRQRESTORE(&hcd->lock, flags)
 504 }
 505
 506 /**
 507  * Deactivates a QH. For non-periodic QHs, removes the QH from the active
 508  * non-periodic schedule. The QH is added to the inactive non-periodic
 509  * schedule if any QTDs are still attached to the QH.
 510  *
 511  * For periodic QHs, the QH is removed from the periodic queued schedule. If
 512  * there are any QTDs still attached to the QH, the QH is added to either the
 513  * periodic inactive schedule or the periodic ready schedule and its next
 514  * scheduled frame is calculated. The QH is placed in the ready schedule if
 515  * the scheduled frame has been reached already. Otherwise it's placed in the
 516  * inactive schedule. If there are no QTDs attached to the QH, the QH is
 517  * completely removed from the periodic schedule.
 518  */
 519 void dwc_otg_hcd_qh_deactivate(dwc_otg_hcd_t *hcd, dwc_otg_qh_t *qh, int sched_next_periodic_split)
 520 {
 521         unsigned long flags;
 522         SPIN_LOCK_IRQSAVE(&hcd->lock, flags);
 523
 524         if (dwc_qh_is_non_per(qh)) {
 525                 dwc_otg_hcd_qh_remove(hcd, qh);
 526                 if (!list_empty(&qh->qtd_list)) {
 527                         /* Add back to inactive non-periodic schedule. */
 528                         dwc_otg_hcd_qh_add(hcd, qh);
 529                 }
 530         } else {
 531                 uint16_t frame_number = dwc_otg_hcd_get_frame_number(dwc_otg_hcd_to_hcd(hcd));
 532
 533                 if (qh->do_split) {
 534                         /* Schedule the next continuing periodic split transfer */
 535                         if (sched_next_periodic_split) {
 536
 537                                 qh->sched_frame = frame_number;
 538                                 if (dwc_frame_num_le(frame_number,
 539                                                      dwc_frame_num_inc(qh->start_split_frame, 1))) {
 540                                         /*
 541                                          * Allow one frame to elapse after start
 542                                          * split microframe before scheduling
 543                                          * complete split, but DONT if we are
 544                                          * doing the next start split in the
 545                                          * same frame for an ISOC out.
 546                                          */
 547                                         if ((qh->ep_type != USB_ENDPOINT_XFER_ISOC) || (qh->ep_is_in != 0)) {
 548                                                 qh->sched_frame = dwc_frame_num_inc(qh->sched_frame, 1);
 549                                         }
 550                                 }
 551                         } else {
 552                                 qh->sched_frame = dwc_frame_num_inc(qh->start_split_frame,
 553                                                                      qh->interval);
 554                                 if (dwc_frame_num_le(qh->sched_frame, frame_number)) {
 555                                         qh->sched_frame = frame_number;
 556                                 }
 557                                 qh->sched_frame |= 0x7;
 558                                 qh->start_split_frame = qh->sched_frame;
 559                         }
 560                 } else {
 561                         qh->sched_frame = dwc_frame_num_inc(qh->sched_frame, qh->interval);
 562                         if (dwc_frame_num_le(qh->sched_frame, frame_number)) {
 563                                 qh->sched_frame = frame_number;
 564                         }
 565                 }
 566
 567                 if (list_empty(&qh->qtd_list)) {
 568                         dwc_otg_hcd_qh_remove(hcd, qh);
 569                 } else {
 570                         /*
 571                          * Remove from periodic_sched_queued and move to
 572                          * appropriate queue.
 573                          */
 574                         if (qh->sched_frame == frame_number) {
 575                                 list_move(&qh->qh_list_entry,
 576                                           &hcd->periodic_sched_ready);
 577                         } else {
 578                                 list_move(&qh->qh_list_entry,
 579                                           &hcd->periodic_sched_inactive);
 580                         }
 581                 }
 582         }
 583
 584         SPIN_UNLOCK_IRQRESTORE(&hcd->lock, flags);
 585 }
 586
 587 /**
 588  * This function allocates and initializes a QTD.
 589  *
 590  * @param[in] urb The URB to create a QTD from.  Each URB-QTD pair will end up
 591  * pointing to each other so each pair should have a unique correlation.
 592  *
 593  * @return Returns pointer to the newly allocated QTD, or NULL on error. */
 594 dwc_otg_qtd_t *dwc_otg_hcd_qtd_create (struct urb *urb)
 595 {
 596         dwc_otg_qtd_t *qtd;
 597
 598         qtd = dwc_otg_hcd_qtd_alloc ();
 599         if (qtd == NULL) {
 600                 return NULL;
 601         }
 602
 603         dwc_otg_hcd_qtd_init (qtd, urb);
 604         return qtd;
 605 }
 606
 607 /**
 608  * Initializes a QTD structure.
 609  *
 610  * @param[in] qtd The QTD to initialize.
 611  * @param[in] urb The URB to use for initialization.  */
 612 void dwc_otg_hcd_qtd_init (dwc_otg_qtd_t *qtd, struct urb *urb)
 613 {
 614         memset (qtd, 0, sizeof (dwc_otg_qtd_t));
 615         qtd->urb = urb;
 616         if (usb_pipecontrol(urb->pipe)) {
 617                 /*
 618                  * The only time the QTD data toggle is used is on the data
 619                  * phase of control transfers. This phase always starts with
 620                  * DATA1.
 621                  */
 622                 qtd->data_toggle = DWC_OTG_HC_PID_DATA1;
 623                 qtd->control_phase = DWC_OTG_CONTROL_SETUP;
 624         }
 625
 626         /* start split */
 627         qtd->complete_split = 0;
 628         qtd->isoc_split_pos = DWC_HCSPLIT_XACTPOS_ALL;
 629         qtd->isoc_split_offset = 0;
 630
 631         /* Store the qtd ptr in the urb to reference what QTD. */
 632         urb->hcpriv = qtd;
 633         return;
 634 }
 635
 636 /**
 637  * This function adds a QTD to the QTD-list of a QH.  It will find the correct
 638  * QH to place the QTD into.  If it does not find a QH, then it will create a
 639  * new QH. If the QH to which the QTD is added is not currently scheduled, it
 640  * is placed into the proper schedule based on its EP type.
 641  *
 642  * @param[in] qtd The QTD to add
 643  * @param[in] dwc_otg_hcd The DWC HCD structure
 644  *
 645  * @return 0 if successful, negative error code otherwise.
 646  */
 647 int dwc_otg_hcd_qtd_add (dwc_otg_qtd_t *qtd,
 648                          dwc_otg_hcd_t *dwc_otg_hcd)
 649 {
 650         struct usb_host_endpoint *ep;
 651         dwc_otg_qh_t *qh;
 652         unsigned long flags;
 653         int retval = 0;
 654
 655         struct urb *urb = qtd->urb;
 656
 657         SPIN_LOCK_IRQSAVE(&dwc_otg_hcd->lock, flags);
 658
 659         /*
 660          * Get the QH which holds the QTD-list to insert to. Create QH if it
 661          * doesn't exist.
 662          */
 663         ep = dwc_urb_to_endpoint(urb);
 664         qh = (dwc_otg_qh_t *)ep->hcpriv;
 665         if (qh == NULL) {
 666                 qh = dwc_otg_hcd_qh_create (dwc_otg_hcd, urb);
 667                 if (qh == NULL) {
 668                         goto done;
 669                 }
 670                 ep->hcpriv = qh;
 671         }
 672
 673         retval = dwc_otg_hcd_qh_add(dwc_otg_hcd, qh);
 674         if (retval == 0) {
 675                 list_add_tail(&qtd->qtd_list_entry, &qh->qtd_list);
 676         }
 677
 678  done:
 679         SPIN_UNLOCK_IRQRESTORE(&dwc_otg_hcd->lock, flags);
 680
 681         return retval;
 682 }
 683
 684 #endif /* DWC_DEVICE_ONLY */