drivers/usb/host/uhci-q.c

   1 /*
   2  * Universal Host Controller Interface driver for USB.
   3  *
   4  * Maintainer: Alan Stern <stern@rowland.harvard.edu>
   5  *
   6  * (C) Copyright 1999 Linus Torvalds
   7  * (C) Copyright 1999-2002 Johannes Erdfelt, johannes@erdfelt.com
   8  * (C) Copyright 1999 Randy Dunlap
   9  * (C) Copyright 1999 Georg Acher, acher@in.tum.de
  10  * (C) Copyright 1999 Deti Fliegl, deti@fliegl.de
  11  * (C) Copyright 1999 Thomas Sailer, sailer@ife.ee.ethz.ch
  12  * (C) Copyright 1999 Roman Weissgaerber, weissg@vienna.at
  13  * (C) Copyright 2000 Yggdrasil Computing, Inc. (port of new PCI interface
  14  *               support from usb-ohci.c by Adam Richter, adam@yggdrasil.com).
  15  * (C) Copyright 1999 Gregory P. Smith (from usb-ohci.c)
  16  * (C) Copyright 2004-2005 Alan Stern, stern@rowland.harvard.edu
  17  */
  18
  19 static void uhci_free_pending_tds(struct uhci_hcd *uhci);
  20
  21 /*
  22  * Technically, updating td->status here is a race, but it's not really a
  23  * problem. The worst that can happen is that we set the IOC bit again
  24  * generating a spurious interrupt. We could fix this by creating another
  25  * QH and leaving the IOC bit always set, but then we would have to play
  26  * games with the FSBR code to make sure we get the correct order in all
  27  * the cases. I don't think it's worth the effort
  28  */
  29 static void uhci_set_next_interrupt(struct uhci_hcd *uhci)
  30 {
  31         if (uhci->is_stopped)
  32                 mod_timer(&uhci_to_hcd(uhci)->rh_timer, jiffies);
  33         uhci->term_td->status |= cpu_to_le32(TD_CTRL_IOC);
  34 }
  35
  36 static inline void uhci_clear_next_interrupt(struct uhci_hcd *uhci)
  37 {
  38         uhci->term_td->status &= ~cpu_to_le32(TD_CTRL_IOC);
  39 }
  40
  41 static struct uhci_td *uhci_alloc_td(struct uhci_hcd *uhci)
  42 {
  43         dma_addr_t dma_handle;
  44         struct uhci_td *td;
  45
  46         td = dma_pool_alloc(uhci->td_pool, GFP_ATOMIC, &dma_handle);
  47         if (!td)
  48                 return NULL;
  49
  50         td->dma_handle = dma_handle;
  51         td->frame = -1;
  52
  53         INIT_LIST_HEAD(&td->list);
  54         INIT_LIST_HEAD(&td->remove_list);
  55         INIT_LIST_HEAD(&td->fl_list);
  56
  57         return td;
  58 }
  59
  60 static void uhci_free_td(struct uhci_hcd *uhci, struct uhci_td *td)
  61 {
  62         if (!list_empty(&td->list))
  63                 dev_warn(uhci_dev(uhci), "td %p still in list!\n", td);
  64         if (!list_empty(&td->remove_list))
  65                 dev_warn(uhci_dev(uhci), "td %p still in remove_list!\n", td);
  66         if (!list_empty(&td->fl_list))
  67                 dev_warn(uhci_dev(uhci), "td %p still in fl_list!\n", td);
  68
  69         dma_pool_free(uhci->td_pool, td, td->dma_handle);
  70 }
  71
  72 static inline void uhci_fill_td(struct uhci_td *td, u32 status,
  73                 u32 token, u32 buffer)
  74 {
  75         td->status = cpu_to_le32(status);
  76         td->token = cpu_to_le32(token);
  77         td->buffer = cpu_to_le32(buffer);
  78 }
  79
  80 /*
  81  * We insert Isochronous URBs directly into the frame list at the beginning
  82  */
  83 static inline void uhci_insert_td_in_frame_list(struct uhci_hcd *uhci,
  84                 struct uhci_td *td, unsigned framenum)
  85 {
  86         framenum &= (UHCI_NUMFRAMES - 1);
  87
  88         td->frame = framenum;
  89
  90         /* Is there a TD already mapped there? */
  91         if (uhci->frame_cpu[framenum]) {
  92                 struct uhci_td *ftd, *ltd;
  93
  94                 ftd = uhci->frame_cpu[framenum];
  95                 ltd = list_entry(ftd->fl_list.prev, struct uhci_td, fl_list);
  96
  97                 list_add_tail(&td->fl_list, &ftd->fl_list);
  98
  99                 td->link = ltd->link;
 100                 wmb();
 101                 ltd->link = cpu_to_le32(td->dma_handle);
 102         } else {
 103                 td->link = uhci->frame[framenum];
 104                 wmb();
 105                 uhci->frame[framenum] = cpu_to_le32(td->dma_handle);
 106                 uhci->frame_cpu[framenum] = td;
 107         }
 108 }
 109
 110 static inline void uhci_remove_td_from_frame_list(struct uhci_hcd *uhci,
 111                 struct uhci_td *td)
 112 {
 113         /* If it's not inserted, don't remove it */
 114         if (td->frame == -1) {
 115                 WARN_ON(!list_empty(&td->fl_list));
 116                 return;
 117         }
 118
 119         if (uhci->frame_cpu[td->frame] == td) {
 120                 if (list_empty(&td->fl_list)) {
 121                         uhci->frame[td->frame] = td->link;
 122                         uhci->frame_cpu[td->frame] = NULL;
 123                 } else {
 124                         struct uhci_td *ntd;
 125
 126                         ntd = list_entry(td->fl_list.next, struct uhci_td, fl_list);
 127                         uhci->frame[td->frame] = cpu_to_le32(ntd->dma_handle);
 128                         uhci->frame_cpu[td->frame] = ntd;
 129                 }
 130         } else {
 131                 struct uhci_td *ptd;
 132
 133                 ptd = list_entry(td->fl_list.prev, struct uhci_td, fl_list);
 134                 ptd->link = td->link;
 135         }
 136
 137         list_del_init(&td->fl_list);
 138         td->frame = -1;
 139 }
 140
 141 /*
 142  * Remove all the TDs for an Isochronous URB from the frame list
 143  */
 144 static void uhci_unlink_isochronous_tds(struct uhci_hcd *uhci, struct urb *urb)
 145 {
 146         struct urb_priv *urbp = (struct urb_priv *) urb->hcpriv;
 147         struct uhci_td *td;
 148
 149         list_for_each_entry(td, &urbp->td_list, list)
 150                 uhci_remove_td_from_frame_list(uhci, td);
 151         wmb();
 152 }
 153
 154 static struct uhci_qh *uhci_alloc_qh(struct uhci_hcd *uhci,
 155                 struct usb_device *udev, struct usb_host_endpoint *hep)
 156 {
 157         dma_addr_t dma_handle;
 158         struct uhci_qh *qh;
 159
 160         qh = dma_pool_alloc(uhci->qh_pool, GFP_ATOMIC, &dma_handle);
 161         if (!qh)
 162                 return NULL;
 163
 164         qh->dma_handle = dma_handle;
 165
 166         qh->element = UHCI_PTR_TERM;
 167         qh->link = UHCI_PTR_TERM;
 168
 169         INIT_LIST_HEAD(&qh->queue);
 170         INIT_LIST_HEAD(&qh->node);
 171
 172         if (udev) {             /* Normal QH */
 173                 qh->dummy_td = uhci_alloc_td(uhci);
 174                 if (!qh->dummy_td) {
 175                         dma_pool_free(uhci->qh_pool, qh, dma_handle);
 176                         return NULL;
 177                 }
 178                 qh->state = QH_STATE_IDLE;
 179                 qh->hep = hep;
 180                 qh->udev = udev;
 181                 hep->hcpriv = qh;
 182
 183         } else {                /* Skeleton QH */
 184                 qh->state = QH_STATE_ACTIVE;
 185                 qh->udev = NULL;
 186         }
 187         return qh;
 188 }
 189
 190 static void uhci_free_qh(struct uhci_hcd *uhci, struct uhci_qh *qh)
 191 {
 192         WARN_ON(qh->state != QH_STATE_IDLE && qh->udev);
 193         if (!list_empty(&qh->queue))
 194                 dev_warn(uhci_dev(uhci), "qh %p list not empty!\n", qh);
 195
 196         list_del(&qh->node);
 197         if (qh->udev) {
 198                 qh->hep->hcpriv = NULL;
 199                 uhci_free_td(uhci, qh->dummy_td);
 200         }
 201         dma_pool_free(uhci->qh_pool, qh, qh->dma_handle);
 202 }
 203
 204 /*
 205  * When the currently executing URB is dequeued, save its current toggle value
 206  */
 207 static void uhci_save_toggle(struct uhci_qh *qh, struct urb *urb)
 208 {
 209         struct urb_priv *urbp = (struct urb_priv *) urb->hcpriv;
 210         struct uhci_td *td;
 211
 212         /* If the QH element pointer is UHCI_PTR_TERM then then currently
 213          * executing URB has already been unlinked, so this one isn't it. */
 214         if (qh_element(qh) == UHCI_PTR_TERM ||
 215                                 qh->queue.next != &urbp->node)
 216                 return;
 217         qh->element = UHCI_PTR_TERM;
 218
 219         /* Only bulk and interrupt pipes have to worry about toggles */
 220         if (!(usb_pipetype(urb->pipe) == PIPE_BULK ||
 221                         usb_pipetype(urb->pipe) == PIPE_INTERRUPT))
 222                 return;
 223
 224         /* Find the first active TD; that's the device's toggle state */
 225         list_for_each_entry(td, &urbp->td_list, list) {
 226                 if (td_status(td) & TD_CTRL_ACTIVE) {
 227                         qh->needs_fixup = 1;
 228                         qh->initial_toggle = uhci_toggle(td_token(td));
 229                         return;
 230                 }
 231         }
 232
 233         WARN_ON(1);
 234 }
 235
 236 /*
 237  * Fix up the data toggles for URBs in a queue, when one of them
 238  * terminates early (short transfer, error, or dequeued).
 239  */
 240 static void uhci_fixup_toggles(struct uhci_qh *qh, int skip_first)
 241 {
 242         struct urb_priv *urbp = NULL;
 243         struct uhci_td *td;
 244         unsigned int toggle = qh->initial_toggle;
 245         unsigned int pipe;
 246
 247         /* Fixups for a short transfer start with the second URB in the
 248          * queue (the short URB is the first). */
 249         if (skip_first)
 250                 urbp = list_entry(qh->queue.next, struct urb_priv, node);
 251
 252         /* When starting with the first URB, if the QH element pointer is
 253          * still valid then we know the URB's toggles are okay. */
 254         else if (qh_element(qh) != UHCI_PTR_TERM)
 255                 toggle = 2;
 256
 257         /* Fix up the toggle for the URBs in the queue.  Normally this
 258          * loop won't run more than once: When an error or short transfer
 259          * occurs, the queue usually gets emptied. */
 260         urbp = list_prepare_entry(urbp, &qh->queue, node);
 261         list_for_each_entry_continue(urbp, &qh->queue, node) {
 262
 263                 /* If the first TD has the right toggle value, we don't
 264                  * need to change any toggles in this URB */
 265                 td = list_entry(urbp->td_list.next, struct uhci_td, list);
 266                 if (toggle > 1 || uhci_toggle(td_token(td)) == toggle) {
 267                         td = list_entry(urbp->td_list.prev, struct uhci_td,
 268                                         list);
 269                         toggle = uhci_toggle(td_token(td)) ^ 1;
 270
 271                 /* Otherwise all the toggles in the URB have to be switched */
 272                 } else {
 273                         list_for_each_entry(td, &urbp->td_list, list) {
 274                                 td->token ^= __constant_cpu_to_le32(
 275                                                         TD_TOKEN_TOGGLE);
 276                                 toggle ^= 1;
 277                         }
 278                 }
 279         }
 280
 281         wmb();
 282         pipe = list_entry(qh->queue.next, struct urb_priv, node)->urb->pipe;
 283         usb_settoggle(qh->udev, usb_pipeendpoint(pipe),
 284                         usb_pipeout(pipe), toggle);
 285         qh->needs_fixup = 0;
 286 }
 287
 288 /*
 289  * Put a QH on the schedule in both hardware and software
 290  */
 291 static void uhci_activate_qh(struct uhci_hcd *uhci, struct uhci_qh *qh)
 292 {
 293         struct uhci_qh *pqh;
 294
 295         WARN_ON(list_empty(&qh->queue));
 296
 297         /* Set the element pointer if it isn't set already.
 298          * This isn't needed for Isochronous queues, but it doesn't hurt. */
 299         if (qh_element(qh) == UHCI_PTR_TERM) {
 300                 struct urb_priv *urbp = list_entry(qh->queue.next,
 301                                 struct urb_priv, node);
 302                 struct uhci_td *td = list_entry(urbp->td_list.next,
 303                                 struct uhci_td, list);
 304
 305                 qh->element = cpu_to_le32(td->dma_handle);
 306         }
 307
 308         if (qh->state == QH_STATE_ACTIVE)
 309                 return;
 310         qh->state = QH_STATE_ACTIVE;
 311
 312         /* Move the QH from its old list to the end of the appropriate
 313          * skeleton's list */
 314         if (qh == uhci->next_qh)
 315                 uhci->next_qh = list_entry(qh->node.next, struct uhci_qh,
 316                                 node);
 317         list_move_tail(&qh->node, &qh->skel->node);
 318
 319         /* Link it into the schedule */
 320         pqh = list_entry(qh->node.prev, struct uhci_qh, node);
 321         qh->link = pqh->link;
 322         wmb();
 323         pqh->link = UHCI_PTR_QH | cpu_to_le32(qh->dma_handle);
 324 }
 325
 326 /*
 327  * Take a QH off the hardware schedule
 328  */
 329 static void uhci_unlink_qh(struct uhci_hcd *uhci, struct uhci_qh *qh)
 330 {
 331         struct uhci_qh *pqh;
 332
 333         if (qh->state == QH_STATE_UNLINKING)
 334                 return;
 335         WARN_ON(qh->state != QH_STATE_ACTIVE || !qh->udev);
 336         qh->state = QH_STATE_UNLINKING;
 337
 338         /* Unlink the QH from the schedule and record when we did it */
 339         pqh = list_entry(qh->node.prev, struct uhci_qh, node);
 340         pqh->link = qh->link;
 341         mb();
 342
 343         uhci_get_current_frame_number(uhci);
 344         qh->unlink_frame = uhci->frame_number;
 345
 346         /* Force an interrupt so we know when the QH is fully unlinked */
 347         if (list_empty(&uhci->skel_unlink_qh->node))
 348                 uhci_set_next_interrupt(uhci);
 349
 350         /* Move the QH from its old list to the end of the unlinking list */
 351         if (qh == uhci->next_qh)
 352                 uhci->next_qh = list_entry(qh->node.next, struct uhci_qh,
 353                                 node);
 354         list_move_tail(&qh->node, &uhci->skel_unlink_qh->node);
 355 }
 356
 357 /*
 358  * When we and the controller are through with a QH, it becomes IDLE.
 359  * This happens when a QH has been off the schedule (on the unlinking
 360  * list) for more than one frame, or when an error occurs while adding
 361  * the first URB onto a new QH.
 362  */
 363 static void uhci_make_qh_idle(struct uhci_hcd *uhci, struct uhci_qh *qh)
 364 {
 365         WARN_ON(qh->state == QH_STATE_ACTIVE);
 366
 367         if (qh == uhci->next_qh)
 368                 uhci->next_qh = list_entry(qh->node.next, struct uhci_qh,
 369                                 node);
 370         list_move(&qh->node, &uhci->idle_qh_list);
 371         qh->state = QH_STATE_IDLE;
 372
 373         /* If anyone is waiting for a QH to become idle, wake them up */
 374         if (uhci->num_waiting)
 375                 wake_up_all(&uhci->waitqh);
 376 }
 377
 378 static inline struct urb_priv *uhci_alloc_urb_priv(struct uhci_hcd *uhci,
 379                 struct urb *urb)
 380 {
 381         struct urb_priv *urbp;
 382
 383         urbp = kmem_cache_alloc(uhci_up_cachep, SLAB_ATOMIC);
 384         if (!urbp)
 385                 return NULL;
 386
 387         memset((void *)urbp, 0, sizeof(*urbp));
 388
 389         urbp->urb = urb;
 390         urb->hcpriv = urbp;
 391
 392         INIT_LIST_HEAD(&urbp->node);
 393         INIT_LIST_HEAD(&urbp->td_list);
 394
 395         return urbp;
 396 }
 397
 398 static void uhci_add_td_to_urb(struct urb *urb, struct uhci_td *td)
 399 {
 400         struct urb_priv *urbp = (struct urb_priv *)urb->hcpriv;
 401
 402         list_add_tail(&td->list, &urbp->td_list);
 403 }
 404
 405 static void uhci_remove_td_from_urb(struct uhci_td *td)
 406 {
 407         if (list_empty(&td->list))
 408                 return;
 409
 410         list_del_init(&td->list);
 411 }
 412
 413 static void uhci_free_urb_priv(struct uhci_hcd *uhci,
 414                 struct urb_priv *urbp)
 415 {
 416         struct uhci_td *td, *tmp;
 417
 418         if (!list_empty(&urbp->node))
 419                 dev_warn(uhci_dev(uhci), "urb %p still on QH's list!\n",
 420                                 urbp->urb);
 421
 422         uhci_get_current_frame_number(uhci);
 423         if (uhci->frame_number + uhci->is_stopped != uhci->td_remove_age) {
 424                 uhci_free_pending_tds(uhci);
 425                 uhci->td_remove_age = uhci->frame_number;
 426         }
 427
 428         /* Check to see if the remove list is empty. Set the IOC bit */
 429         /* to force an interrupt so we can remove the TDs. */
 430         if (list_empty(&uhci->td_remove_list))
 431                 uhci_set_next_interrupt(uhci);
 432
 433         list_for_each_entry_safe(td, tmp, &urbp->td_list, list) {
 434                 uhci_remove_td_from_urb(td);
 435                 list_add(&td->remove_list, &uhci->td_remove_list);
 436         }
 437
 438         urbp->urb->hcpriv = NULL;
 439         kmem_cache_free(uhci_up_cachep, urbp);
 440 }
 441
 442 static void uhci_inc_fsbr(struct uhci_hcd *uhci, struct urb *urb)
 443 {
 444         struct urb_priv *urbp = (struct urb_priv *)urb->hcpriv;
 445
 446         if ((!(urb->transfer_flags & URB_NO_FSBR)) && !urbp->fsbr) {
 447                 urbp->fsbr = 1;
 448                 if (!uhci->fsbr++ && !uhci->fsbrtimeout)
 449                         uhci->skel_term_qh->link = cpu_to_le32(uhci->skel_fs_control_qh->dma_handle) | UHCI_PTR_QH;
 450         }
 451 }
 452
 453 static void uhci_dec_fsbr(struct uhci_hcd *uhci, struct urb *urb)
 454 {
 455         struct urb_priv *urbp = (struct urb_priv *)urb->hcpriv;
 456
 457         if ((!(urb->transfer_flags & URB_NO_FSBR)) && urbp->fsbr) {
 458                 urbp->fsbr = 0;
 459                 if (!--uhci->fsbr)
 460                         uhci->fsbrtimeout = jiffies + FSBR_DELAY;
 461         }
 462 }
 463
 464 /*
 465  * Map status to standard result codes
 466  *
 467  * <status> is (td_status(td) & 0xF60000), a.k.a.
 468  * uhci_status_bits(td_status(td)).
 469  * Note: <status> does not include the TD_CTRL_NAK bit.
 470  * <dir_out> is True for output TDs and False for input TDs.
 471  */
 472 static int uhci_map_status(int status, int dir_out)
 473 {
 474         if (!status)
 475                 return 0;
 476         if (status & TD_CTRL_BITSTUFF)                  /* Bitstuff error */
 477                 return -EPROTO;
 478         if (status & TD_CTRL_CRCTIMEO) {                /* CRC/Timeout */
 479                 if (dir_out)
 480                         return -EPROTO;
 481                 else
 482                         return -EILSEQ;
 483         }
 484         if (status & TD_CTRL_BABBLE)                    /* Babble */
 485                 return -EOVERFLOW;
 486         if (status & TD_CTRL_DBUFERR)                   /* Buffer error */
 487                 return -ENOSR;
 488         if (status & TD_CTRL_STALLED)                   /* Stalled */
 489                 return -EPIPE;
 490         WARN_ON(status & TD_CTRL_ACTIVE);               /* Active */
 491         return 0;
 492 }
 493
 494 /*
 495  * Control transfers
 496  */
 497 static int uhci_submit_control(struct uhci_hcd *uhci, struct urb *urb,
 498                 struct uhci_qh *qh)
 499 {
 500         struct uhci_td *td;
 501         unsigned long destination, status;
 502         int maxsze = le16_to_cpu(qh->hep->desc.wMaxPacketSize);
 503         int len = urb->transfer_buffer_length;
 504         dma_addr_t data = urb->transfer_dma;
 505         __le32 *plink;
 506
 507         /* The "pipe" thing contains the destination in bits 8--18 */
 508         destination = (urb->pipe & PIPE_DEVEP_MASK) | USB_PID_SETUP;
 509
 510         /* 3 errors, dummy TD remains inactive */
 511         status = uhci_maxerr(3);
 512         if (urb->dev->speed == USB_SPEED_LOW)
 513                 status |= TD_CTRL_LS;
 514
 515         /*
 516          * Build the TD for the control request setup packet
 517          */
 518         td = qh->dummy_td;
 519         uhci_add_td_to_urb(urb, td);
 520         uhci_fill_td(td, status, destination | uhci_explen(8),
 521                         urb->setup_dma);
 522         plink = &td->link;
 523         status |= TD_CTRL_ACTIVE;
 524
 525         /*
 526          * If direction is "send", change the packet ID from SETUP (0x2D)
 527          * to OUT (0xE1).  Else change it from SETUP to IN (0x69) and
 528          * set Short Packet Detect (SPD) for all data packets.
 529          */
 530         if (usb_pipeout(urb->pipe))
 531                 destination ^= (USB_PID_SETUP ^ USB_PID_OUT);
 532         else {
 533                 destination ^= (USB_PID_SETUP ^ USB_PID_IN);
 534                 status |= TD_CTRL_SPD;
 535         }
 536
 537         /*
 538          * Build the DATA TDs
 539          */
 540         while (len > 0) {
 541                 int pktsze = min(len, maxsze);
 542
 543                 td = uhci_alloc_td(uhci);
 544                 if (!td)
 545                         goto nomem;
 546                 *plink = cpu_to_le32(td->dma_handle);
 547
 548                 /* Alternate Data0/1 (start with Data1) */
 549                 destination ^= TD_TOKEN_TOGGLE;
 550
 551                 uhci_add_td_to_urb(urb, td);
 552                 uhci_fill_td(td, status, destination | uhci_explen(pktsze),
 553                                 data);
 554                 plink = &td->link;
 555
 556                 data += pktsze;
 557                 len -= pktsze;
 558         }
 559
 560         /*
 561          * Build the final TD for control status
 562          */
 563         td = uhci_alloc_td(uhci);
 564         if (!td)
 565                 goto nomem;
 566         *plink = cpu_to_le32(td->dma_handle);
 567
 568         /*
 569          * It's IN if the pipe is an output pipe or we're not expecting
 570          * data back.
 571          */
 572         destination &= ~TD_TOKEN_PID_MASK;
 573         if (usb_pipeout(urb->pipe) || !urb->transfer_buffer_length)
 574                 destination |= USB_PID_IN;
 575         else
 576                 destination |= USB_PID_OUT;
 577
 578         destination |= TD_TOKEN_TOGGLE;         /* End in Data1 */
 579
 580         status &= ~TD_CTRL_SPD;
 581
 582         uhci_add_td_to_urb(urb, td);
 583         uhci_fill_td(td, status | TD_CTRL_IOC,
 584                         destination | uhci_explen(0), 0);
 585         plink = &td->link;
 586
 587         /*
 588          * Build the new dummy TD and activate the old one
 589          */
 590         td = uhci_alloc_td(uhci);
 591         if (!td)
 592                 goto nomem;
 593         *plink = cpu_to_le32(td->dma_handle);
 594
 595         uhci_fill_td(td, 0, USB_PID_OUT | uhci_explen(0), 0);
 596         wmb();
 597         qh->dummy_td->status |= __constant_cpu_to_le32(TD_CTRL_ACTIVE);
 598         qh->dummy_td = td;
 599
 600         /* Low-speed transfers get a different queue, and won't hog the bus.
 601          * Also, some devices enumerate better without FSBR; the easiest way
 602          * to do that is to put URBs on the low-speed queue while the device
 603          * isn't in the CONFIGURED state. */
 604         if (urb->dev->speed == USB_SPEED_LOW ||
 605                         urb->dev->state != USB_STATE_CONFIGURED)
 606                 qh->skel = uhci->skel_ls_control_qh;
 607         else {
 608                 qh->skel = uhci->skel_fs_control_qh;
 609                 uhci_inc_fsbr(uhci, urb);
 610         }
 611         return 0;
 612
 613 nomem:
 614         /* Remove the dummy TD from the td_list so it doesn't get freed */
 615         uhci_remove_td_from_urb(qh->dummy_td);
 616         return -ENOMEM;
 617 }
 618
 619 /*
 620  * If control-IN transfer was short, the status packet wasn't sent.
 621  * This routine changes the element pointer in the QH to point at the
 622  * status TD.  It's safe to do this even while the QH is live, because
 623  * the hardware only updates the element pointer following a successful
 624  * transfer.  The inactive TD for the short packet won't cause an update,
 625  * so the pointer won't get overwritten.  The next time the controller
 626  * sees this QH, it will send the status packet.
 627  */
 628 static int usb_control_retrigger_status(struct uhci_hcd *uhci, struct urb *urb)
 629 {
 630         struct urb_priv *urbp = (struct urb_priv *)urb->hcpriv;
 631         struct uhci_td *td;
 632
 633         urbp->short_transfer = 1;
 634
 635         td = list_entry(urbp->td_list.prev, struct uhci_td, list);
 636         urbp->qh->element = cpu_to_le32(td->dma_handle);
 637
 638         return -EINPROGRESS;
 639 }
 640
 641
 642 static int uhci_result_control(struct uhci_hcd *uhci, struct urb *urb)
 643 {
 644         struct list_head *tmp, *head;
 645         struct urb_priv *urbp = urb->hcpriv;
 646         struct uhci_td *td;
 647         unsigned int status;
 648         int ret = 0;
 649
 650         head = &urbp->td_list;
 651         if (urbp->short_transfer) {
 652                 tmp = head->prev;
 653                 goto status_stage;
 654         }
 655
 656         urb->actual_length = 0;
 657
 658         tmp = head->next;
 659         td = list_entry(tmp, struct uhci_td, list);
 660
 661         /* The first TD is the SETUP stage, check the status, but skip */
 662         /*  the count */
 663         status = uhci_status_bits(td_status(td));
 664         if (status & TD_CTRL_ACTIVE)
 665                 return -EINPROGRESS;
 666
 667         if (status)
 668                 goto td_error;
 669
 670         /* The rest of the TDs (but the last) are data */
 671         tmp = tmp->next;
 672         while (tmp != head && tmp->next != head) {
 673                 unsigned int ctrlstat;
 674
 675                 td = list_entry(tmp, struct uhci_td, list);
 676                 tmp = tmp->next;
 677
 678                 ctrlstat = td_status(td);
 679                 status = uhci_status_bits(ctrlstat);
 680                 if (status & TD_CTRL_ACTIVE)
 681                         return -EINPROGRESS;
 682
 683                 urb->actual_length += uhci_actual_length(ctrlstat);
 684
 685                 if (status)
 686                         goto td_error;
 687
 688                 /* Check to see if we received a short packet */
 689                 if (uhci_actual_length(ctrlstat) <
 690                                 uhci_expected_length(td_token(td))) {
 691                         if (urb->transfer_flags & URB_SHORT_NOT_OK) {
 692                                 ret = -EREMOTEIO;
 693                                 goto err;
 694                         }
 695
 696                         return usb_control_retrigger_status(uhci, urb);
 697                 }
 698         }
 699
 700 status_stage:
 701         td = list_entry(tmp, struct uhci_td, list);
 702
 703         /* Control status stage */
 704         status = td_status(td);
 705
 706 #ifdef I_HAVE_BUGGY_APC_BACKUPS
 707         /* APC BackUPS Pro kludge */
 708         /* It tries to send all of the descriptor instead of the amount */
 709         /*  we requested */
 710         if (status & TD_CTRL_IOC &&     /* IOC is masked out by uhci_status_bits */
 711             status & TD_CTRL_ACTIVE &&
 712             status & TD_CTRL_NAK)
 713                 return 0;
 714 #endif
 715
 716         status = uhci_status_bits(status);
 717         if (status & TD_CTRL_ACTIVE)
 718                 return -EINPROGRESS;
 719
 720         if (status)
 721                 goto td_error;
 722
 723         return 0;
 724
 725 td_error:
 726         ret = uhci_map_status(status, uhci_packetout(td_token(td)));
 727
 728 err:
 729         if ((debug == 1 && ret != -EPIPE) || debug > 1) {
 730                 /* Some debugging code */
 731                 dev_dbg(uhci_dev(uhci), "%s: failed with status %x\n",
 732                                 __FUNCTION__, status);
 733
 734                 if (errbuf) {
 735                         /* Print the chain for debugging purposes */
 736                         uhci_show_qh(urbp->qh, errbuf, ERRBUF_LEN, 0);
 737                         lprintk(errbuf);
 738                 }
 739         }
 740
 741         /* Note that the queue has stopped */
 742         urbp->qh->element = UHCI_PTR_TERM;
 743         urbp->qh->is_stopped = 1;
 744         return ret;
 745 }
 746
 747 /*
 748  * Common submit for bulk and interrupt
 749  */
 750 static int uhci_submit_common(struct uhci_hcd *uhci, struct urb *urb,
 751                 struct uhci_qh *qh)
 752 {
 753         struct uhci_td *td;
 754         unsigned long destination, status;
 755         int maxsze = le16_to_cpu(qh->hep->desc.wMaxPacketSize);
 756         int len = urb->transfer_buffer_length;
 757         dma_addr_t data = urb->transfer_dma;
 758         __le32 *plink;
 759         unsigned int toggle;
 760
 761         if (len < 0)
 762                 return -EINVAL;
 763
 764         /* The "pipe" thing contains the destination in bits 8--18 */
 765         destination = (urb->pipe & PIPE_DEVEP_MASK) | usb_packetid(urb->pipe);
 766         toggle = usb_gettoggle(urb->dev, usb_pipeendpoint(urb->pipe),
 767                          usb_pipeout(urb->pipe));
 768
 769         /* 3 errors, dummy TD remains inactive */
 770         status = uhci_maxerr(3);
 771         if (urb->dev->speed == USB_SPEED_LOW)
 772                 status |= TD_CTRL_LS;
 773         if (usb_pipein(urb->pipe))
 774                 status |= TD_CTRL_SPD;
 775
 776         /*
 777          * Build the DATA TDs
 778          */
 779         plink = NULL;
 780         td = qh->dummy_td;
 781         do {    /* Allow zero length packets */
 782                 int pktsze = maxsze;
 783
 784                 if (len <= pktsze) {            /* The last packet */
 785                         pktsze = len;
 786                         if (!(urb->transfer_flags & URB_SHORT_NOT_OK))
 787                                 status &= ~TD_CTRL_SPD;
 788                 }
 789
 790                 if (plink) {
 791                         td = uhci_alloc_td(uhci);
 792                         if (!td)
 793                                 goto nomem;
 794                         *plink = cpu_to_le32(td->dma_handle);
 795                 }
 796                 uhci_add_td_to_urb(urb, td);
 797                 uhci_fill_td(td, status,
 798                                 destination | uhci_explen(pktsze) |
 799                                         (toggle << TD_TOKEN_TOGGLE_SHIFT),
 800                                 data);
 801                 plink = &td->link;
 802                 status |= TD_CTRL_ACTIVE;
 803
 804                 data += pktsze;
 805                 len -= maxsze;
 806                 toggle ^= 1;
 807         } while (len > 0);
 808
 809         /*
 810          * URB_ZERO_PACKET means adding a 0-length packet, if direction
 811          * is OUT and the transfer_length was an exact multiple of maxsze,
 812          * hence (len = transfer_length - N * maxsze) == 0
 813          * however, if transfer_length == 0, the zero packet was already
 814          * prepared above.
 815          */
 816         if ((urb->transfer_flags & URB_ZERO_PACKET) &&
 817                         usb_pipeout(urb->pipe) && len == 0 &&
 818                         urb->transfer_buffer_length > 0) {
 819                 td = uhci_alloc_td(uhci);
 820                 if (!td)
 821                         goto nomem;
 822                 *plink = cpu_to_le32(td->dma_handle);
 823
 824                 uhci_add_td_to_urb(urb, td);
 825                 uhci_fill_td(td, status,
 826                                 destination | uhci_explen(0) |
 827                                         (toggle << TD_TOKEN_TOGGLE_SHIFT),
 828                                 data);
 829                 plink = &td->link;
 830
 831                 toggle ^= 1;
 832         }
 833
 834         /* Set the interrupt-on-completion flag on the last packet.
 835          * A more-or-less typical 4 KB URB (= size of one memory page)
 836          * will require about 3 ms to transfer; that's a little on the
 837          * fast side but not enough to justify delaying an interrupt
 838          * more than 2 or 3 URBs, so we will ignore the URB_NO_INTERRUPT
 839          * flag setting. */
 840         td->status |= __constant_cpu_to_le32(TD_CTRL_IOC);
 841
 842         /*
 843          * Build the new dummy TD and activate the old one
 844          */
 845         td = uhci_alloc_td(uhci);
 846         if (!td)
 847                 goto nomem;
 848         *plink = cpu_to_le32(td->dma_handle);
 849
 850         uhci_fill_td(td, 0, USB_PID_OUT | uhci_explen(0), 0);
 851         wmb();
 852         qh->dummy_td->status |= __constant_cpu_to_le32(TD_CTRL_ACTIVE);
 853         qh->dummy_td = td;
 854
 855         usb_settoggle(urb->dev, usb_pipeendpoint(urb->pipe),
 856                         usb_pipeout(urb->pipe), toggle);
 857         return 0;
 858
 859 nomem:
 860         /* Remove the dummy TD from the td_list so it doesn't get freed */
 861         uhci_remove_td_from_urb(qh->dummy_td);
 862         return -ENOMEM;
 863 }
 864
 865 /*
 866  * Common result for bulk and interrupt
 867  */
 868 static int uhci_result_common(struct uhci_hcd *uhci, struct urb *urb)
 869 {
 870         struct urb_priv *urbp = urb->hcpriv;
 871         struct uhci_td *td;
 872         unsigned int status = 0;
 873         int ret = 0;
 874
 875         urb->actual_length = 0;
 876
 877         list_for_each_entry(td, &urbp->td_list, list) {
 878                 unsigned int ctrlstat = td_status(td);
 879
 880                 status = uhci_status_bits(ctrlstat);
 881                 if (status & TD_CTRL_ACTIVE)
 882                         return -EINPROGRESS;
 883
 884                 urb->actual_length += uhci_actual_length(ctrlstat);
 885
 886                 if (status)
 887                         goto td_error;
 888
 889                 if (uhci_actual_length(ctrlstat) <
 890                                 uhci_expected_length(td_token(td))) {
 891                         if (urb->transfer_flags & URB_SHORT_NOT_OK) {
 892                                 ret = -EREMOTEIO;
 893                                 goto err;
 894                         }
 895
 896                         /*
 897                          * This URB stopped short of its end.  We have to
 898                          * fix up the toggles of the following URBs on the
 899                          * queue and restart the queue.  But only if this
 900                          * TD isn't the last one in the URB.
 901                          *
 902                          * Do this only the first time we encounter the
 903                          * short URB.
 904                          */
 905                         if (!urbp->short_transfer &&
 906                                         &td->list != urbp->td_list.prev) {
 907                                 urbp->short_transfer = 1;
 908                                 urbp->qh->initial_toggle =
 909                                                 uhci_toggle(td_token(td)) ^ 1;
 910                                 uhci_fixup_toggles(urbp->qh, 1);
 911
 912                                 td = list_entry(urbp->td_list.prev,
 913                                                 struct uhci_td, list);
 914                                 urbp->qh->element = td->link;
 915                         }
 916                         break;
 917                 }
 918         }
 919
 920         return 0;
 921
 922 td_error:
 923         ret = uhci_map_status(status, uhci_packetout(td_token(td)));
 924
 925         if ((debug == 1 && ret != -EPIPE) || debug > 1) {
 926                 /* Some debugging code */
 927                 dev_dbg(uhci_dev(uhci), "%s: failed with status %x\n",
 928                                 __FUNCTION__, status);
 929
 930                 if (debug > 1 && errbuf) {
 931                         /* Print the chain for debugging purposes */
 932                         uhci_show_qh(urbp->qh, errbuf, ERRBUF_LEN, 0);
 933                         lprintk(errbuf);
 934                 }
 935         }
 936 err:
 937
 938         /* Note that the queue has stopped and save the next toggle value */
 939         urbp->qh->element = UHCI_PTR_TERM;
 940         urbp->qh->is_stopped = 1;
 941         urbp->qh->needs_fixup = 1;
 942         urbp->qh->initial_toggle = uhci_toggle(td_token(td)) ^
 943                         (ret == -EREMOTEIO);
 944         return ret;
 945 }
 946
 947 static inline int uhci_submit_bulk(struct uhci_hcd *uhci, struct urb *urb,
 948                 struct uhci_qh *qh)
 949 {
 950         int ret;
 951
 952         /* Can't have low-speed bulk transfers */
 953         if (urb->dev->speed == USB_SPEED_LOW)
 954                 return -EINVAL;
 955
 956         qh->skel = uhci->skel_bulk_qh;
 957         ret = uhci_submit_common(uhci, urb, qh);
 958         if (ret == 0)
 959                 uhci_inc_fsbr(uhci, urb);
 960         return ret;
 961 }
 962
 963 static inline int uhci_submit_interrupt(struct uhci_hcd *uhci, struct urb *urb,
 964                 struct uhci_qh *qh)
 965 {
 966         /* USB 1.1 interrupt transfers only involve one packet per interval.
 967          * Drivers can submit URBs of any length, but longer ones will need
 968          * multiple intervals to complete.
 969          */
 970         qh->skel = uhci->skelqh[__interval_to_skel(urb->interval)];
 971         return uhci_submit_common(uhci, urb, qh);
 972 }
 973
 974 /*
 975  * Isochronous transfers
 976  */
 977 static int uhci_submit_isochronous(struct uhci_hcd *uhci, struct urb *urb,
 978                 struct uhci_qh *qh)
 979 {
 980         struct uhci_td *td = NULL;      /* Since urb->number_of_packets > 0 */
 981         int i, frame;
 982         unsigned long destination, status;
 983         struct urb_priv *urbp = (struct urb_priv *) urb->hcpriv;
 984
 985         if (urb->number_of_packets > 900)       /* 900? Why? */
 986                 return -EFBIG;
 987
 988         status = TD_CTRL_ACTIVE | TD_CTRL_IOS;
 989         destination = (urb->pipe & PIPE_DEVEP_MASK) | usb_packetid(urb->pipe);
 990
 991         /* Figure out the starting frame number */
 992         if (urb->transfer_flags & URB_ISO_ASAP) {
 993                 if (list_empty(&qh->queue)) {
 994                         uhci_get_current_frame_number(uhci);
 995                         urb->start_frame = (uhci->frame_number + 10);
 996
 997                 } else {                /* Go right after the last one */
 998                         struct urb *last_urb;
 999
1000                         last_urb = list_entry(qh->queue.prev,
1001                                         struct urb_priv, node)->urb;
1002                         urb->start_frame = (last_urb->start_frame +
1003                                         last_urb->number_of_packets *
1004                                         last_urb->interval);
1005                 }
1006         } else {
1007                 /* FIXME: Sanity check */
1008         }
1009         urb->start_frame &= (UHCI_NUMFRAMES - 1);
1010
1011         for (i = 0; i < urb->number_of_packets; i++) {
1012                 td = uhci_alloc_td(uhci);
1013                 if (!td)
1014                         return -ENOMEM;
1015
1016                 uhci_add_td_to_urb(urb, td);
1017                 uhci_fill_td(td, status, destination |
1018                                 uhci_explen(urb->iso_frame_desc[i].length),
1019                                 urb->transfer_dma +
1020                                         urb->iso_frame_desc[i].offset);
1021         }
1022
1023         /* Set the interrupt-on-completion flag on the last packet. */
1024         td->status |= __constant_cpu_to_le32(TD_CTRL_IOC);
1025
1026         qh->skel = uhci->skel_iso_qh;
1027
1028         /* Add the TDs to the frame list */
1029         frame = urb->start_frame;
1030         list_for_each_entry(td, &urbp->td_list, list) {
1031                 uhci_insert_td_in_frame_list(uhci, td, frame);
1032                 frame += urb->interval;
1033         }
1034
1035         return 0;
1036 }
1037
1038 static int uhci_result_isochronous(struct uhci_hcd *uhci, struct urb *urb)
1039 {
1040         struct uhci_td *td;
1041         struct urb_priv *urbp = (struct urb_priv *)urb->hcpriv;
1042         int status;
1043         int i, ret = 0;
1044
1045         urb->actual_length = urb->error_count = 0;
1046
1047         i = 0;
1048         list_for_each_entry(td, &urbp->td_list, list) {
1049                 int actlength;
1050                 unsigned int ctrlstat = td_status(td);
1051
1052                 if (ctrlstat & TD_CTRL_ACTIVE)
1053                         return -EINPROGRESS;
1054
1055                 actlength = uhci_actual_length(ctrlstat);
1056                 urb->iso_frame_desc[i].actual_length = actlength;
1057                 urb->actual_length += actlength;
1058
1059                 status = uhci_map_status(uhci_status_bits(ctrlstat),
1060                                 usb_pipeout(urb->pipe));
1061                 urb->iso_frame_desc[i].status = status;
1062                 if (status) {
1063                         urb->error_count++;
1064                         ret = status;
1065                 }
1066
1067                 i++;
1068         }
1069
1070         return ret;
1071 }
1072
1073 static int uhci_urb_enqueue(struct usb_hcd *hcd,
1074                 struct usb_host_endpoint *hep,
1075                 struct urb *urb, gfp_t mem_flags)
1076 {
1077         int ret;
1078         struct uhci_hcd *uhci = hcd_to_uhci(hcd);
1079         unsigned long flags;
1080         struct urb_priv *urbp;
1081         struct uhci_qh *qh;
1082         int bustime;
1083
1084         spin_lock_irqsave(&uhci->lock, flags);
1085
1086         ret = urb->status;
1087         if (ret != -EINPROGRESS)                /* URB already unlinked! */
1088                 goto done;
1089
1090         ret = -ENOMEM;
1091         urbp = uhci_alloc_urb_priv(uhci, urb);
1092         if (!urbp)
1093                 goto done;
1094
1095         if (hep->hcpriv)
1096                 qh = (struct uhci_qh *) hep->hcpriv;
1097         else {
1098                 qh = uhci_alloc_qh(uhci, urb->dev, hep);
1099                 if (!qh)
1100                         goto err_no_qh;
1101         }
1102         urbp->qh = qh;
1103
1104         switch (usb_pipetype(urb->pipe)) {
1105         case PIPE_CONTROL:
1106                 ret = uhci_submit_control(uhci, urb, qh);
1107                 break;
1108         case PIPE_BULK:
1109                 ret = uhci_submit_bulk(uhci, urb, qh);
1110                 break;
1111         case PIPE_INTERRUPT:
1112                 if (list_empty(&qh->queue)) {
1113                         bustime = usb_check_bandwidth(urb->dev, urb);
1114                         if (bustime < 0)
1115                                 ret = bustime;
1116                         else {
1117                                 ret = uhci_submit_interrupt(uhci, urb, qh);
1118                                 if (ret == 0)
1119                                         usb_claim_bandwidth(urb->dev, urb, bustime, 0);
1120                         }
1121                 } else {        /* inherit from parent */
1122                         struct urb_priv *eurbp;
1123
1124                         eurbp = list_entry(qh->queue.prev, struct urb_priv,
1125                                         node);
1126                         urb->bandwidth = eurbp->urb->bandwidth;
1127                         ret = uhci_submit_interrupt(uhci, urb, qh);
1128                 }
1129                 break;
1130         case PIPE_ISOCHRONOUS:
1131                 bustime = usb_check_bandwidth(urb->dev, urb);
1132                 if (bustime < 0) {
1133                         ret = bustime;
1134                         break;
1135                 }
1136
1137                 ret = uhci_submit_isochronous(uhci, urb, qh);
1138                 if (ret == 0)
1139                         usb_claim_bandwidth(urb->dev, urb, bustime, 1);
1140                 break;
1141         }
1142         if (ret != 0)
1143                 goto err_submit_failed;
1144
1145         /* Add this URB to the QH */
1146         urbp->qh = qh;
1147         list_add_tail(&urbp->node, &qh->queue);
1148
1149         /* If the new URB is the first and only one on this QH then either
1150          * the QH is new and idle or else it's unlinked and waiting to
1151          * become idle, so we can activate it right away. */
1152         if (qh->queue.next == &urbp->node)
1153                 uhci_activate_qh(uhci, qh);
1154         goto done;
1155
1156 err_submit_failed:
1157         if (qh->state == QH_STATE_IDLE)
1158                 uhci_make_qh_idle(uhci, qh);    /* Reclaim unused QH */
1159
1160 err_no_qh:
1161         uhci_free_urb_priv(uhci, urbp);
1162
1163 done:
1164         spin_unlock_irqrestore(&uhci->lock, flags);
1165         return ret;
1166 }
1167
1168 static int uhci_urb_dequeue(struct usb_hcd *hcd, struct urb *urb)
1169 {
1170         struct uhci_hcd *uhci = hcd_to_uhci(hcd);
1171         unsigned long flags;
1172         struct urb_priv *urbp;
1173
1174         spin_lock_irqsave(&uhci->lock, flags);
1175         urbp = urb->hcpriv;
1176         if (!urbp)                      /* URB was never linked! */
1177                 goto done;
1178
1179         /* Remove Isochronous TDs from the frame list ASAP */
1180         if (usb_pipetype(urb->pipe) == PIPE_ISOCHRONOUS)
1181                 uhci_unlink_isochronous_tds(uhci, urb);
1182         uhci_unlink_qh(uhci, urbp->qh);
1183
1184 done:
1185         spin_unlock_irqrestore(&uhci->lock, flags);
1186         return 0;
1187 }
1188
1189 /*
1190  * Finish unlinking an URB and give it back
1191  */
1192 static void uhci_giveback_urb(struct uhci_hcd *uhci, struct uhci_qh *qh,
1193                 struct urb *urb, struct pt_regs *regs)
1194 __releases(uhci->lock)
1195 __acquires(uhci->lock)
1196 {
1197         struct urb_priv *urbp = (struct urb_priv *) urb->hcpriv;
1198
1199         /* Isochronous TDs get unlinked directly from the frame list */
1200         if (usb_pipetype(urb->pipe) == PIPE_ISOCHRONOUS)
1201                 uhci_unlink_isochronous_tds(uhci, urb);
1202
1203         /* If the URB isn't first on its queue, adjust the link pointer
1204          * of the last TD in the previous URB. */
1205         else if (qh->queue.next != &urbp->node) {
1206                 struct urb_priv *purbp;
1207                 struct uhci_td *ptd, *ltd;
1208
1209                 purbp = list_entry(urbp->node.prev, struct urb_priv, node);
1210                 ptd = list_entry(purbp->td_list.prev, struct uhci_td,
1211                                 list);
1212                 ltd = list_entry(urbp->td_list.prev, struct uhci_td,
1213                                 list);
1214                 ptd->link = ltd->link;
1215         }
1216
1217         /* Take the URB off the QH's queue.  If the queue is now empty,
1218          * this is a perfect time for a toggle fixup. */
1219         list_del_init(&urbp->node);
1220         if (list_empty(&qh->queue) && qh->needs_fixup) {
1221                 usb_settoggle(urb->dev, usb_pipeendpoint(urb->pipe),
1222                                 usb_pipeout(urb->pipe), qh->initial_toggle);
1223                 qh->needs_fixup = 0;
1224         }
1225
1226         uhci_dec_fsbr(uhci, urb);       /* Safe since it checks */
1227         uhci_free_urb_priv(uhci, urbp);
1228
1229         switch (usb_pipetype(urb->pipe)) {
1230         case PIPE_ISOCHRONOUS:
1231                 /* Release bandwidth for Interrupt or Isoc. transfers */
1232                 if (urb->bandwidth)
1233                         usb_release_bandwidth(urb->dev, urb, 1);
1234                 break;
1235         case PIPE_INTERRUPT:
1236                 /* Release bandwidth for Interrupt or Isoc. transfers */
1237                 /* Make sure we don't release if we have a queued URB */
1238                 if (list_empty(&qh->queue) && urb->bandwidth)
1239                         usb_release_bandwidth(urb->dev, urb, 0);
1240                 else
1241                         /* bandwidth was passed on to queued URB, */
1242                         /* so don't let usb_unlink_urb() release it */
1243                         urb->bandwidth = 0;
1244                 break;
1245         }
1246
1247         spin_unlock(&uhci->lock);
1248         usb_hcd_giveback_urb(uhci_to_hcd(uhci), urb, regs);
1249         spin_lock(&uhci->lock);
1250
1251         /* If the queue is now empty, we can unlink the QH and give up its
1252          * reserved bandwidth. */
1253         if (list_empty(&qh->queue)) {
1254                 uhci_unlink_qh(uhci, qh);
1255
1256                 /* Bandwidth stuff not yet implemented */
1257         }
1258 }
1259
1260 /*
1261  * Scan the URBs in a QH's queue
1262  */
1263 #define QH_FINISHED_UNLINKING(qh)                       \
1264                 (qh->state == QH_STATE_UNLINKING &&     \
1265                 uhci->frame_number + uhci->is_stopped != qh->unlink_frame)
1266
1267 static void uhci_scan_qh(struct uhci_hcd *uhci, struct uhci_qh *qh,
1268                 struct pt_regs *regs)
1269 {
1270         struct urb_priv *urbp;
1271         struct urb *urb;
1272         int status;
1273
1274         while (!list_empty(&qh->queue)) {
1275                 urbp = list_entry(qh->queue.next, struct urb_priv, node);
1276                 urb = urbp->urb;
1277
1278                 switch (usb_pipetype(urb->pipe)) {
1279                 case PIPE_CONTROL:
1280                         status = uhci_result_control(uhci, urb);
1281                         break;
1282                 case PIPE_ISOCHRONOUS:
1283                         status = uhci_result_isochronous(uhci, urb);
1284                         break;
1285                 default:        /* PIPE_BULK or PIPE_INTERRUPT */
1286                         status = uhci_result_common(uhci, urb);
1287                         break;
1288                 }
1289                 if (status == -EINPROGRESS)
1290                         break;
1291
1292                 spin_lock(&urb->lock);
1293                 if (urb->status == -EINPROGRESS)        /* Not dequeued */
1294                         urb->status = status;
1295                 else
1296                         status = -ECONNRESET;
1297                 spin_unlock(&urb->lock);
1298
1299                 /* Dequeued but completed URBs can't be given back unless
1300                  * the QH is stopped or has finished unlinking. */
1301                 if (status == -ECONNRESET &&
1302                                 !(qh->is_stopped || QH_FINISHED_UNLINKING(qh)))
1303                         return;
1304
1305                 uhci_giveback_urb(uhci, qh, urb, regs);
1306                 if (qh->is_stopped)
1307                         break;
1308         }
1309
1310         /* If the QH is neither stopped nor finished unlinking (normal case),
1311          * our work here is done. */
1312  restart:
1313         if (!(qh->is_stopped || QH_FINISHED_UNLINKING(qh)))
1314                 return;
1315
1316         /* Otherwise give back each of the dequeued URBs */
1317         list_for_each_entry(urbp, &qh->queue, node) {
1318                 urb = urbp->urb;
1319                 if (urb->status != -EINPROGRESS) {
1320                         uhci_save_toggle(qh, urb);
1321                         uhci_giveback_urb(uhci, qh, urb, regs);
1322                         goto restart;
1323                 }
1324         }
1325         qh->is_stopped = 0;
1326
1327         /* There are no more dequeued URBs.  If there are still URBs on the
1328          * queue, the QH can now be re-activated. */
1329         if (!list_empty(&qh->queue)) {
1330                 if (qh->needs_fixup)
1331                         uhci_fixup_toggles(qh, 0);
1332                 uhci_activate_qh(uhci, qh);
1333         }
1334
1335         /* The queue is empty.  The QH can become idle if it is fully
1336          * unlinked. */
1337         else if (QH_FINISHED_UNLINKING(qh))
1338                 uhci_make_qh_idle(uhci, qh);
1339 }
1340
1341 static void uhci_free_pending_tds(struct uhci_hcd *uhci)
1342 {
1343         struct uhci_td *td, *tmp;
1344
1345         list_for_each_entry_safe(td, tmp, &uhci->td_remove_list, remove_list) {
1346                 list_del_init(&td->remove_list);
1347
1348                 uhci_free_td(uhci, td);
1349         }
1350 }
1351
1352 /*
1353  * Process events in the schedule, but only in one thread at a time
1354  */
1355 static void uhci_scan_schedule(struct uhci_hcd *uhci, struct pt_regs *regs)
1356 {
1357         int i;
1358         struct uhci_qh *qh;
1359
1360         /* Don't allow re-entrant calls */
1361         if (uhci->scan_in_progress) {
1362                 uhci->need_rescan = 1;
1363                 return;
1364         }
1365         uhci->scan_in_progress = 1;
1366  rescan:
1367         uhci->need_rescan = 0;
1368
1369         uhci_clear_next_interrupt(uhci);
1370         uhci_get_current_frame_number(uhci);
1371
1372         if (uhci->frame_number + uhci->is_stopped != uhci->td_remove_age)
1373                 uhci_free_pending_tds(uhci);
1374
1375         /* Go through all the QH queues and process the URBs in each one */
1376         for (i = 0; i < UHCI_NUM_SKELQH - 1; ++i) {
1377                 uhci->next_qh = list_entry(uhci->skelqh[i]->node.next,
1378                                 struct uhci_qh, node);
1379                 while ((qh = uhci->next_qh) != uhci->skelqh[i]) {
1380                         uhci->next_qh = list_entry(qh->node.next,
1381                                         struct uhci_qh, node);
1382                         uhci_scan_qh(uhci, qh, regs);
1383                 }
1384         }
1385
1386         if (uhci->need_rescan)
1387                 goto rescan;
1388         uhci->scan_in_progress = 0;
1389
1390         /* If the controller is stopped, we can finish these off right now */
1391         if (uhci->is_stopped)
1392                 uhci_free_pending_tds(uhci);
1393
1394         if (list_empty(&uhci->td_remove_list) &&
1395                         list_empty(&uhci->skel_unlink_qh->node))
1396                 uhci_clear_next_interrupt(uhci);
1397         else
1398                 uhci_set_next_interrupt(uhci);
1399 }
1400
1401 static void check_fsbr(struct uhci_hcd *uhci)
1402 {
1403         /* For now, don't scan URBs for FSBR timeouts.
1404          * Add it back in later... */
1405
1406         /* Really disable FSBR */
1407         if (!uhci->fsbr && uhci->fsbrtimeout && time_after_eq(jiffies, uhci->fsbrtimeout)) {
1408                 uhci->fsbrtimeout = 0;
1409                 uhci->skel_term_qh->link = UHCI_PTR_TERM;
1410         }
1411 }