]> git.proxmox.com Git - mirror_ubuntu-artful-kernel.git/blame - drivers/usb/host/ohci-hcd.c
usb: don't use flush_scheduled_work()
[mirror_ubuntu-artful-kernel.git] / drivers / usb / host / ohci-hcd.c
CommitLineData
1da177e4
LT
1/*
2 * OHCI HCD (Host Controller Driver) for USB.
3 *
4 * (C) Copyright 1999 Roman Weissgaerber <weissg@vienna.at>
5 * (C) Copyright 2000-2004 David Brownell <dbrownell@users.sourceforge.net>
dd9048af 6 *
1da177e4
LT
7 * [ Initialisation is based on Linus' ]
8 * [ uhci code and gregs ohci fragments ]
9 * [ (C) Copyright 1999 Linus Torvalds ]
10 * [ (C) Copyright 1999 Gregory P. Smith]
dd9048af
DB
11 *
12 *
1da177e4
LT
13 * OHCI is the main "non-Intel/VIA" standard for USB 1.1 host controller
14 * interfaces (though some non-x86 Intel chips use it). It supports
15 * smarter hardware than UHCI. A download link for the spec available
16 * through the http://www.usb.org website.
17 *
1da177e4
LT
18 * This file is licenced under the GPL.
19 */
dd9048af 20
1da177e4
LT
21#include <linux/module.h>
22#include <linux/moduleparam.h>
23#include <linux/pci.h>
24#include <linux/kernel.h>
25#include <linux/delay.h>
26#include <linux/ioport.h>
27#include <linux/sched.h>
28#include <linux/slab.h>
1da177e4
LT
29#include <linux/errno.h>
30#include <linux/init.h>
31#include <linux/timer.h>
32#include <linux/list.h>
1da177e4 33#include <linux/usb.h>
3a16f7b4 34#include <linux/usb/otg.h>
27729aad 35#include <linux/usb/hcd.h>
dd9048af 36#include <linux/dma-mapping.h>
f4df0e33 37#include <linux/dmapool.h>
d576bb9f 38#include <linux/workqueue.h>
684c19e0 39#include <linux/debugfs.h>
1da177e4
LT
40
41#include <asm/io.h>
42#include <asm/irq.h>
43#include <asm/system.h>
44#include <asm/unaligned.h>
45#include <asm/byteorder.h>
46
47
1da177e4
LT
48#define DRIVER_AUTHOR "Roman Weissgaerber, David Brownell"
49#define DRIVER_DESC "USB 1.1 'Open' Host Controller (OHCI) Driver"
50
51/*-------------------------------------------------------------------------*/
52
8de98402 53#undef OHCI_VERBOSE_DEBUG /* not always helpful */
1da177e4
LT
54
55/* For initializing controller (mask in an HCFS mode too) */
d413984a 56#define OHCI_CONTROL_INIT OHCI_CTRL_CBSR
1da177e4 57#define OHCI_INTR_INIT \
d413984a
DB
58 (OHCI_INTR_MIE | OHCI_INTR_RHSC | OHCI_INTR_UE \
59 | OHCI_INTR_RD | OHCI_INTR_WDH)
1da177e4
LT
60
61#ifdef __hppa__
62/* On PA-RISC, PDC can leave IR set incorrectly; ignore it there. */
63#define IR_DISABLE
64#endif
65
66#ifdef CONFIG_ARCH_OMAP
67/* OMAP doesn't support IR (no SMM; not needed) */
68#define IR_DISABLE
69#endif
70
71/*-------------------------------------------------------------------------*/
72
73static const char hcd_name [] = "ohci_hcd";
74
d413984a
DB
75#define STATECHANGE_DELAY msecs_to_jiffies(300)
76
1da177e4
LT
77#include "ohci.h"
78
79static void ohci_dump (struct ohci_hcd *ohci, int verbose);
80static int ohci_init (struct ohci_hcd *ohci);
81static void ohci_stop (struct usb_hcd *hcd);
da6fb570
DB
82
83#if defined(CONFIG_PM) || defined(CONFIG_PCI)
d576bb9f 84static int ohci_restart (struct ohci_hcd *ohci);
da6fb570 85#endif
1da177e4 86
ab1666c1
LY
87#ifdef CONFIG_PCI
88static void quirk_amd_pll(int state);
89static void amd_iso_dev_put(void);
a1f17a87 90static void sb800_prefetch(struct ohci_hcd *ohci, int on);
ab1666c1
LY
91#else
92static inline void quirk_amd_pll(int state)
93{
94 return;
95}
96static inline void amd_iso_dev_put(void)
97{
98 return;
99}
a1f17a87
LY
100static inline void sb800_prefetch(struct ohci_hcd *ohci, int on)
101{
102 return;
103}
ab1666c1
LY
104#endif
105
106
1da177e4
LT
107#include "ohci-hub.c"
108#include "ohci-dbg.c"
109#include "ohci-mem.c"
110#include "ohci-q.c"
111
112
113/*
114 * On architectures with edge-triggered interrupts we must never return
115 * IRQ_NONE.
116 */
117#if defined(CONFIG_SA1111) /* ... or other edge-triggered systems */
118#define IRQ_NOTMINE IRQ_HANDLED
119#else
120#define IRQ_NOTMINE IRQ_NONE
121#endif
122
123
124/* Some boards misreport power switching/overcurrent */
125static int distrust_firmware = 1;
126module_param (distrust_firmware, bool, 0);
127MODULE_PARM_DESC (distrust_firmware,
128 "true to distrust firmware power/overcurrent setup");
129
130/* Some boards leave IR set wrongly, since they fail BIOS/SMM handshakes */
131static int no_handshake = 0;
132module_param (no_handshake, bool, 0);
133MODULE_PARM_DESC (no_handshake, "true (not default) disables BIOS handshake");
134
135/*-------------------------------------------------------------------------*/
136
137/*
138 * queue up an urb for anything except the root hub
139 */
140static int ohci_urb_enqueue (
141 struct usb_hcd *hcd,
1da177e4 142 struct urb *urb,
55016f10 143 gfp_t mem_flags
1da177e4
LT
144) {
145 struct ohci_hcd *ohci = hcd_to_ohci (hcd);
146 struct ed *ed;
147 urb_priv_t *urb_priv;
148 unsigned int pipe = urb->pipe;
149 int i, size = 0;
150 unsigned long flags;
151 int retval = 0;
dd9048af 152
1da177e4 153#ifdef OHCI_VERBOSE_DEBUG
55d84968 154 urb_print(urb, "SUB", usb_pipein(pipe), -EINPROGRESS);
1da177e4 155#endif
dd9048af 156
1da177e4 157 /* every endpoint has a ed, locate and maybe (re)initialize it */
e9df41c5 158 if (! (ed = ed_get (ohci, urb->ep, urb->dev, pipe, urb->interval)))
1da177e4
LT
159 return -ENOMEM;
160
161 /* for the private part of the URB we need the number of TDs (size) */
162 switch (ed->type) {
163 case PIPE_CONTROL:
164 /* td_submit_urb() doesn't yet handle these */
165 if (urb->transfer_buffer_length > 4096)
166 return -EMSGSIZE;
167
168 /* 1 TD for setup, 1 for ACK, plus ... */
169 size = 2;
170 /* FALLTHROUGH */
171 // case PIPE_INTERRUPT:
172 // case PIPE_BULK:
173 default:
174 /* one TD for every 4096 Bytes (can be upto 8K) */
175 size += urb->transfer_buffer_length / 4096;
176 /* ... and for any remaining bytes ... */
177 if ((urb->transfer_buffer_length % 4096) != 0)
178 size++;
179 /* ... and maybe a zero length packet to wrap it up */
180 if (size == 0)
181 size++;
182 else if ((urb->transfer_flags & URB_ZERO_PACKET) != 0
183 && (urb->transfer_buffer_length
184 % usb_maxpacket (urb->dev, pipe,
185 usb_pipeout (pipe))) == 0)
186 size++;
187 break;
188 case PIPE_ISOCHRONOUS: /* number of packets from URB */
189 size = urb->number_of_packets;
190 break;
191 }
192
193 /* allocate the private part of the URB */
dd00cc48 194 urb_priv = kzalloc (sizeof (urb_priv_t) + size * sizeof (struct td *),
1da177e4
LT
195 mem_flags);
196 if (!urb_priv)
197 return -ENOMEM;
1da177e4
LT
198 INIT_LIST_HEAD (&urb_priv->pending);
199 urb_priv->length = size;
dd9048af 200 urb_priv->ed = ed;
1da177e4
LT
201
202 /* allocate the TDs (deferring hash chain updates) */
203 for (i = 0; i < size; i++) {
204 urb_priv->td [i] = td_alloc (ohci, mem_flags);
205 if (!urb_priv->td [i]) {
206 urb_priv->length = i;
207 urb_free_priv (ohci, urb_priv);
208 return -ENOMEM;
209 }
dd9048af 210 }
1da177e4
LT
211
212 spin_lock_irqsave (&ohci->lock, flags);
213
214 /* don't submit to a dead HC */
541c7d43 215 if (!HCD_HW_ACCESSIBLE(hcd)) {
8de98402
BH
216 retval = -ENODEV;
217 goto fail;
218 }
1da177e4
LT
219 if (!HC_IS_RUNNING(hcd->state)) {
220 retval = -ENODEV;
221 goto fail;
222 }
e9df41c5
AS
223 retval = usb_hcd_link_urb_to_ep(hcd, urb);
224 if (retval)
1da177e4 225 goto fail;
1da177e4
LT
226
227 /* schedule the ed if needed */
228 if (ed->state == ED_IDLE) {
229 retval = ed_schedule (ohci, ed);
e9df41c5
AS
230 if (retval < 0) {
231 usb_hcd_unlink_urb_from_ep(hcd, urb);
232 goto fail;
233 }
1da177e4
LT
234 if (ed->type == PIPE_ISOCHRONOUS) {
235 u16 frame = ohci_frame_no(ohci);
236
237 /* delay a few frames before the first TD */
238 frame += max_t (u16, 8, ed->interval);
239 frame &= ~(ed->interval - 1);
240 frame |= ed->branch;
241 urb->start_frame = frame;
242
243 /* yes, only URB_ISO_ASAP is supported, and
244 * urb->start_frame is never used as input.
245 */
246 }
247 } else if (ed->type == PIPE_ISOCHRONOUS)
248 urb->start_frame = ed->last_iso + ed->interval;
249
250 /* fill the TDs and link them to the ed; and
251 * enable that part of the schedule, if needed
252 * and update count of queued periodic urbs
253 */
254 urb->hcpriv = urb_priv;
255 td_submit_urb (ohci, urb);
256
1da177e4
LT
257fail:
258 if (retval)
259 urb_free_priv (ohci, urb_priv);
260 spin_unlock_irqrestore (&ohci->lock, flags);
261 return retval;
262}
263
264/*
55d84968
AS
265 * decouple the URB from the HC queues (TDs, urb_priv).
266 * reporting is always done
1da177e4
LT
267 * asynchronously, and we might be dealing with an urb that's
268 * partially transferred, or an ED with other urbs being unlinked.
269 */
e9df41c5 270static int ohci_urb_dequeue(struct usb_hcd *hcd, struct urb *urb, int status)
1da177e4
LT
271{
272 struct ohci_hcd *ohci = hcd_to_ohci (hcd);
273 unsigned long flags;
e9df41c5 274 int rc;
dd9048af 275
1da177e4 276#ifdef OHCI_VERBOSE_DEBUG
55d84968 277 urb_print(urb, "UNLINK", 1, status);
dd9048af 278#endif
1da177e4
LT
279
280 spin_lock_irqsave (&ohci->lock, flags);
e9df41c5
AS
281 rc = usb_hcd_check_unlink_urb(hcd, urb, status);
282 if (rc) {
283 ; /* Do nothing */
284 } else if (HC_IS_RUNNING(hcd->state)) {
1da177e4
LT
285 urb_priv_t *urb_priv;
286
287 /* Unless an IRQ completed the unlink while it was being
288 * handed to us, flag it for unlink and giveback, and force
289 * some upcoming INTR_SF to call finish_unlinks()
290 */
291 urb_priv = urb->hcpriv;
292 if (urb_priv) {
293 if (urb_priv->ed->state == ED_OPER)
294 start_ed_unlink (ohci, urb_priv->ed);
295 }
296 } else {
297 /*
298 * with HC dead, we won't respect hc queue pointers
299 * any more ... just clean up every urb's memory.
300 */
301 if (urb->hcpriv)
55d84968 302 finish_urb(ohci, urb, status);
1da177e4
LT
303 }
304 spin_unlock_irqrestore (&ohci->lock, flags);
e9df41c5 305 return rc;
1da177e4
LT
306}
307
308/*-------------------------------------------------------------------------*/
309
310/* frees config/altsetting state for endpoints,
311 * including ED memory, dummy TD, and bulk/intr data toggle
312 */
313
314static void
315ohci_endpoint_disable (struct usb_hcd *hcd, struct usb_host_endpoint *ep)
316{
317 struct ohci_hcd *ohci = hcd_to_ohci (hcd);
318 unsigned long flags;
319 struct ed *ed = ep->hcpriv;
320 unsigned limit = 1000;
321
322 /* ASSERT: any requests/urbs are being unlinked */
323 /* ASSERT: nobody can be submitting urbs for this any more */
324
325 if (!ed)
326 return;
327
328rescan:
329 spin_lock_irqsave (&ohci->lock, flags);
330
331 if (!HC_IS_RUNNING (hcd->state)) {
332sanitize:
333 ed->state = ED_IDLE;
89a0fd18
MN
334 if (quirk_zfmicro(ohci) && ed->type == PIPE_INTERRUPT)
335 ohci->eds_scheduled--;
7d12e780 336 finish_unlinks (ohci, 0);
1da177e4
LT
337 }
338
339 switch (ed->state) {
340 case ED_UNLINK: /* wait for hw to finish? */
341 /* major IRQ delivery trouble loses INTR_SF too... */
342 if (limit-- == 0) {
89a0fd18
MN
343 ohci_warn(ohci, "ED unlink timeout\n");
344 if (quirk_zfmicro(ohci)) {
345 ohci_warn(ohci, "Attempting ZF TD recovery\n");
346 ohci->ed_to_check = ed;
347 ohci->zf_delay = 2;
348 }
1da177e4
LT
349 goto sanitize;
350 }
351 spin_unlock_irqrestore (&ohci->lock, flags);
22c43863 352 schedule_timeout_uninterruptible(1);
1da177e4
LT
353 goto rescan;
354 case ED_IDLE: /* fully unlinked */
355 if (list_empty (&ed->td_list)) {
356 td_free (ohci, ed->dummy);
357 ed_free (ohci, ed);
358 break;
359 }
360 /* else FALL THROUGH */
361 default:
362 /* caller was supposed to have unlinked any requests;
363 * that's not our job. can't recover; must leak ed.
364 */
365 ohci_err (ohci, "leak ed %p (#%02x) state %d%s\n",
366 ed, ep->desc.bEndpointAddress, ed->state,
367 list_empty (&ed->td_list) ? "" : " (has tds)");
368 td_free (ohci, ed->dummy);
369 break;
370 }
371 ep->hcpriv = NULL;
372 spin_unlock_irqrestore (&ohci->lock, flags);
1da177e4
LT
373}
374
375static int ohci_get_frame (struct usb_hcd *hcd)
376{
377 struct ohci_hcd *ohci = hcd_to_ohci (hcd);
378
379 return ohci_frame_no(ohci);
380}
381
382static void ohci_usb_reset (struct ohci_hcd *ohci)
383{
384 ohci->hc_control = ohci_readl (ohci, &ohci->regs->control);
385 ohci->hc_control &= OHCI_CTRL_RWC;
386 ohci_writel (ohci, ohci->hc_control, &ohci->regs->control);
387}
388
64a21d02 389/* ohci_shutdown forcibly disables IRQs and DMA, helping kexec and
f4df0e33
DB
390 * other cases where the next software may expect clean state from the
391 * "firmware". this is bus-neutral, unlike shutdown() methods.
392 */
64a21d02
AG
393static void
394ohci_shutdown (struct usb_hcd *hcd)
f4df0e33
DB
395{
396 struct ohci_hcd *ohci;
397
64a21d02 398 ohci = hcd_to_ohci (hcd);
f4df0e33 399 ohci_writel (ohci, OHCI_INTR_MIE, &ohci->regs->intrdisable);
3df7169e
AS
400 ohci->hc_control = ohci_readl(ohci, &ohci->regs->control);
401
402 /* If the SHUTDOWN quirk is set, don't put the controller in RESET */
403 ohci->hc_control &= (ohci->flags & OHCI_QUIRK_SHUTDOWN ?
404 OHCI_CTRL_RWC | OHCI_CTRL_HCFS :
405 OHCI_CTRL_RWC);
406 ohci_writel(ohci, ohci->hc_control, &ohci->regs->control);
407
f4df0e33
DB
408 /* flush the writes */
409 (void) ohci_readl (ohci, &ohci->regs->control);
f4df0e33
DB
410}
411
89a0fd18
MN
412static int check_ed(struct ohci_hcd *ohci, struct ed *ed)
413{
414 return (hc32_to_cpu(ohci, ed->hwINFO) & ED_IN) != 0
415 && (hc32_to_cpu(ohci, ed->hwHeadP) & TD_MASK)
416 == (hc32_to_cpu(ohci, ed->hwTailP) & TD_MASK)
417 && !list_empty(&ed->td_list);
418}
419
420/* ZF Micro watchdog timer callback. The ZF Micro chipset sometimes completes
421 * an interrupt TD but neglects to add it to the donelist. On systems with
422 * this chipset, we need to periodically check the state of the queues to look
423 * for such "lost" TDs.
424 */
425static void unlink_watchdog_func(unsigned long _ohci)
426{
da6fb570 427 unsigned long flags;
89a0fd18
MN
428 unsigned max;
429 unsigned seen_count = 0;
430 unsigned i;
431 struct ed **seen = NULL;
432 struct ohci_hcd *ohci = (struct ohci_hcd *) _ohci;
433
434 spin_lock_irqsave(&ohci->lock, flags);
435 max = ohci->eds_scheduled;
436 if (!max)
437 goto done;
438
439 if (ohci->ed_to_check)
440 goto out;
441
442 seen = kcalloc(max, sizeof *seen, GFP_ATOMIC);
443 if (!seen)
444 goto out;
445
446 for (i = 0; i < NUM_INTS; i++) {
447 struct ed *ed = ohci->periodic[i];
448
449 while (ed) {
450 unsigned temp;
451
452 /* scan this branch of the periodic schedule tree */
453 for (temp = 0; temp < seen_count; temp++) {
454 if (seen[temp] == ed) {
455 /* we've checked it and what's after */
456 ed = NULL;
457 break;
458 }
459 }
460 if (!ed)
461 break;
462 seen[seen_count++] = ed;
463 if (!check_ed(ohci, ed)) {
464 ed = ed->ed_next;
465 continue;
466 }
467
468 /* HC's TD list is empty, but HCD sees at least one
469 * TD that's not been sent through the donelist.
470 */
471 ohci->ed_to_check = ed;
472 ohci->zf_delay = 2;
473
474 /* The HC may wait until the next frame to report the
475 * TD as done through the donelist and INTR_WDH. (We
476 * just *assume* it's not a multi-TD interrupt URB;
477 * those could defer the IRQ more than one frame, using
478 * DI...) Check again after the next INTR_SF.
479 */
480 ohci_writel(ohci, OHCI_INTR_SF,
481 &ohci->regs->intrstatus);
482 ohci_writel(ohci, OHCI_INTR_SF,
483 &ohci->regs->intrenable);
484
485 /* flush those writes */
486 (void) ohci_readl(ohci, &ohci->regs->control);
487
488 goto out;
489 }
490 }
491out:
492 kfree(seen);
493 if (ohci->eds_scheduled)
9cebcdc7 494 mod_timer(&ohci->unlink_watchdog, round_jiffies(jiffies + HZ));
89a0fd18
MN
495done:
496 spin_unlock_irqrestore(&ohci->lock, flags);
497}
498
1da177e4
LT
499/*-------------------------------------------------------------------------*
500 * HC functions
501 *-------------------------------------------------------------------------*/
502
503/* init memory, and kick BIOS/SMM off */
504
505static int ohci_init (struct ohci_hcd *ohci)
506{
507 int ret;
6a9062f3 508 struct usb_hcd *hcd = ohci_to_hcd(ohci);
1da177e4 509
1133cd8a
DES
510 if (distrust_firmware)
511 ohci->flags |= OHCI_QUIRK_HUB_POWER;
512
1da177e4 513 disable (ohci);
6a9062f3 514 ohci->regs = hcd->regs;
1da177e4 515
6a9062f3
DB
516 /* REVISIT this BIOS handshake is now moved into PCI "quirks", and
517 * was never needed for most non-PCI systems ... remove the code?
518 */
519
1da177e4
LT
520#ifndef IR_DISABLE
521 /* SMM owns the HC? not for long! */
522 if (!no_handshake && ohci_readl (ohci,
523 &ohci->regs->control) & OHCI_CTRL_IR) {
524 u32 temp;
525
526 ohci_dbg (ohci, "USB HC TakeOver from BIOS/SMM\n");
527
528 /* this timeout is arbitrary. we make it long, so systems
529 * depending on usb keyboards may be usable even if the
530 * BIOS/SMM code seems pretty broken.
531 */
532 temp = 500; /* arbitrary: five seconds */
533
534 ohci_writel (ohci, OHCI_INTR_OC, &ohci->regs->intrenable);
535 ohci_writel (ohci, OHCI_OCR, &ohci->regs->cmdstatus);
536 while (ohci_readl (ohci, &ohci->regs->control) & OHCI_CTRL_IR) {
537 msleep (10);
538 if (--temp == 0) {
539 ohci_err (ohci, "USB HC takeover failed!"
540 " (BIOS/SMM bug)\n");
541 return -EBUSY;
542 }
543 }
544 ohci_usb_reset (ohci);
545 }
546#endif
547
548 /* Disable HC interrupts */
549 ohci_writel (ohci, OHCI_INTR_MIE, &ohci->regs->intrdisable);
6a9062f3
DB
550
551 /* flush the writes, and save key bits like RWC */
552 if (ohci_readl (ohci, &ohci->regs->control) & OHCI_CTRL_RWC)
553 ohci->hc_control |= OHCI_CTRL_RWC;
1da177e4 554
fdd13b36
DB
555 /* Read the number of ports unless overridden */
556 if (ohci->num_ports == 0)
557 ohci->num_ports = roothub_a(ohci) & RH_A_NDP;
558
1da177e4
LT
559 if (ohci->hcca)
560 return 0;
561
6a9062f3 562 ohci->hcca = dma_alloc_coherent (hcd->self.controller,
1da177e4
LT
563 sizeof *ohci->hcca, &ohci->hcca_dma, 0);
564 if (!ohci->hcca)
565 return -ENOMEM;
566
567 if ((ret = ohci_mem_init (ohci)) < 0)
6a9062f3
DB
568 ohci_stop (hcd);
569 else {
6a9062f3
DB
570 create_debug_files (ohci);
571 }
1da177e4
LT
572
573 return ret;
1da177e4
LT
574}
575
576/*-------------------------------------------------------------------------*/
577
578/* Start an OHCI controller, set the BUS operational
579 * resets USB and controller
dd9048af 580 * enable interrupts
1da177e4
LT
581 */
582static int ohci_run (struct ohci_hcd *ohci)
583{
96f90a8b 584 u32 mask, val;
1da177e4 585 int first = ohci->fminterval == 0;
6a9062f3 586 struct usb_hcd *hcd = ohci_to_hcd(ohci);
1da177e4
LT
587
588 disable (ohci);
589
590 /* boot firmware should have set this up (5.1.1.3.1) */
591 if (first) {
592
96f90a8b
HS
593 val = ohci_readl (ohci, &ohci->regs->fminterval);
594 ohci->fminterval = val & 0x3fff;
1da177e4
LT
595 if (ohci->fminterval != FI)
596 ohci_dbg (ohci, "fminterval delta %d\n",
597 ohci->fminterval - FI);
598 ohci->fminterval |= FSMP (ohci->fminterval) << 16;
599 /* also: power/overcurrent flags in roothub.a */
600 }
601
6fd9086a
AS
602 /* Reset USB nearly "by the book". RemoteWakeupConnected has
603 * to be checked in case boot firmware (BIOS/SMM/...) has set up
604 * wakeup in a way the bus isn't aware of (e.g., legacy PCI PM).
605 * If the bus glue detected wakeup capability then it should
bcca06ef 606 * already be enabled; if so we'll just enable it again.
1da177e4 607 */
bcca06ef
AS
608 if ((ohci->hc_control & OHCI_CTRL_RWC) != 0)
609 device_set_wakeup_capable(hcd->self.controller, 1);
1da177e4
LT
610
611 switch (ohci->hc_control & OHCI_CTRL_HCFS) {
612 case OHCI_USB_OPER:
96f90a8b 613 val = 0;
1da177e4
LT
614 break;
615 case OHCI_USB_SUSPEND:
616 case OHCI_USB_RESUME:
617 ohci->hc_control &= OHCI_CTRL_RWC;
618 ohci->hc_control |= OHCI_USB_RESUME;
96f90a8b 619 val = 10 /* msec wait */;
1da177e4
LT
620 break;
621 // case OHCI_USB_RESET:
622 default:
623 ohci->hc_control &= OHCI_CTRL_RWC;
624 ohci->hc_control |= OHCI_USB_RESET;
96f90a8b 625 val = 50 /* msec wait */;
1da177e4
LT
626 break;
627 }
628 ohci_writel (ohci, ohci->hc_control, &ohci->regs->control);
629 // flush the writes
630 (void) ohci_readl (ohci, &ohci->regs->control);
96f90a8b 631 msleep(val);
383975d7 632
1da177e4
LT
633 memset (ohci->hcca, 0, sizeof (struct ohci_hcca));
634
635 /* 2msec timelimit here means no irqs/preempt */
636 spin_lock_irq (&ohci->lock);
637
638retry:
639 /* HC Reset requires max 10 us delay */
640 ohci_writel (ohci, OHCI_HCR, &ohci->regs->cmdstatus);
96f90a8b 641 val = 30; /* ... allow extra time */
1da177e4 642 while ((ohci_readl (ohci, &ohci->regs->cmdstatus) & OHCI_HCR) != 0) {
96f90a8b 643 if (--val == 0) {
1da177e4
LT
644 spin_unlock_irq (&ohci->lock);
645 ohci_err (ohci, "USB HC reset timed out!\n");
646 return -1;
647 }
648 udelay (1);
649 }
650
651 /* now we're in the SUSPEND state ... must go OPERATIONAL
652 * within 2msec else HC enters RESUME
653 *
654 * ... but some hardware won't init fmInterval "by the book"
655 * (SiS, OPTi ...), so reset again instead. SiS doesn't need
656 * this if we write fmInterval after we're OPERATIONAL.
657 * Unclear about ALi, ServerWorks, and others ... this could
658 * easily be a longstanding bug in chip init on Linux.
659 */
660 if (ohci->flags & OHCI_QUIRK_INITRESET) {
661 ohci_writel (ohci, ohci->hc_control, &ohci->regs->control);
662 // flush those writes
663 (void) ohci_readl (ohci, &ohci->regs->control);
664 }
665
666 /* Tell the controller where the control and bulk lists are
667 * The lists are empty now. */
668 ohci_writel (ohci, 0, &ohci->regs->ed_controlhead);
669 ohci_writel (ohci, 0, &ohci->regs->ed_bulkhead);
670
671 /* a reset clears this */
672 ohci_writel (ohci, (u32) ohci->hcca_dma, &ohci->regs->hcca);
673
674 periodic_reinit (ohci);
675
676 /* some OHCI implementations are finicky about how they init.
677 * bogus values here mean not even enumeration could work.
678 */
679 if ((ohci_readl (ohci, &ohci->regs->fminterval) & 0x3fff0000) == 0
680 || !ohci_readl (ohci, &ohci->regs->periodicstart)) {
681 if (!(ohci->flags & OHCI_QUIRK_INITRESET)) {
682 ohci->flags |= OHCI_QUIRK_INITRESET;
683 ohci_dbg (ohci, "enabling initreset quirk\n");
684 goto retry;
685 }
686 spin_unlock_irq (&ohci->lock);
687 ohci_err (ohci, "init err (%08x %04x)\n",
688 ohci_readl (ohci, &ohci->regs->fminterval),
689 ohci_readl (ohci, &ohci->regs->periodicstart));
690 return -EOVERFLOW;
691 }
692
d413984a 693 /* use rhsc irqs after khubd is fully initialized */
541c7d43 694 set_bit(HCD_FLAG_POLL_RH, &hcd->flags);
d413984a
DB
695 hcd->uses_new_polling = 1;
696
697 /* start controller operations */
1da177e4 698 ohci->hc_control &= OHCI_CTRL_RWC;
d413984a
DB
699 ohci->hc_control |= OHCI_CONTROL_INIT | OHCI_USB_OPER;
700 ohci_writel (ohci, ohci->hc_control, &ohci->regs->control);
6a9062f3 701 hcd->state = HC_STATE_RUNNING;
1da177e4
LT
702
703 /* wake on ConnectStatusChange, matching external hubs */
704 ohci_writel (ohci, RH_HS_DRWE, &ohci->regs->roothub.status);
705
706 /* Choose the interrupts we care about now, others later on demand */
707 mask = OHCI_INTR_INIT;
d413984a 708 ohci_writel (ohci, ~0, &ohci->regs->intrstatus);
1da177e4
LT
709 ohci_writel (ohci, mask, &ohci->regs->intrenable);
710
711 /* handle root hub init quirks ... */
96f90a8b
HS
712 val = roothub_a (ohci);
713 val &= ~(RH_A_PSM | RH_A_OCPM);
1da177e4
LT
714 if (ohci->flags & OHCI_QUIRK_SUPERIO) {
715 /* NSC 87560 and maybe others */
96f90a8b
HS
716 val |= RH_A_NOCP;
717 val &= ~(RH_A_POTPGT | RH_A_NPS);
718 ohci_writel (ohci, val, &ohci->regs->roothub.a);
1133cd8a
DES
719 } else if ((ohci->flags & OHCI_QUIRK_AMD756) ||
720 (ohci->flags & OHCI_QUIRK_HUB_POWER)) {
1da177e4
LT
721 /* hub power always on; required for AMD-756 and some
722 * Mac platforms. ganged overcurrent reporting, if any.
723 */
96f90a8b
HS
724 val |= RH_A_NPS;
725 ohci_writel (ohci, val, &ohci->regs->roothub.a);
1da177e4
LT
726 }
727 ohci_writel (ohci, RH_HS_LPSC, &ohci->regs->roothub.status);
96f90a8b 728 ohci_writel (ohci, (val & RH_A_NPS) ? 0 : RH_B_PPCM,
1da177e4
LT
729 &ohci->regs->roothub.b);
730 // flush those writes
731 (void) ohci_readl (ohci, &ohci->regs->control);
732
d413984a 733 ohci->next_statechange = jiffies + STATECHANGE_DELAY;
1da177e4
LT
734 spin_unlock_irq (&ohci->lock);
735
736 // POTPGT delay is bits 24-31, in 2 ms units.
96f90a8b 737 mdelay ((val >> 23) & 0x1fe);
6a9062f3 738 hcd->state = HC_STATE_RUNNING;
1da177e4 739
89a0fd18
MN
740 if (quirk_zfmicro(ohci)) {
741 /* Create timer to watch for bad queue state on ZF Micro */
742 setup_timer(&ohci->unlink_watchdog, unlink_watchdog_func,
743 (unsigned long) ohci);
744
745 ohci->eds_scheduled = 0;
746 ohci->ed_to_check = NULL;
747 }
748
1da177e4
LT
749 ohci_dump (ohci, 1);
750
1da177e4
LT
751 return 0;
752}
753
754/*-------------------------------------------------------------------------*/
755
756/* an interrupt happens */
757
7d12e780 758static irqreturn_t ohci_irq (struct usb_hcd *hcd)
1da177e4
LT
759{
760 struct ohci_hcd *ohci = hcd_to_ohci (hcd);
761 struct ohci_regs __iomem *regs = ohci->regs;
89a0fd18 762 int ints;
1da177e4 763
565227c0
BH
764 /* Read interrupt status (and flush pending writes). We ignore the
765 * optimization of checking the LSB of hcca->done_head; it doesn't
766 * work on all systems (edge triggering for OHCI can be a factor).
89a0fd18 767 */
565227c0 768 ints = ohci_readl(ohci, &regs->intrstatus);
1da177e4 769
565227c0
BH
770 /* Check for an all 1's result which is a typical consequence
771 * of dead, unclocked, or unplugged (CardBus...) devices
772 */
773 if (ints == ~(u32)0) {
1da177e4
LT
774 disable (ohci);
775 ohci_dbg (ohci, "device removed!\n");
776 return IRQ_HANDLED;
565227c0
BH
777 }
778
779 /* We only care about interrupts that are enabled */
780 ints &= ohci_readl(ohci, &regs->intrenable);
1da177e4
LT
781
782 /* interrupt for some other device? */
565227c0 783 if (ints == 0)
1da177e4 784 return IRQ_NOTMINE;
d413984a 785
1da177e4 786 if (ints & OHCI_INTR_UE) {
1da177e4 787 // e.g. due to PCI Master/Target Abort
89a0fd18 788 if (quirk_nec(ohci)) {
d576bb9f
MH
789 /* Workaround for a silicon bug in some NEC chips used
790 * in Apple's PowerBooks. Adapted from Darwin code.
791 */
792 ohci_err (ohci, "OHCI Unrecoverable Error, scheduling NEC chip restart\n");
793
794 ohci_writel (ohci, OHCI_INTR_UE, &regs->intrdisable);
795
796 schedule_work (&ohci->nec_work);
797 } else {
798 disable (ohci);
799 ohci_err (ohci, "OHCI Unrecoverable Error, disabled\n");
800 }
1da177e4
LT
801
802 ohci_dump (ohci, 1);
803 ohci_usb_reset (ohci);
804 }
805
583ceada
AS
806 if (ints & OHCI_INTR_RHSC) {
807 ohci_vdbg(ohci, "rhsc\n");
808 ohci->next_statechange = jiffies + STATECHANGE_DELAY;
809 ohci_writel(ohci, OHCI_INTR_RD | OHCI_INTR_RHSC,
810 &regs->intrstatus);
052ac01a
AS
811
812 /* NOTE: Vendors didn't always make the same implementation
813 * choices for RHSC. Many followed the spec; RHSC triggers
814 * on an edge, like setting and maybe clearing a port status
815 * change bit. With others it's level-triggered, active
816 * until khubd clears all the port status change bits. We'll
817 * always disable it here and rely on polling until khubd
818 * re-enables it.
819 */
820 ohci_writel(ohci, OHCI_INTR_RHSC, &regs->intrdisable);
583ceada
AS
821 usb_hcd_poll_rh_status(hcd);
822 }
823
824 /* For connect and disconnect events, we expect the controller
825 * to turn on RHSC along with RD. But for remote wakeup events
826 * this might not happen.
827 */
828 else if (ints & OHCI_INTR_RD) {
829 ohci_vdbg(ohci, "resume detect\n");
830 ohci_writel(ohci, OHCI_INTR_RD, &regs->intrstatus);
541c7d43 831 set_bit(HCD_FLAG_POLL_RH, &hcd->flags);
8d1a243b
AS
832 if (ohci->autostop) {
833 spin_lock (&ohci->lock);
834 ohci_rh_resume (ohci);
835 spin_unlock (&ohci->lock);
836 } else
f197b2c5 837 usb_hcd_resume_root_hub(hcd);
1da177e4
LT
838 }
839
840 if (ints & OHCI_INTR_WDH) {
1da177e4 841 spin_lock (&ohci->lock);
7d12e780 842 dl_done_list (ohci);
1da177e4 843 spin_unlock (&ohci->lock);
1da177e4 844 }
dd9048af 845
89a0fd18
MN
846 if (quirk_zfmicro(ohci) && (ints & OHCI_INTR_SF)) {
847 spin_lock(&ohci->lock);
848 if (ohci->ed_to_check) {
849 struct ed *ed = ohci->ed_to_check;
850
851 if (check_ed(ohci, ed)) {
852 /* HC thinks the TD list is empty; HCD knows
853 * at least one TD is outstanding
854 */
855 if (--ohci->zf_delay == 0) {
856 struct td *td = list_entry(
857 ed->td_list.next,
858 struct td, td_list);
859 ohci_warn(ohci,
860 "Reclaiming orphan TD %p\n",
861 td);
862 takeback_td(ohci, td);
863 ohci->ed_to_check = NULL;
864 }
865 } else
866 ohci->ed_to_check = NULL;
867 }
868 spin_unlock(&ohci->lock);
869 }
870
1da177e4
LT
871 /* could track INTR_SO to reduce available PCI/... bandwidth */
872
873 /* handle any pending URB/ED unlinks, leaving INTR_SF enabled
874 * when there's still unlinking to be done (next frame).
875 */
876 spin_lock (&ohci->lock);
877 if (ohci->ed_rm_list)
7d12e780 878 finish_unlinks (ohci, ohci_frame_no(ohci));
89a0fd18
MN
879 if ((ints & OHCI_INTR_SF) != 0
880 && !ohci->ed_rm_list
881 && !ohci->ed_to_check
1da177e4 882 && HC_IS_RUNNING(hcd->state))
dd9048af 883 ohci_writel (ohci, OHCI_INTR_SF, &regs->intrdisable);
1da177e4
LT
884 spin_unlock (&ohci->lock);
885
886 if (HC_IS_RUNNING(hcd->state)) {
887 ohci_writel (ohci, ints, &regs->intrstatus);
dd9048af 888 ohci_writel (ohci, OHCI_INTR_MIE, &regs->intrenable);
1da177e4
LT
889 // flush those writes
890 (void) ohci_readl (ohci, &ohci->regs->control);
891 }
892
893 return IRQ_HANDLED;
894}
895
896/*-------------------------------------------------------------------------*/
897
898static void ohci_stop (struct usb_hcd *hcd)
dd9048af 899{
1da177e4
LT
900 struct ohci_hcd *ohci = hcd_to_ohci (hcd);
901
1da177e4
LT
902 ohci_dump (ohci, 1);
903
569ff2de
TH
904 if (quirk_nec(ohci))
905 flush_work_sync(&ohci->nec_work);
1da177e4
LT
906
907 ohci_usb_reset (ohci);
908 ohci_writel (ohci, OHCI_INTR_MIE, &ohci->regs->intrdisable);
71795c1d
PZ
909 free_irq(hcd->irq, hcd);
910 hcd->irq = -1;
911
89a0fd18
MN
912 if (quirk_zfmicro(ohci))
913 del_timer(&ohci->unlink_watchdog);
ab1666c1
LY
914 if (quirk_amdiso(ohci))
915 amd_iso_dev_put();
89a0fd18 916
1da177e4
LT
917 remove_debug_files (ohci);
918 ohci_mem_cleanup (ohci);
919 if (ohci->hcca) {
dd9048af
DB
920 dma_free_coherent (hcd->self.controller,
921 sizeof *ohci->hcca,
1da177e4
LT
922 ohci->hcca, ohci->hcca_dma);
923 ohci->hcca = NULL;
924 ohci->hcca_dma = 0;
925 }
926}
927
928/*-------------------------------------------------------------------------*/
929
da6fb570
DB
930#if defined(CONFIG_PM) || defined(CONFIG_PCI)
931
1da177e4 932/* must not be called from interrupt context */
1da177e4
LT
933static int ohci_restart (struct ohci_hcd *ohci)
934{
935 int temp;
936 int i;
937 struct urb_priv *priv;
1da177e4 938
1da177e4
LT
939 spin_lock_irq(&ohci->lock);
940 disable (ohci);
d576bb9f
MH
941
942 /* Recycle any "live" eds/tds (and urbs). */
1da177e4
LT
943 if (!list_empty (&ohci->pending))
944 ohci_dbg(ohci, "abort schedule...\n");
945 list_for_each_entry (priv, &ohci->pending, pending) {
946 struct urb *urb = priv->td[0]->urb;
947 struct ed *ed = priv->ed;
948
949 switch (ed->state) {
950 case ED_OPER:
951 ed->state = ED_UNLINK;
952 ed->hwINFO |= cpu_to_hc32(ohci, ED_DEQUEUE);
953 ed_deschedule (ohci, ed);
954
955 ed->ed_next = ohci->ed_rm_list;
956 ed->ed_prev = NULL;
957 ohci->ed_rm_list = ed;
958 /* FALLTHROUGH */
959 case ED_UNLINK:
960 break;
961 default:
962 ohci_dbg(ohci, "bogus ed %p state %d\n",
963 ed, ed->state);
964 }
965
55d84968
AS
966 if (!urb->unlinked)
967 urb->unlinked = -ESHUTDOWN;
1da177e4 968 }
7d12e780 969 finish_unlinks (ohci, 0);
1da177e4
LT
970 spin_unlock_irq(&ohci->lock);
971
972 /* paranoia, in case that didn't work: */
973
974 /* empty the interrupt branches */
975 for (i = 0; i < NUM_INTS; i++) ohci->load [i] = 0;
976 for (i = 0; i < NUM_INTS; i++) ohci->hcca->int_table [i] = 0;
dd9048af 977
1da177e4
LT
978 /* no EDs to remove */
979 ohci->ed_rm_list = NULL;
980
dd9048af 981 /* empty control and bulk lists */
1da177e4
LT
982 ohci->ed_controltail = NULL;
983 ohci->ed_bulktail = NULL;
984
985 if ((temp = ohci_run (ohci)) < 0) {
986 ohci_err (ohci, "can't restart, %d\n", temp);
987 return temp;
1da177e4 988 }
383975d7 989 ohci_dbg(ohci, "restart complete\n");
1da177e4
LT
990 return 0;
991}
d576bb9f 992
da6fb570
DB
993#endif
994
d576bb9f
MH
995/*-------------------------------------------------------------------------*/
996
1da177e4 997MODULE_AUTHOR (DRIVER_AUTHOR);
2b70f073 998MODULE_DESCRIPTION(DRIVER_DESC);
1da177e4
LT
999MODULE_LICENSE ("GPL");
1000
1001#ifdef CONFIG_PCI
1002#include "ohci-pci.c"
5e16fabe 1003#define PCI_DRIVER ohci_pci_driver
1da177e4
LT
1004#endif
1005
6381fad7 1006#if defined(CONFIG_ARCH_SA1100) && defined(CONFIG_SA1111)
1da177e4 1007#include "ohci-sa1111.c"
5e16fabe 1008#define SA1111_DRIVER ohci_hcd_sa1111_driver
1da177e4
LT
1009#endif
1010
3ba5f38f 1011#if defined(CONFIG_ARCH_S3C2410) || defined(CONFIG_ARCH_S3C64XX)
3eb0c5f4 1012#include "ohci-s3c2410.c"
5e16fabe 1013#define PLATFORM_DRIVER ohci_hcd_s3c2410_driver
3eb0c5f4
BD
1014#endif
1015
968b448b 1016#ifdef CONFIG_USB_OHCI_HCD_OMAP1
1da177e4 1017#include "ohci-omap.c"
968b448b
AG
1018#define OMAP1_PLATFORM_DRIVER ohci_hcd_omap_driver
1019#endif
1020
1021#ifdef CONFIG_USB_OHCI_HCD_OMAP3
1022#include "ohci-omap3.c"
1023#define OMAP3_PLATFORM_DRIVER ohci_hcd_omap3_driver
1da177e4
LT
1024#endif
1025
1026#ifdef CONFIG_ARCH_LH7A404
1027#include "ohci-lh7a404.c"
5e16fabe 1028#define PLATFORM_DRIVER ohci_hcd_lh7a404_driver
1da177e4
LT
1029#endif
1030
e77ec189 1031#if defined(CONFIG_PXA27x) || defined(CONFIG_PXA3xx)
1da177e4 1032#include "ohci-pxa27x.c"
5e16fabe 1033#define PLATFORM_DRIVER ohci_hcd_pxa27x_driver
1da177e4
LT
1034#endif
1035
a5b7474a
LB
1036#ifdef CONFIG_ARCH_EP93XX
1037#include "ohci-ep93xx.c"
5e16fabe 1038#define PLATFORM_DRIVER ohci_hcd_ep93xx_driver
a5b7474a
LB
1039#endif
1040
42a4f17d 1041#ifdef CONFIG_MIPS_ALCHEMY
1da177e4 1042#include "ohci-au1xxx.c"
5e16fabe 1043#define PLATFORM_DRIVER ohci_hcd_au1xxx_driver
1da177e4
LT
1044#endif
1045
5151d040
VW
1046#ifdef CONFIG_PNX8550
1047#include "ohci-pnx8550.c"
5e16fabe 1048#define PLATFORM_DRIVER ohci_hcd_pnx8550_driver
5151d040
VW
1049#endif
1050
1da177e4
LT
1051#ifdef CONFIG_USB_OHCI_HCD_PPC_SOC
1052#include "ohci-ppc-soc.c"
5e16fabe 1053#define PLATFORM_DRIVER ohci_hcd_ppc_soc_driver
1da177e4
LT
1054#endif
1055
58a0cd78 1056#ifdef CONFIG_ARCH_AT91
39a269c0 1057#include "ohci-at91.c"
5e16fabe 1058#define PLATFORM_DRIVER ohci_hcd_at91_driver
39a269c0
AV
1059#endif
1060
60bbfc84
VW
1061#ifdef CONFIG_ARCH_PNX4008
1062#include "ohci-pnx4008.c"
5e16fabe 1063#define PLATFORM_DRIVER usb_hcd_pnx4008_driver
60bbfc84
VW
1064#endif
1065
efe7daf2
SS
1066#ifdef CONFIG_ARCH_DAVINCI_DA8XX
1067#include "ohci-da8xx.c"
1068#define PLATFORM_DRIVER ohci_hcd_da8xx_driver
1069#endif
1070
828d55c5
YS
1071#if defined(CONFIG_CPU_SUBTYPE_SH7720) || \
1072 defined(CONFIG_CPU_SUBTYPE_SH7721) || \
4c3f450b
KM
1073 defined(CONFIG_CPU_SUBTYPE_SH7763) || \
1074 defined(CONFIG_CPU_SUBTYPE_SH7786)
828d55c5
YS
1075#include "ohci-sh.c"
1076#define PLATFORM_DRIVER ohci_hcd_sh_driver
1077#endif
1078
5e16fabe 1079
495a678f
SM
1080#ifdef CONFIG_USB_OHCI_HCD_PPC_OF
1081#include "ohci-ppc-of.c"
1082#define OF_PLATFORM_DRIVER ohci_hcd_ppc_of_driver
1083#endif
1084
6a6c957e
GL
1085#ifdef CONFIG_PPC_PS3
1086#include "ohci-ps3.c"
7a4eb7fd 1087#define PS3_SYSTEM_BUS_DRIVER ps3_ohci_driver
6a6c957e
GL
1088#endif
1089
c604e851
MB
1090#ifdef CONFIG_USB_OHCI_HCD_SSB
1091#include "ohci-ssb.c"
1092#define SSB_OHCI_DRIVER ssb_ohci_driver
1093#endif
1094
f54aab6e
MD
1095#ifdef CONFIG_MFD_SM501
1096#include "ohci-sm501.c"
3ee38d8b 1097#define SM501_OHCI_DRIVER ohci_hcd_sm501_driver
f54aab6e
MD
1098#endif
1099
78c73414
DES
1100#ifdef CONFIG_MFD_TC6393XB
1101#include "ohci-tmio.c"
1102#define TMIO_OHCI_DRIVER ohci_hcd_tmio_driver
2249071b
LPC
1103#endif
1104
1105#ifdef CONFIG_MACH_JZ4740
1106#include "ohci-jz4740.c"
1107#define PLATFORM_DRIVER ohci_hcd_jz4740_driver
78c73414
DES
1108#endif
1109
1643accd
DD
1110#ifdef CONFIG_USB_OCTEON_OHCI
1111#include "ohci-octeon.c"
1112#define PLATFORM_DRIVER ohci_octeon_driver
1113#endif
1114
5e16fabe
SM
1115#if !defined(PCI_DRIVER) && \
1116 !defined(PLATFORM_DRIVER) && \
968b448b
AG
1117 !defined(OMAP1_PLATFORM_DRIVER) && \
1118 !defined(OMAP3_PLATFORM_DRIVER) && \
495a678f 1119 !defined(OF_PLATFORM_DRIVER) && \
6a6c957e 1120 !defined(SA1111_DRIVER) && \
c604e851 1121 !defined(PS3_SYSTEM_BUS_DRIVER) && \
3ee38d8b 1122 !defined(SM501_OHCI_DRIVER) && \
78c73414 1123 !defined(TMIO_OHCI_DRIVER) && \
c604e851 1124 !defined(SSB_OHCI_DRIVER)
1da177e4
LT
1125#error "missing bus glue for ohci-hcd"
1126#endif
5e16fabe
SM
1127
1128static int __init ohci_hcd_mod_init(void)
1129{
1130 int retval = 0;
5e16fabe
SM
1131
1132 if (usb_disabled())
1133 return -ENODEV;
1134
2b70f073 1135 printk(KERN_INFO "%s: " DRIVER_DESC "\n", hcd_name);
5e16fabe
SM
1136 pr_debug ("%s: block sizes: ed %Zd td %Zd\n", hcd_name,
1137 sizeof (struct ed), sizeof (struct td));
9beeee65 1138 set_bit(USB_OHCI_LOADED, &usb_hcds_loaded);
5e16fabe 1139
684c19e0 1140#ifdef DEBUG
485f4f39 1141 ohci_debug_root = debugfs_create_dir("ohci", usb_debug_root);
684c19e0
TJ
1142 if (!ohci_debug_root) {
1143 retval = -ENOENT;
1144 goto error_debug;
1145 }
1146#endif
1147
6a6c957e 1148#ifdef PS3_SYSTEM_BUS_DRIVER
7a4eb7fd
GL
1149 retval = ps3_ohci_driver_register(&PS3_SYSTEM_BUS_DRIVER);
1150 if (retval < 0)
1151 goto error_ps3;
6a6c957e
GL
1152#endif
1153
5e16fabe
SM
1154#ifdef PLATFORM_DRIVER
1155 retval = platform_driver_register(&PLATFORM_DRIVER);
1156 if (retval < 0)
de44743b 1157 goto error_platform;
5e16fabe
SM
1158#endif
1159
968b448b
AG
1160#ifdef OMAP1_PLATFORM_DRIVER
1161 retval = platform_driver_register(&OMAP1_PLATFORM_DRIVER);
1162 if (retval < 0)
1163 goto error_omap1_platform;
1164#endif
1165
1166#ifdef OMAP3_PLATFORM_DRIVER
1167 retval = platform_driver_register(&OMAP3_PLATFORM_DRIVER);
1168 if (retval < 0)
1169 goto error_omap3_platform;
1170#endif
1171
495a678f
SM
1172#ifdef OF_PLATFORM_DRIVER
1173 retval = of_register_platform_driver(&OF_PLATFORM_DRIVER);
1174 if (retval < 0)
de44743b 1175 goto error_of_platform;
495a678f
SM
1176#endif
1177
5e16fabe
SM
1178#ifdef SA1111_DRIVER
1179 retval = sa1111_driver_register(&SA1111_DRIVER);
1180 if (retval < 0)
de44743b 1181 goto error_sa1111;
5e16fabe
SM
1182#endif
1183
1184#ifdef PCI_DRIVER
1185 retval = pci_register_driver(&PCI_DRIVER);
1186 if (retval < 0)
de44743b 1187 goto error_pci;
5e16fabe
SM
1188#endif
1189
c604e851
MB
1190#ifdef SSB_OHCI_DRIVER
1191 retval = ssb_driver_register(&SSB_OHCI_DRIVER);
1192 if (retval)
1193 goto error_ssb;
1194#endif
1195
3ee38d8b
BD
1196#ifdef SM501_OHCI_DRIVER
1197 retval = platform_driver_register(&SM501_OHCI_DRIVER);
1198 if (retval < 0)
1199 goto error_sm501;
1200#endif
1201
78c73414
DES
1202#ifdef TMIO_OHCI_DRIVER
1203 retval = platform_driver_register(&TMIO_OHCI_DRIVER);
1204 if (retval < 0)
1205 goto error_tmio;
1206#endif
1207
5e16fabe
SM
1208 return retval;
1209
1210 /* Error path */
78c73414
DES
1211#ifdef TMIO_OHCI_DRIVER
1212 platform_driver_unregister(&TMIO_OHCI_DRIVER);
1213 error_tmio:
1214#endif
3ee38d8b 1215#ifdef SM501_OHCI_DRIVER
78c73414 1216 platform_driver_unregister(&SM501_OHCI_DRIVER);
3ee38d8b
BD
1217 error_sm501:
1218#endif
c604e851 1219#ifdef SSB_OHCI_DRIVER
78c73414 1220 ssb_driver_unregister(&SSB_OHCI_DRIVER);
c604e851
MB
1221 error_ssb:
1222#endif
de44743b 1223#ifdef PCI_DRIVER
c604e851 1224 pci_unregister_driver(&PCI_DRIVER);
de44743b
BH
1225 error_pci:
1226#endif
1227#ifdef SA1111_DRIVER
1228 sa1111_driver_unregister(&SA1111_DRIVER);
1229 error_sa1111:
5e16fabe 1230#endif
495a678f 1231#ifdef OF_PLATFORM_DRIVER
de44743b
BH
1232 of_unregister_platform_driver(&OF_PLATFORM_DRIVER);
1233 error_of_platform:
495a678f 1234#endif
de44743b
BH
1235#ifdef PLATFORM_DRIVER
1236 platform_driver_unregister(&PLATFORM_DRIVER);
1237 error_platform:
6a6c957e 1238#endif
968b448b
AG
1239#ifdef OMAP1_PLATFORM_DRIVER
1240 platform_driver_unregister(&OMAP1_PLATFORM_DRIVER);
1241 error_omap1_platform:
1242#endif
1243#ifdef OMAP3_PLATFORM_DRIVER
1244 platform_driver_unregister(&OMAP3_PLATFORM_DRIVER);
1245 error_omap3_platform:
1246#endif
6a6c957e 1247#ifdef PS3_SYSTEM_BUS_DRIVER
7a4eb7fd 1248 ps3_ohci_driver_unregister(&PS3_SYSTEM_BUS_DRIVER);
6a6c957e 1249 error_ps3:
5e16fabe 1250#endif
684c19e0
TJ
1251#ifdef DEBUG
1252 debugfs_remove(ohci_debug_root);
1253 ohci_debug_root = NULL;
1254 error_debug:
1255#endif
1256
9beeee65 1257 clear_bit(USB_OHCI_LOADED, &usb_hcds_loaded);
5e16fabe
SM
1258 return retval;
1259}
1260module_init(ohci_hcd_mod_init);
1261
1262static void __exit ohci_hcd_mod_exit(void)
1263{
78c73414
DES
1264#ifdef TMIO_OHCI_DRIVER
1265 platform_driver_unregister(&TMIO_OHCI_DRIVER);
1266#endif
3ee38d8b
BD
1267#ifdef SM501_OHCI_DRIVER
1268 platform_driver_unregister(&SM501_OHCI_DRIVER);
1269#endif
c604e851
MB
1270#ifdef SSB_OHCI_DRIVER
1271 ssb_driver_unregister(&SSB_OHCI_DRIVER);
1272#endif
5e16fabe
SM
1273#ifdef PCI_DRIVER
1274 pci_unregister_driver(&PCI_DRIVER);
1275#endif
1276#ifdef SA1111_DRIVER
1277 sa1111_driver_unregister(&SA1111_DRIVER);
1278#endif
495a678f
SM
1279#ifdef OF_PLATFORM_DRIVER
1280 of_unregister_platform_driver(&OF_PLATFORM_DRIVER);
1281#endif
5e16fabe
SM
1282#ifdef PLATFORM_DRIVER
1283 platform_driver_unregister(&PLATFORM_DRIVER);
1284#endif
ffb6748f
KM
1285#ifdef OMAP3_PLATFORM_DRIVER
1286 platform_driver_unregister(&OMAP3_PLATFORM_DRIVER);
1287#endif
6a6c957e 1288#ifdef PS3_SYSTEM_BUS_DRIVER
7a4eb7fd 1289 ps3_ohci_driver_unregister(&PS3_SYSTEM_BUS_DRIVER);
6a6c957e 1290#endif
684c19e0
TJ
1291#ifdef DEBUG
1292 debugfs_remove(ohci_debug_root);
1293#endif
9beeee65 1294 clear_bit(USB_OHCI_LOADED, &usb_hcds_loaded);
5e16fabe
SM
1295}
1296module_exit(ohci_hcd_mod_exit);
1297