Commit | Line | Data |
---|---|---|
1da177e4 | 1 | /* |
578333ab AS |
2 | * Enhanced Host Controller Interface (EHCI) driver for USB. |
3 | * | |
4 | * Maintainer: Alan Stern <stern@rowland.harvard.edu> | |
5 | * | |
1da177e4 | 6 | * Copyright (c) 2000-2004 by David Brownell |
53bd6a60 | 7 | * |
1da177e4 LT |
8 | * This program is free software; you can redistribute it and/or modify it |
9 | * under the terms of the GNU General Public License as published by the | |
10 | * Free Software Foundation; either version 2 of the License, or (at your | |
11 | * option) any later version. | |
12 | * | |
13 | * This program is distributed in the hope that it will be useful, but | |
14 | * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY | |
15 | * or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License | |
16 | * for more details. | |
17 | * | |
18 | * You should have received a copy of the GNU General Public License | |
19 | * along with this program; if not, write to the Free Software Foundation, | |
20 | * Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | |
21 | */ | |
22 | ||
1da177e4 LT |
23 | #include <linux/module.h> |
24 | #include <linux/pci.h> | |
25 | #include <linux/dmapool.h> | |
26 | #include <linux/kernel.h> | |
27 | #include <linux/delay.h> | |
28 | #include <linux/ioport.h> | |
29 | #include <linux/sched.h> | |
3c04e20e | 30 | #include <linux/vmalloc.h> |
1da177e4 LT |
31 | #include <linux/errno.h> |
32 | #include <linux/init.h> | |
d58b4bcc | 33 | #include <linux/hrtimer.h> |
1da177e4 LT |
34 | #include <linux/list.h> |
35 | #include <linux/interrupt.h> | |
1da177e4 | 36 | #include <linux/usb.h> |
27729aad | 37 | #include <linux/usb/hcd.h> |
1da177e4 LT |
38 | #include <linux/moduleparam.h> |
39 | #include <linux/dma-mapping.h> | |
694cc208 | 40 | #include <linux/debugfs.h> |
5a0e3ad6 | 41 | #include <linux/slab.h> |
aa4d8342 | 42 | #include <linux/uaccess.h> |
1da177e4 | 43 | |
1da177e4 LT |
44 | #include <asm/byteorder.h> |
45 | #include <asm/io.h> | |
46 | #include <asm/irq.h> | |
1da177e4 | 47 | #include <asm/unaligned.h> |
1da177e4 | 48 | |
df7c1ca2 GL |
49 | #if defined(CONFIG_PPC_PS3) |
50 | #include <asm/firmware.h> | |
51 | #endif | |
52 | ||
1da177e4 LT |
53 | /*-------------------------------------------------------------------------*/ |
54 | ||
55 | /* | |
56 | * EHCI hc_driver implementation ... experimental, incomplete. | |
57 | * Based on the final 1.0 register interface specification. | |
58 | * | |
59 | * USB 2.0 shows up in upcoming www.pcmcia.org technology. | |
60 | * First was PCMCIA, like ISA; then CardBus, which is PCI. | |
61 | * Next comes "CardBay", using USB 2.0 signals. | |
62 | * | |
63 | * Contains additional contributions by Brad Hards, Rory Bolt, and others. | |
64 | * Special thanks to Intel and VIA for providing host controllers to | |
65 | * test this driver on, and Cypress (including In-System Design) for | |
66 | * providing early devices for those host controllers to talk to! | |
1da177e4 LT |
67 | */ |
68 | ||
1da177e4 LT |
69 | #define DRIVER_AUTHOR "David Brownell" |
70 | #define DRIVER_DESC "USB 2.0 'Enhanced' Host Controller (EHCI) Driver" | |
71 | ||
72 | static const char hcd_name [] = "ehci_hcd"; | |
73 | ||
74 | ||
9776afc8 | 75 | #undef VERBOSE_DEBUG |
1da177e4 LT |
76 | #undef EHCI_URB_TRACE |
77 | ||
78 | #ifdef DEBUG | |
79 | #define EHCI_STATS | |
80 | #endif | |
81 | ||
82 | /* magic numbers that can affect system performance */ | |
83 | #define EHCI_TUNE_CERR 3 /* 0-3 qtd retries; 0 == don't stop */ | |
84 | #define EHCI_TUNE_RL_HS 4 /* nak throttle; see 4.9 */ | |
85 | #define EHCI_TUNE_RL_TT 0 | |
86 | #define EHCI_TUNE_MULT_HS 1 /* 1-3 transactions/uframe; 4.10.3 */ | |
87 | #define EHCI_TUNE_MULT_TT 1 | |
ffda0803 AS |
88 | /* |
89 | * Some drivers think it's safe to schedule isochronous transfers more than | |
90 | * 256 ms into the future (partly as a result of an old bug in the scheduling | |
91 | * code). In an attempt to avoid trouble, we will use a minimum scheduling | |
92 | * length of 512 frames instead of 256. | |
93 | */ | |
94 | #define EHCI_TUNE_FLS 1 /* (medium) 512-frame schedule */ | |
1da177e4 | 95 | |
1da177e4 LT |
96 | /* Initial IRQ latency: faster than hw default */ |
97 | static int log2_irq_thresh = 0; // 0 to 6 | |
98 | module_param (log2_irq_thresh, int, S_IRUGO); | |
99 | MODULE_PARM_DESC (log2_irq_thresh, "log2 IRQ latency, 1-64 microframes"); | |
100 | ||
101 | /* initial park setting: slower than hw default */ | |
102 | static unsigned park = 0; | |
103 | module_param (park, uint, S_IRUGO); | |
104 | MODULE_PARM_DESC (park, "park setting; 1-3 back-to-back async packets"); | |
105 | ||
93f1a47c | 106 | /* for flakey hardware, ignore overcurrent indicators */ |
90ab5ee9 | 107 | static bool ignore_oc = 0; |
93f1a47c DB |
108 | module_param (ignore_oc, bool, S_IRUGO); |
109 | MODULE_PARM_DESC (ignore_oc, "ignore bogus hardware overcurrent indications"); | |
110 | ||
48f24970 AD |
111 | /* for link power management(LPM) feature */ |
112 | static unsigned int hird; | |
113 | module_param(hird, int, S_IRUGO); | |
cc556871 | 114 | MODULE_PARM_DESC(hird, "host initiated resume duration, +1 for each 75us"); |
48f24970 | 115 | |
1da177e4 LT |
116 | #define INTR_MASK (STS_IAA | STS_FATAL | STS_PCD | STS_ERR | STS_INT) |
117 | ||
118 | /*-------------------------------------------------------------------------*/ | |
119 | ||
120 | #include "ehci.h" | |
121 | #include "ehci-dbg.c" | |
ad93562b | 122 | #include "pci-quirks.h" |
1da177e4 LT |
123 | |
124 | /*-------------------------------------------------------------------------*/ | |
125 | ||
126 | /* | |
127 | * handshake - spin reading hc until handshake completes or fails | |
128 | * @ptr: address of hc register to be read | |
129 | * @mask: bits to look at in result of read | |
130 | * @done: value of those bits when handshake succeeds | |
131 | * @usec: timeout in microseconds | |
132 | * | |
133 | * Returns negative errno, or zero on success | |
134 | * | |
135 | * Success happens when the "mask" bits have the specified value (hardware | |
136 | * handshake done). There are two failure modes: "usec" have passed (major | |
137 | * hardware flakeout), or the register reads as all-ones (hardware removed). | |
138 | * | |
139 | * That last failure should_only happen in cases like physical cardbus eject | |
140 | * before driver shutdown. But it also seems to be caused by bugs in cardbus | |
141 | * bridge shutdown: shutting down the bridge before the devices using it. | |
142 | */ | |
083522d7 BH |
143 | static int handshake (struct ehci_hcd *ehci, void __iomem *ptr, |
144 | u32 mask, u32 done, int usec) | |
1da177e4 LT |
145 | { |
146 | u32 result; | |
147 | ||
148 | do { | |
083522d7 | 149 | result = ehci_readl(ehci, ptr); |
1da177e4 LT |
150 | if (result == ~(u32)0) /* card removed */ |
151 | return -ENODEV; | |
152 | result &= mask; | |
153 | if (result == done) | |
154 | return 0; | |
155 | udelay (1); | |
156 | usec--; | |
157 | } while (usec > 0); | |
158 | return -ETIMEDOUT; | |
159 | } | |
160 | ||
65fd4272 MC |
161 | /* check TDI/ARC silicon is in host mode */ |
162 | static int tdi_in_host_mode (struct ehci_hcd *ehci) | |
163 | { | |
65fd4272 MC |
164 | u32 tmp; |
165 | ||
a46af4eb | 166 | tmp = ehci_readl(ehci, &ehci->regs->usbmode); |
65fd4272 MC |
167 | return (tmp & 3) == USBMODE_CM_HC; |
168 | } | |
169 | ||
c4f34764 AS |
170 | /* |
171 | * Force HC to halt state from unknown (EHCI spec section 2.3). | |
172 | * Must be called with interrupts enabled and the lock not held. | |
173 | */ | |
1da177e4 LT |
174 | static int ehci_halt (struct ehci_hcd *ehci) |
175 | { | |
c4f34764 AS |
176 | u32 temp; |
177 | ||
178 | spin_lock_irq(&ehci->lock); | |
1da177e4 | 179 | |
72f30b6f | 180 | /* disable any irqs left enabled by previous code */ |
083522d7 | 181 | ehci_writel(ehci, 0, &ehci->regs->intr_enable); |
72f30b6f | 182 | |
c4f34764 AS |
183 | if (ehci_is_TDI(ehci) && !tdi_in_host_mode(ehci)) { |
184 | spin_unlock_irq(&ehci->lock); | |
65fd4272 MC |
185 | return 0; |
186 | } | |
187 | ||
3d9545cc AS |
188 | /* |
189 | * This routine gets called during probe before ehci->command | |
190 | * has been initialized, so we can't rely on its value. | |
191 | */ | |
192 | ehci->command &= ~CMD_RUN; | |
083522d7 | 193 | temp = ehci_readl(ehci, &ehci->regs->command); |
3d9545cc | 194 | temp &= ~(CMD_RUN | CMD_IAAD); |
083522d7 | 195 | ehci_writel(ehci, temp, &ehci->regs->command); |
df7c1ca2 | 196 | |
c4f34764 AS |
197 | spin_unlock_irq(&ehci->lock); |
198 | synchronize_irq(ehci_to_hcd(ehci)->irq); | |
0bcfeb3e | 199 | |
c4f34764 | 200 | return handshake(ehci, &ehci->regs->status, |
083522d7 | 201 | STS_HALT, STS_HALT, 16 * 125); |
0bcfeb3e DB |
202 | } |
203 | ||
1da177e4 LT |
204 | /* put TDI/ARC silicon into EHCI mode */ |
205 | static void tdi_reset (struct ehci_hcd *ehci) | |
206 | { | |
1da177e4 LT |
207 | u32 tmp; |
208 | ||
a46af4eb | 209 | tmp = ehci_readl(ehci, &ehci->regs->usbmode); |
d23a1377 VB |
210 | tmp |= USBMODE_CM_HC; |
211 | /* The default byte access to MMR space is LE after | |
212 | * controller reset. Set the required endian mode | |
213 | * for transfer buffers to match the host microprocessor | |
214 | */ | |
215 | if (ehci_big_endian_mmio(ehci)) | |
216 | tmp |= USBMODE_BE; | |
a46af4eb | 217 | ehci_writel(ehci, tmp, &ehci->regs->usbmode); |
1da177e4 LT |
218 | } |
219 | ||
c4f34764 AS |
220 | /* |
221 | * Reset a non-running (STS_HALT == 1) controller. | |
222 | * Must be called with interrupts enabled and the lock not held. | |
223 | */ | |
1da177e4 LT |
224 | static int ehci_reset (struct ehci_hcd *ehci) |
225 | { | |
226 | int retval; | |
083522d7 | 227 | u32 command = ehci_readl(ehci, &ehci->regs->command); |
1da177e4 | 228 | |
8d053c79 JW |
229 | /* If the EHCI debug controller is active, special care must be |
230 | * taken before and after a host controller reset */ | |
9fa5780b | 231 | if (ehci->debug && !dbgp_reset_prep(ehci_to_hcd(ehci))) |
8d053c79 JW |
232 | ehci->debug = NULL; |
233 | ||
1da177e4 LT |
234 | command |= CMD_RESET; |
235 | dbg_cmd (ehci, "reset", command); | |
083522d7 | 236 | ehci_writel(ehci, command, &ehci->regs->command); |
e8799906 | 237 | ehci->rh_state = EHCI_RH_HALTED; |
1da177e4 | 238 | ehci->next_statechange = jiffies; |
083522d7 BH |
239 | retval = handshake (ehci, &ehci->regs->command, |
240 | CMD_RESET, 0, 250 * 1000); | |
1da177e4 | 241 | |
331ac6b2 AD |
242 | if (ehci->has_hostpc) { |
243 | ehci_writel(ehci, USBMODE_EX_HC | USBMODE_EX_VBPS, | |
a46af4eb AS |
244 | &ehci->regs->usbmode_ex); |
245 | ehci_writel(ehci, TXFIFO_DEFAULT, &ehci->regs->txfill_tuning); | |
331ac6b2 | 246 | } |
1da177e4 LT |
247 | if (retval) |
248 | return retval; | |
249 | ||
250 | if (ehci_is_TDI(ehci)) | |
251 | tdi_reset (ehci); | |
252 | ||
8d053c79 | 253 | if (ehci->debug) |
9fa5780b | 254 | dbgp_external_startup(ehci_to_hcd(ehci)); |
8d053c79 | 255 | |
a448e4dc AS |
256 | ehci->port_c_suspend = ehci->suspended_ports = |
257 | ehci->resuming_ports = 0; | |
1da177e4 LT |
258 | return retval; |
259 | } | |
260 | ||
c4f34764 AS |
261 | /* |
262 | * Idle the controller (turn off the schedules). | |
263 | * Must be called with interrupts enabled and the lock not held. | |
264 | */ | |
1da177e4 LT |
265 | static void ehci_quiesce (struct ehci_hcd *ehci) |
266 | { | |
267 | u32 temp; | |
268 | ||
e8799906 | 269 | if (ehci->rh_state != EHCI_RH_RUNNING) |
c0c53dbc | 270 | return; |
1da177e4 LT |
271 | |
272 | /* wait for any schedule enables/disables to take effect */ | |
3d9545cc | 273 | temp = (ehci->command << 10) & (STS_ASS | STS_PSS); |
9671cd7a | 274 | handshake(ehci, &ehci->regs->status, STS_ASS | STS_PSS, temp, 16 * 125); |
1da177e4 LT |
275 | |
276 | /* then disable anything that's still active */ | |
c4f34764 | 277 | spin_lock_irq(&ehci->lock); |
3d9545cc AS |
278 | ehci->command &= ~(CMD_ASE | CMD_PSE); |
279 | ehci_writel(ehci, ehci->command, &ehci->regs->command); | |
c4f34764 | 280 | spin_unlock_irq(&ehci->lock); |
1da177e4 LT |
281 | |
282 | /* hardware can take 16 microframes to turn off ... */ | |
9671cd7a | 283 | handshake(ehci, &ehci->regs->status, STS_ASS | STS_PSS, 0, 16 * 125); |
1da177e4 LT |
284 | } |
285 | ||
286 | /*-------------------------------------------------------------------------*/ | |
287 | ||
07d29b63 | 288 | static void end_unlink_async(struct ehci_hcd *ehci); |
32830f20 | 289 | static void unlink_empty_async(struct ehci_hcd *ehci); |
7d12e780 | 290 | static void ehci_work(struct ehci_hcd *ehci); |
df202255 AS |
291 | static void start_unlink_intr(struct ehci_hcd *ehci, struct ehci_qh *qh); |
292 | static void end_unlink_intr(struct ehci_hcd *ehci, struct ehci_qh *qh); | |
1da177e4 | 293 | |
d58b4bcc | 294 | #include "ehci-timer.c" |
1da177e4 | 295 | #include "ehci-hub.c" |
48f24970 | 296 | #include "ehci-lpm.c" |
1da177e4 LT |
297 | #include "ehci-mem.c" |
298 | #include "ehci-q.c" | |
299 | #include "ehci-sched.c" | |
4c67045b | 300 | #include "ehci-sysfs.c" |
1da177e4 LT |
301 | |
302 | /*-------------------------------------------------------------------------*/ | |
303 | ||
8903795a AS |
304 | /* On some systems, leaving remote wakeup enabled prevents system shutdown. |
305 | * The firmware seems to think that powering off is a wakeup event! | |
306 | * This routine turns off remote wakeup and everything else, on all ports. | |
307 | */ | |
308 | static void ehci_turn_off_all_ports(struct ehci_hcd *ehci) | |
309 | { | |
310 | int port = HCS_N_PORTS(ehci->hcs_params); | |
311 | ||
312 | while (port--) | |
313 | ehci_writel(ehci, PORT_RWC_BITS, | |
314 | &ehci->regs->port_status[port]); | |
315 | } | |
316 | ||
21da84a8 SS |
317 | /* |
318 | * Halt HC, turn off all ports, and let the BIOS use the companion controllers. | |
c4f34764 | 319 | * Must be called with interrupts enabled and the lock not held. |
72f30b6f | 320 | */ |
21da84a8 | 321 | static void ehci_silence_controller(struct ehci_hcd *ehci) |
1da177e4 | 322 | { |
21da84a8 | 323 | ehci_halt(ehci); |
c4f34764 AS |
324 | |
325 | spin_lock_irq(&ehci->lock); | |
326 | ehci->rh_state = EHCI_RH_HALTED; | |
8903795a | 327 | ehci_turn_off_all_ports(ehci); |
1da177e4 LT |
328 | |
329 | /* make BIOS/etc use companion controller during reboot */ | |
083522d7 | 330 | ehci_writel(ehci, 0, &ehci->regs->configured_flag); |
8903795a AS |
331 | |
332 | /* unblock posted writes */ | |
333 | ehci_readl(ehci, &ehci->regs->configured_flag); | |
c4f34764 | 334 | spin_unlock_irq(&ehci->lock); |
1da177e4 LT |
335 | } |
336 | ||
21da84a8 SS |
337 | /* ehci_shutdown kick in for silicon on any bus (not just pci, etc). |
338 | * This forcibly disables dma and IRQs, helping kexec and other cases | |
339 | * where the next system software may expect clean state. | |
340 | */ | |
341 | static void ehci_shutdown(struct usb_hcd *hcd) | |
342 | { | |
343 | struct ehci_hcd *ehci = hcd_to_ehci(hcd); | |
344 | ||
21da84a8 | 345 | spin_lock_irq(&ehci->lock); |
43fe3a99 | 346 | ehci->shutdown = true; |
c0c53dbc | 347 | ehci->rh_state = EHCI_RH_STOPPING; |
d58b4bcc | 348 | ehci->enabled_hrtimer_events = 0; |
21da84a8 | 349 | spin_unlock_irq(&ehci->lock); |
d58b4bcc | 350 | |
c4f34764 AS |
351 | ehci_silence_controller(ehci); |
352 | ||
d58b4bcc | 353 | hrtimer_cancel(&ehci->hrtimer); |
21da84a8 SS |
354 | } |
355 | ||
56c1e26d DB |
356 | static void ehci_port_power (struct ehci_hcd *ehci, int is_on) |
357 | { | |
358 | unsigned port; | |
359 | ||
360 | if (!HCS_PPC (ehci->hcs_params)) | |
361 | return; | |
362 | ||
363 | ehci_dbg (ehci, "...power%s ports...\n", is_on ? "up" : "down"); | |
364 | for (port = HCS_N_PORTS (ehci->hcs_params); port > 0; ) | |
365 | (void) ehci_hub_control(ehci_to_hcd(ehci), | |
366 | is_on ? SetPortFeature : ClearPortFeature, | |
367 | USB_PORT_FEAT_POWER, | |
368 | port--, NULL, 0); | |
383975d7 AS |
369 | /* Flush those writes */ |
370 | ehci_readl(ehci, &ehci->regs->command); | |
56c1e26d DB |
371 | msleep(20); |
372 | } | |
373 | ||
7ff71d6a | 374 | /*-------------------------------------------------------------------------*/ |
1da177e4 | 375 | |
7ff71d6a MP |
376 | /* |
377 | * ehci_work is called from some interrupts, timers, and so on. | |
378 | * it calls driver completion functions, after dropping ehci->lock. | |
379 | */ | |
7d12e780 | 380 | static void ehci_work (struct ehci_hcd *ehci) |
7ff71d6a | 381 | { |
7ff71d6a MP |
382 | /* another CPU may drop ehci->lock during a schedule scan while |
383 | * it reports urb completions. this flag guards against bogus | |
384 | * attempts at re-entrant schedule scanning. | |
385 | */ | |
361aabf3 AS |
386 | if (ehci->scanning) { |
387 | ehci->need_rescan = true; | |
7ff71d6a | 388 | return; |
361aabf3 AS |
389 | } |
390 | ehci->scanning = true; | |
391 | ||
392 | rescan: | |
393 | ehci->need_rescan = false; | |
31446610 AS |
394 | if (ehci->async_count) |
395 | scan_async(ehci); | |
569b394f AS |
396 | if (ehci->intr_count > 0) |
397 | scan_intr(ehci); | |
398 | if (ehci->isoc_count > 0) | |
399 | scan_isoc(ehci); | |
361aabf3 AS |
400 | if (ehci->need_rescan) |
401 | goto rescan; | |
402 | ehci->scanning = false; | |
7ff71d6a MP |
403 | |
404 | /* the IO watchdog guards against hardware or driver bugs that | |
405 | * misplace IRQs, and should let us run completely without IRQs. | |
406 | * such lossage has been observed on both VT6202 and VT8235. | |
407 | */ | |
18aafe64 | 408 | turn_on_io_watchdog(ehci); |
7ff71d6a | 409 | } |
1da177e4 | 410 | |
21da84a8 SS |
411 | /* |
412 | * Called when the ehci_hcd module is removed. | |
413 | */ | |
7ff71d6a | 414 | static void ehci_stop (struct usb_hcd *hcd) |
1da177e4 LT |
415 | { |
416 | struct ehci_hcd *ehci = hcd_to_ehci (hcd); | |
1da177e4 | 417 | |
7ff71d6a | 418 | ehci_dbg (ehci, "stop\n"); |
1da177e4 | 419 | |
7ff71d6a | 420 | /* no more interrupts ... */ |
56c1e26d | 421 | |
7ff71d6a | 422 | spin_lock_irq(&ehci->lock); |
d58b4bcc | 423 | ehci->enabled_hrtimer_events = 0; |
c4f34764 | 424 | spin_unlock_irq(&ehci->lock); |
1da177e4 | 425 | |
c4f34764 | 426 | ehci_quiesce(ehci); |
21da84a8 | 427 | ehci_silence_controller(ehci); |
7ff71d6a | 428 | ehci_reset (ehci); |
1da177e4 | 429 | |
d58b4bcc | 430 | hrtimer_cancel(&ehci->hrtimer); |
4c67045b | 431 | remove_sysfs_files(ehci); |
7ff71d6a | 432 | remove_debug_files (ehci); |
1da177e4 | 433 | |
7ff71d6a MP |
434 | /* root hub is shut down separately (first, when possible) */ |
435 | spin_lock_irq (&ehci->lock); | |
55934eb3 | 436 | end_free_itds(ehci); |
7ff71d6a MP |
437 | spin_unlock_irq (&ehci->lock); |
438 | ehci_mem_cleanup (ehci); | |
1da177e4 | 439 | |
ad93562b AX |
440 | if (ehci->amd_pll_fix == 1) |
441 | usb_amd_dev_put(); | |
05570297 | 442 | |
7ff71d6a | 443 | #ifdef EHCI_STATS |
99ac5b1e AS |
444 | ehci_dbg(ehci, "irq normal %ld err %ld iaa %ld (lost %ld)\n", |
445 | ehci->stats.normal, ehci->stats.error, ehci->stats.iaa, | |
7ff71d6a MP |
446 | ehci->stats.lost_iaa); |
447 | ehci_dbg (ehci, "complete %ld unlink %ld\n", | |
448 | ehci->stats.complete, ehci->stats.unlink); | |
1da177e4 | 449 | #endif |
1da177e4 | 450 | |
083522d7 BH |
451 | dbg_status (ehci, "ehci_stop completed", |
452 | ehci_readl(ehci, &ehci->regs->status)); | |
1da177e4 LT |
453 | } |
454 | ||
18807521 DB |
455 | /* one-time init, only for memory state */ |
456 | static int ehci_init(struct usb_hcd *hcd) | |
1da177e4 | 457 | { |
18807521 | 458 | struct ehci_hcd *ehci = hcd_to_ehci(hcd); |
1da177e4 | 459 | u32 temp; |
1da177e4 LT |
460 | int retval; |
461 | u32 hcc_params; | |
3807e26d | 462 | struct ehci_qh_hw *hw; |
18807521 DB |
463 | |
464 | spin_lock_init(&ehci->lock); | |
465 | ||
403dbd36 AD |
466 | /* |
467 | * keep io watchdog by default, those good HCDs could turn off it later | |
468 | */ | |
469 | ehci->need_io_watchdog = 1; | |
1da177e4 | 470 | |
d58b4bcc AS |
471 | hrtimer_init(&ehci->hrtimer, CLOCK_MONOTONIC, HRTIMER_MODE_ABS); |
472 | ehci->hrtimer.function = ehci_hrtimer_func; | |
473 | ehci->next_hrtimer_event = EHCI_HRTIMER_NO_EVENT; | |
07d29b63 | 474 | |
f75593ce AS |
475 | hcc_params = ehci_readl(ehci, &ehci->caps->hcc_params); |
476 | ||
cc62a7eb KS |
477 | /* |
478 | * by default set standard 80% (== 100 usec/uframe) max periodic | |
479 | * bandwidth as required by USB 2.0 | |
480 | */ | |
481 | ehci->uframe_periodic_max = 100; | |
482 | ||
1da177e4 LT |
483 | /* |
484 | * hw default: 1K periodic list heads, one per frame. | |
485 | * periodic_size can shrink by USBCMD update if hcc_params allows. | |
486 | */ | |
487 | ehci->periodic_size = DEFAULT_I_TDPS; | |
569b394f | 488 | INIT_LIST_HEAD(&ehci->intr_qh_list); |
9aa09d2f | 489 | INIT_LIST_HEAD(&ehci->cached_itd_list); |
0e5f231b | 490 | INIT_LIST_HEAD(&ehci->cached_sitd_list); |
f75593ce | 491 | |
8e192910 | 492 | if (HCC_PGM_FRAMELISTLEN(hcc_params)) { |
f75593ce AS |
493 | /* periodic schedule size can be smaller than default */ |
494 | switch (EHCI_TUNE_FLS) { | |
495 | case 0: ehci->periodic_size = 1024; break; | |
496 | case 1: ehci->periodic_size = 512; break; | |
497 | case 2: ehci->periodic_size = 256; break; | |
498 | default: BUG(); | |
499 | } | |
500 | } | |
18807521 | 501 | if ((retval = ehci_mem_init(ehci, GFP_KERNEL)) < 0) |
1da177e4 LT |
502 | return retval; |
503 | ||
504 | /* controllers may cache some of the periodic schedule ... */ | |
53bd6a60 | 505 | if (HCC_ISOC_CACHE(hcc_params)) // full frame cache |
98cae42d | 506 | ehci->i_thresh = 0; |
1da177e4 | 507 | else // N microframes cached |
18807521 | 508 | ehci->i_thresh = 2 + HCC_ISOC_THRES(hcc_params); |
1da177e4 | 509 | |
1da177e4 LT |
510 | /* |
511 | * dedicate a qh for the async ring head, since we couldn't unlink | |
512 | * a 'real' qh without stopping the async schedule [4.8]. use it | |
513 | * as the 'reclamation list head' too. | |
514 | * its dummy is used in hw_alt_next of many tds, to prevent the qh | |
515 | * from automatically advancing to the next td after short reads. | |
516 | */ | |
18807521 | 517 | ehci->async->qh_next.qh = NULL; |
3807e26d AD |
518 | hw = ehci->async->hw; |
519 | hw->hw_next = QH_NEXT(ehci, ehci->async->qh_dma); | |
520 | hw->hw_info1 = cpu_to_hc32(ehci, QH_HEAD); | |
4f7a67e2 | 521 | #if defined(CONFIG_PPC_PS3) |
4c53de72 | 522 | hw->hw_info1 |= cpu_to_hc32(ehci, QH_INACTIVATE); |
4f7a67e2 | 523 | #endif |
3807e26d AD |
524 | hw->hw_token = cpu_to_hc32(ehci, QTD_STS_HALT); |
525 | hw->hw_qtd_next = EHCI_LIST_END(ehci); | |
18807521 | 526 | ehci->async->qh_state = QH_STATE_LINKED; |
3807e26d | 527 | hw->hw_alt_next = QTD_NEXT(ehci, ehci->async->dummy->qtd_dma); |
1da177e4 LT |
528 | |
529 | /* clear interrupt enables, set irq latency */ | |
530 | if (log2_irq_thresh < 0 || log2_irq_thresh > 6) | |
531 | log2_irq_thresh = 0; | |
532 | temp = 1 << (16 + log2_irq_thresh); | |
5a9cdf33 AD |
533 | if (HCC_PER_PORT_CHANGE_EVENT(hcc_params)) { |
534 | ehci->has_ppcd = 1; | |
535 | ehci_dbg(ehci, "enable per-port change event\n"); | |
536 | temp |= CMD_PPCEE; | |
537 | } | |
1da177e4 LT |
538 | if (HCC_CANPARK(hcc_params)) { |
539 | /* HW default park == 3, on hardware that supports it (like | |
540 | * NVidia and ALI silicon), maximizes throughput on the async | |
541 | * schedule by avoiding QH fetches between transfers. | |
542 | * | |
543 | * With fast usb storage devices and NForce2, "park" seems to | |
544 | * make problems: throughput reduction (!), data errors... | |
545 | */ | |
546 | if (park) { | |
18807521 | 547 | park = min(park, (unsigned) 3); |
1da177e4 LT |
548 | temp |= CMD_PARK; |
549 | temp |= park << 8; | |
550 | } | |
18807521 | 551 | ehci_dbg(ehci, "park %d\n", park); |
1da177e4 | 552 | } |
18807521 | 553 | if (HCC_PGM_FRAMELISTLEN(hcc_params)) { |
1da177e4 LT |
554 | /* periodic schedule size can be smaller than default */ |
555 | temp &= ~(3 << 2); | |
556 | temp |= (EHCI_TUNE_FLS << 2); | |
1da177e4 | 557 | } |
48f24970 AD |
558 | if (HCC_LPM(hcc_params)) { |
559 | /* support link power management EHCI 1.1 addendum */ | |
560 | ehci_dbg(ehci, "support lpm\n"); | |
561 | ehci->has_lpm = 1; | |
562 | if (hird > 0xf) { | |
563 | ehci_dbg(ehci, "hird %d invalid, use default 0", | |
564 | hird); | |
565 | hird = 0; | |
566 | } | |
567 | temp |= hird << 24; | |
568 | } | |
18807521 DB |
569 | ehci->command = temp; |
570 | ||
40f8db8f | 571 | /* Accept arbitrarily long scatter-gather lists */ |
4307a28e AR |
572 | if (!(hcd->driver->flags & HCD_LOCAL_MEM)) |
573 | hcd->self.sg_tablesize = ~0; | |
18807521 DB |
574 | return 0; |
575 | } | |
576 | ||
577 | /* start HC running; it's halted, ehci_init() has been run (once) */ | |
578 | static int ehci_run (struct usb_hcd *hcd) | |
579 | { | |
580 | struct ehci_hcd *ehci = hcd_to_ehci (hcd); | |
18807521 DB |
581 | u32 temp; |
582 | u32 hcc_params; | |
583 | ||
1d619f12 | 584 | hcd->uses_new_polling = 1; |
1d619f12 | 585 | |
18807521 | 586 | /* EHCI spec section 4.1 */ |
876e0df9 | 587 | |
083522d7 BH |
588 | ehci_writel(ehci, ehci->periodic_dma, &ehci->regs->frame_list); |
589 | ehci_writel(ehci, (u32)ehci->async->qh_dma, &ehci->regs->async_next); | |
18807521 DB |
590 | |
591 | /* | |
592 | * hcc_params controls whether ehci->regs->segment must (!!!) | |
593 | * be used; it constrains QH/ITD/SITD and QTD locations. | |
594 | * pci_pool consistent memory always uses segment zero. | |
595 | * streaming mappings for I/O buffers, like pci_map_single(), | |
596 | * can return segments above 4GB, if the device allows. | |
597 | * | |
598 | * NOTE: the dma mask is visible through dma_supported(), so | |
599 | * drivers can pass this info along ... like NETIF_F_HIGHDMA, | |
600 | * Scsi_Host.highmem_io, and so forth. It's readonly to all | |
601 | * host side drivers though. | |
602 | */ | |
083522d7 | 603 | hcc_params = ehci_readl(ehci, &ehci->caps->hcc_params); |
18807521 | 604 | if (HCC_64BIT_ADDR(hcc_params)) { |
083522d7 | 605 | ehci_writel(ehci, 0, &ehci->regs->segment); |
18807521 DB |
606 | #if 0 |
607 | // this is deeply broken on almost all architectures | |
6a35528a | 608 | if (!dma_set_mask(hcd->self.controller, DMA_BIT_MASK(64))) |
18807521 DB |
609 | ehci_info(ehci, "enabled 64bit DMA\n"); |
610 | #endif | |
611 | } | |
612 | ||
613 | ||
1da177e4 LT |
614 | // Philips, Intel, and maybe others need CMD_RUN before the |
615 | // root hub will detect new devices (why?); NEC doesn't | |
18807521 DB |
616 | ehci->command &= ~(CMD_LRESET|CMD_IAAD|CMD_PSE|CMD_ASE|CMD_RESET); |
617 | ehci->command |= CMD_RUN; | |
083522d7 | 618 | ehci_writel(ehci, ehci->command, &ehci->regs->command); |
18807521 | 619 | dbg_cmd (ehci, "init", ehci->command); |
1da177e4 | 620 | |
1da177e4 LT |
621 | /* |
622 | * Start, enabling full USB 2.0 functionality ... usb 1.1 devices | |
623 | * are explicitly handed to companion controller(s), so no TT is | |
624 | * involved with the root hub. (Except where one is integrated, | |
625 | * and there's no companion controller unless maybe for USB OTG.) | |
32fe0198 AS |
626 | * |
627 | * Turning on the CF flag will transfer ownership of all ports | |
628 | * from the companions to the EHCI controller. If any of the | |
629 | * companions are in the middle of a port reset at the time, it | |
630 | * could cause trouble. Write-locking ehci_cf_port_reset_rwsem | |
1cb52658 DB |
631 | * guarantees that no resets are in progress. After we set CF, |
632 | * a short delay lets the hardware catch up; new resets shouldn't | |
633 | * be started before the port switching actions could complete. | |
1da177e4 | 634 | */ |
32fe0198 | 635 | down_write(&ehci_cf_port_reset_rwsem); |
e8799906 | 636 | ehci->rh_state = EHCI_RH_RUNNING; |
083522d7 BH |
637 | ehci_writel(ehci, FLAG_CF, &ehci->regs->configured_flag); |
638 | ehci_readl(ehci, &ehci->regs->command); /* unblock posted writes */ | |
1cb52658 | 639 | msleep(5); |
32fe0198 | 640 | up_write(&ehci_cf_port_reset_rwsem); |
ee4ecb8a | 641 | ehci->last_periodic_enable = ktime_get_real(); |
1da177e4 | 642 | |
c430131a | 643 | temp = HC_VERSION(ehci, ehci_readl(ehci, &ehci->caps->hc_capbase)); |
1da177e4 | 644 | ehci_info (ehci, |
2b70f073 | 645 | "USB %x.%x started, EHCI %x.%02x%s\n", |
7ff71d6a | 646 | ((ehci->sbrn & 0xf0)>>4), (ehci->sbrn & 0x0f), |
2b70f073 | 647 | temp >> 8, temp & 0xff, |
93f1a47c | 648 | ignore_oc ? ", overcurrent ignored" : ""); |
1da177e4 | 649 | |
083522d7 BH |
650 | ehci_writel(ehci, INTR_MASK, |
651 | &ehci->regs->intr_enable); /* Turn On Interrupts */ | |
1da177e4 | 652 | |
18807521 DB |
653 | /* GRR this is run-once init(), being done every time the HC starts. |
654 | * So long as they're part of class devices, we can't do it init() | |
655 | * since the class device isn't created that early. | |
656 | */ | |
657 | create_debug_files(ehci); | |
4c67045b | 658 | create_sysfs_files(ehci); |
1da177e4 LT |
659 | |
660 | return 0; | |
661 | } | |
662 | ||
1a49e2ac | 663 | static int ehci_setup(struct usb_hcd *hcd) |
2093c6b4 MC |
664 | { |
665 | struct ehci_hcd *ehci = hcd_to_ehci(hcd); | |
666 | int retval; | |
667 | ||
668 | ehci->regs = (void __iomem *)ehci->caps + | |
669 | HC_LENGTH(ehci, ehci_readl(ehci, &ehci->caps->hc_capbase)); | |
670 | dbg_hcs_params(ehci, "reset"); | |
671 | dbg_hcc_params(ehci, "reset"); | |
672 | ||
673 | /* cache this readonly data; minimize chip reads */ | |
674 | ehci->hcs_params = ehci_readl(ehci, &ehci->caps->hcs_params); | |
675 | ||
676 | ehci->sbrn = HCD_USB2; | |
677 | ||
631fe9d9 AS |
678 | /* data structure init */ |
679 | retval = ehci_init(hcd); | |
2093c6b4 MC |
680 | if (retval) |
681 | return retval; | |
682 | ||
631fe9d9 | 683 | retval = ehci_halt(ehci); |
2093c6b4 MC |
684 | if (retval) |
685 | return retval; | |
686 | ||
1a49e2ac AS |
687 | if (ehci_is_TDI(ehci)) |
688 | tdi_reset(ehci); | |
689 | ||
2093c6b4 MC |
690 | ehci_reset(ehci); |
691 | ||
692 | return 0; | |
693 | } | |
694 | ||
1da177e4 LT |
695 | /*-------------------------------------------------------------------------*/ |
696 | ||
7d12e780 | 697 | static irqreturn_t ehci_irq (struct usb_hcd *hcd) |
1da177e4 LT |
698 | { |
699 | struct ehci_hcd *ehci = hcd_to_ehci (hcd); | |
67b2e029 | 700 | u32 status, masked_status, pcd_status = 0, cmd; |
1da177e4 LT |
701 | int bh; |
702 | ||
703 | spin_lock (&ehci->lock); | |
704 | ||
083522d7 | 705 | status = ehci_readl(ehci, &ehci->regs->status); |
1da177e4 LT |
706 | |
707 | /* e.g. cardbus physical eject */ | |
708 | if (status == ~(u32) 0) { | |
709 | ehci_dbg (ehci, "device removed\n"); | |
710 | goto dead; | |
711 | } | |
712 | ||
2fbe2bf1 AS |
713 | /* |
714 | * We don't use STS_FLR, but some controllers don't like it to | |
715 | * remain on, so mask it out along with the other status bits. | |
716 | */ | |
717 | masked_status = status & (INTR_MASK | STS_FLR); | |
718 | ||
69fff59d | 719 | /* Shared IRQ? */ |
e8799906 | 720 | if (!masked_status || unlikely(ehci->rh_state == EHCI_RH_HALTED)) { |
1da177e4 LT |
721 | spin_unlock(&ehci->lock); |
722 | return IRQ_NONE; | |
723 | } | |
724 | ||
725 | /* clear (just) interrupts */ | |
67b2e029 | 726 | ehci_writel(ehci, masked_status, &ehci->regs->status); |
e82cc128 | 727 | cmd = ehci_readl(ehci, &ehci->regs->command); |
1da177e4 LT |
728 | bh = 0; |
729 | ||
9776afc8 | 730 | #ifdef VERBOSE_DEBUG |
1da177e4 LT |
731 | /* unrequested/ignored: Frame List Rollover */ |
732 | dbg_status (ehci, "irq", status); | |
733 | #endif | |
734 | ||
735 | /* INT, ERR, and IAA interrupt rates can be throttled */ | |
736 | ||
737 | /* normal [4.15.1.2] or error [4.15.1.1] completion */ | |
738 | if (likely ((status & (STS_INT|STS_ERR)) != 0)) { | |
739 | if (likely ((status & STS_ERR) == 0)) | |
740 | COUNT (ehci->stats.normal); | |
741 | else | |
742 | COUNT (ehci->stats.error); | |
743 | bh = 1; | |
744 | } | |
745 | ||
746 | /* complete the unlinking of some qh [4.15.2.3] */ | |
747 | if (status & STS_IAA) { | |
9d938747 AS |
748 | |
749 | /* Turn off the IAA watchdog */ | |
750 | ehci->enabled_hrtimer_events &= ~BIT(EHCI_HRTIMER_IAA_WATCHDOG); | |
751 | ||
752 | /* | |
753 | * Mild optimization: Allow another IAAD to reset the | |
754 | * hrtimer, if one occurs before the next expiration. | |
755 | * In theory we could always cancel the hrtimer, but | |
756 | * tests show that about half the time it will be reset | |
757 | * for some other event anyway. | |
758 | */ | |
759 | if (ehci->next_hrtimer_event == EHCI_HRTIMER_IAA_WATCHDOG) | |
760 | ++ehci->next_hrtimer_event; | |
761 | ||
e82cc128 | 762 | /* guard against (alleged) silicon errata */ |
6feff1b9 | 763 | if (cmd & CMD_IAAD) |
e82cc128 | 764 | ehci_dbg(ehci, "IAA with IAAD still set?\n"); |
3c273a05 | 765 | if (ehci->async_iaa) { |
99ac5b1e | 766 | COUNT(ehci->stats.iaa); |
e82cc128 DB |
767 | end_unlink_async(ehci); |
768 | } else | |
99ac5b1e | 769 | ehci_dbg(ehci, "IAA with nothing unlinked?\n"); |
1da177e4 LT |
770 | } |
771 | ||
772 | /* remote wakeup [4.3.1] */ | |
d97cc2f2 | 773 | if (status & STS_PCD) { |
1da177e4 | 774 | unsigned i = HCS_N_PORTS (ehci->hcs_params); |
5a9cdf33 | 775 | u32 ppcd = 0; |
d1b1842c DB |
776 | |
777 | /* kick root hub later */ | |
1d619f12 | 778 | pcd_status = status; |
1da177e4 LT |
779 | |
780 | /* resume root hub? */ | |
dc75ce9d | 781 | if (ehci->rh_state == EHCI_RH_SUSPENDED) |
8c03356a | 782 | usb_hcd_resume_root_hub(hcd); |
1da177e4 | 783 | |
5a9cdf33 AD |
784 | /* get per-port change detect bits */ |
785 | if (ehci->has_ppcd) | |
786 | ppcd = status >> 16; | |
787 | ||
1da177e4 | 788 | while (i--) { |
5a9cdf33 AD |
789 | int pstatus; |
790 | ||
791 | /* leverage per-port change bits feature */ | |
792 | if (ehci->has_ppcd && !(ppcd & (1 << i))) | |
793 | continue; | |
794 | pstatus = ehci_readl(ehci, | |
795 | &ehci->regs->port_status[i]); | |
b972b68c DB |
796 | |
797 | if (pstatus & PORT_OWNER) | |
1da177e4 | 798 | continue; |
eafe5b99 AS |
799 | if (!(test_bit(i, &ehci->suspended_ports) && |
800 | ((pstatus & PORT_RESUME) || | |
801 | !(pstatus & PORT_SUSPEND)) && | |
802 | (pstatus & PORT_PE) && | |
803 | ehci->reset_done[i] == 0)) | |
1da177e4 LT |
804 | continue; |
805 | ||
806 | /* start 20 msec resume signaling from this port, | |
807 | * and make khubd collect PORT_STAT_C_SUSPEND to | |
49d0f078 AS |
808 | * stop that signaling. Use 5 ms extra for safety, |
809 | * like usb_port_resume() does. | |
1da177e4 | 810 | */ |
49d0f078 | 811 | ehci->reset_done[i] = jiffies + msecs_to_jiffies(25); |
a448e4dc | 812 | set_bit(i, &ehci->resuming_ports); |
1da177e4 | 813 | ehci_dbg (ehci, "port %d remote wakeup\n", i + 1); |
61e8b858 | 814 | mod_timer(&hcd->rh_timer, ehci->reset_done[i]); |
1da177e4 LT |
815 | } |
816 | } | |
817 | ||
818 | /* PCI errors [4.15.2.4] */ | |
819 | if (unlikely ((status & STS_FATAL) != 0)) { | |
67b2e029 | 820 | ehci_err(ehci, "fatal error\n"); |
eafe5b99 AS |
821 | dbg_cmd(ehci, "fatal", cmd); |
822 | dbg_status(ehci, "fatal", status); | |
1da177e4 | 823 | dead: |
69fff59d | 824 | usb_hc_died(hcd); |
bf6387bc AS |
825 | |
826 | /* Don't let the controller do anything more */ | |
43fe3a99 | 827 | ehci->shutdown = true; |
bf6387bc AS |
828 | ehci->rh_state = EHCI_RH_STOPPING; |
829 | ehci->command &= ~(CMD_RUN | CMD_ASE | CMD_PSE); | |
830 | ehci_writel(ehci, ehci->command, &ehci->regs->command); | |
831 | ehci_writel(ehci, 0, &ehci->regs->intr_enable); | |
832 | ehci_handle_controller_death(ehci); | |
833 | ||
834 | /* Handle completions when the controller stops */ | |
835 | bh = 0; | |
1da177e4 LT |
836 | } |
837 | ||
838 | if (bh) | |
7d12e780 | 839 | ehci_work (ehci); |
1da177e4 | 840 | spin_unlock (&ehci->lock); |
d1b1842c | 841 | if (pcd_status) |
1d619f12 | 842 | usb_hcd_poll_rh_status(hcd); |
1da177e4 LT |
843 | return IRQ_HANDLED; |
844 | } | |
845 | ||
846 | /*-------------------------------------------------------------------------*/ | |
847 | ||
848 | /* | |
849 | * non-error returns are a promise to giveback() the urb later | |
850 | * we drop ownership so next owner (or urb unlink) can get it | |
851 | * | |
852 | * urb + dev is in hcd.self.controller.urb_list | |
853 | * we're queueing TDs onto software and hardware lists | |
854 | * | |
855 | * hcd-specific init for hcpriv hasn't been done yet | |
856 | * | |
857 | * NOTE: control, bulk, and interrupt share the same code to append TDs | |
858 | * to a (possibly active) QH, and the same QH scanning code. | |
859 | */ | |
860 | static int ehci_urb_enqueue ( | |
861 | struct usb_hcd *hcd, | |
1da177e4 | 862 | struct urb *urb, |
55016f10 | 863 | gfp_t mem_flags |
1da177e4 LT |
864 | ) { |
865 | struct ehci_hcd *ehci = hcd_to_ehci (hcd); | |
866 | struct list_head qtd_list; | |
867 | ||
868 | INIT_LIST_HEAD (&qtd_list); | |
869 | ||
870 | switch (usb_pipetype (urb->pipe)) { | |
25b70a86 DB |
871 | case PIPE_CONTROL: |
872 | /* qh_completions() code doesn't handle all the fault cases | |
873 | * in multi-TD control transfers. Even 1KB is rare anyway. | |
874 | */ | |
875 | if (urb->transfer_buffer_length > (16 * 1024)) | |
876 | return -EMSGSIZE; | |
877 | /* FALLTHROUGH */ | |
878 | /* case PIPE_BULK: */ | |
1da177e4 LT |
879 | default: |
880 | if (!qh_urb_transaction (ehci, urb, &qtd_list, mem_flags)) | |
881 | return -ENOMEM; | |
e9df41c5 | 882 | return submit_async(ehci, urb, &qtd_list, mem_flags); |
1da177e4 LT |
883 | |
884 | case PIPE_INTERRUPT: | |
885 | if (!qh_urb_transaction (ehci, urb, &qtd_list, mem_flags)) | |
886 | return -ENOMEM; | |
e9df41c5 | 887 | return intr_submit(ehci, urb, &qtd_list, mem_flags); |
1da177e4 LT |
888 | |
889 | case PIPE_ISOCHRONOUS: | |
890 | if (urb->dev->speed == USB_SPEED_HIGH) | |
891 | return itd_submit (ehci, urb, mem_flags); | |
892 | else | |
893 | return sitd_submit (ehci, urb, mem_flags); | |
894 | } | |
895 | } | |
896 | ||
1da177e4 LT |
897 | /* remove from hardware lists |
898 | * completions normally happen asynchronously | |
899 | */ | |
900 | ||
e9df41c5 | 901 | static int ehci_urb_dequeue(struct usb_hcd *hcd, struct urb *urb, int status) |
1da177e4 LT |
902 | { |
903 | struct ehci_hcd *ehci = hcd_to_ehci (hcd); | |
904 | struct ehci_qh *qh; | |
905 | unsigned long flags; | |
e9df41c5 | 906 | int rc; |
1da177e4 LT |
907 | |
908 | spin_lock_irqsave (&ehci->lock, flags); | |
e9df41c5 AS |
909 | rc = usb_hcd_check_unlink_urb(hcd, urb, status); |
910 | if (rc) | |
911 | goto done; | |
912 | ||
1da177e4 LT |
913 | switch (usb_pipetype (urb->pipe)) { |
914 | // case PIPE_CONTROL: | |
915 | // case PIPE_BULK: | |
916 | default: | |
917 | qh = (struct ehci_qh *) urb->hcpriv; | |
918 | if (!qh) | |
919 | break; | |
07d29b63 AS |
920 | switch (qh->qh_state) { |
921 | case QH_STATE_LINKED: | |
922 | case QH_STATE_COMPLETING: | |
3c273a05 | 923 | start_unlink_async(ehci, qh); |
07d29b63 AS |
924 | break; |
925 | case QH_STATE_UNLINK: | |
926 | case QH_STATE_UNLINK_WAIT: | |
927 | /* already started */ | |
928 | break; | |
929 | case QH_STATE_IDLE: | |
7a0f0d95 AS |
930 | /* QH might be waiting for a Clear-TT-Buffer */ |
931 | qh_completions(ehci, qh); | |
07d29b63 AS |
932 | break; |
933 | } | |
1da177e4 LT |
934 | break; |
935 | ||
936 | case PIPE_INTERRUPT: | |
937 | qh = (struct ehci_qh *) urb->hcpriv; | |
938 | if (!qh) | |
939 | break; | |
940 | switch (qh->qh_state) { | |
941 | case QH_STATE_LINKED: | |
a448c9d8 | 942 | case QH_STATE_COMPLETING: |
df202255 | 943 | start_unlink_intr(ehci, qh); |
a448c9d8 | 944 | break; |
1da177e4 | 945 | case QH_STATE_IDLE: |
7d12e780 | 946 | qh_completions (ehci, qh); |
1da177e4 LT |
947 | break; |
948 | default: | |
949 | ehci_dbg (ehci, "bogus qh %p state %d\n", | |
950 | qh, qh->qh_state); | |
951 | goto done; | |
952 | } | |
1da177e4 LT |
953 | break; |
954 | ||
955 | case PIPE_ISOCHRONOUS: | |
956 | // itd or sitd ... | |
957 | ||
958 | // wait till next completion, do it then. | |
959 | // completion irqs can wait up to 1024 msec, | |
960 | break; | |
961 | } | |
962 | done: | |
963 | spin_unlock_irqrestore (&ehci->lock, flags); | |
e9df41c5 | 964 | return rc; |
1da177e4 LT |
965 | } |
966 | ||
967 | /*-------------------------------------------------------------------------*/ | |
968 | ||
969 | // bulk qh holds the data toggle | |
970 | ||
971 | static void | |
972 | ehci_endpoint_disable (struct usb_hcd *hcd, struct usb_host_endpoint *ep) | |
973 | { | |
974 | struct ehci_hcd *ehci = hcd_to_ehci (hcd); | |
975 | unsigned long flags; | |
976 | struct ehci_qh *qh, *tmp; | |
977 | ||
978 | /* ASSERT: any requests/urbs are being unlinked */ | |
979 | /* ASSERT: nobody can be submitting urbs for this any more */ | |
980 | ||
981 | rescan: | |
982 | spin_lock_irqsave (&ehci->lock, flags); | |
983 | qh = ep->hcpriv; | |
984 | if (!qh) | |
985 | goto done; | |
986 | ||
987 | /* endpoints can be iso streams. for now, we don't | |
988 | * accelerate iso completions ... so spin a while. | |
989 | */ | |
1082f57a | 990 | if (qh->hw == NULL) { |
8c5bf7be AS |
991 | struct ehci_iso_stream *stream = ep->hcpriv; |
992 | ||
993 | if (!list_empty(&stream->td_list)) | |
994 | goto idle_timeout; | |
995 | ||
996 | /* BUG_ON(!list_empty(&stream->free_list)); */ | |
997 | kfree(stream); | |
998 | goto done; | |
1da177e4 LT |
999 | } |
1000 | ||
c0c53dbc | 1001 | if (ehci->rh_state < EHCI_RH_RUNNING) |
1da177e4 LT |
1002 | qh->qh_state = QH_STATE_IDLE; |
1003 | switch (qh->qh_state) { | |
1004 | case QH_STATE_LINKED: | |
3a44494e | 1005 | case QH_STATE_COMPLETING: |
1da177e4 LT |
1006 | for (tmp = ehci->async->qh_next.qh; |
1007 | tmp && tmp != qh; | |
1008 | tmp = tmp->qh_next.qh) | |
1009 | continue; | |
02e2c51b AS |
1010 | /* periodic qh self-unlinks on empty, and a COMPLETING qh |
1011 | * may already be unlinked. | |
1012 | */ | |
1013 | if (tmp) | |
3c273a05 | 1014 | start_unlink_async(ehci, qh); |
1da177e4 LT |
1015 | /* FALL THROUGH */ |
1016 | case QH_STATE_UNLINK: /* wait for hw to finish? */ | |
07d29b63 | 1017 | case QH_STATE_UNLINK_WAIT: |
1da177e4 LT |
1018 | idle_timeout: |
1019 | spin_unlock_irqrestore (&ehci->lock, flags); | |
22c43863 | 1020 | schedule_timeout_uninterruptible(1); |
1da177e4 LT |
1021 | goto rescan; |
1022 | case QH_STATE_IDLE: /* fully unlinked */ | |
914b7012 AS |
1023 | if (qh->clearing_tt) |
1024 | goto idle_timeout; | |
1da177e4 | 1025 | if (list_empty (&qh->qtd_list)) { |
c83e1a9f | 1026 | qh_destroy(ehci, qh); |
1da177e4 LT |
1027 | break; |
1028 | } | |
1029 | /* else FALL THROUGH */ | |
1030 | default: | |
1da177e4 LT |
1031 | /* caller was supposed to have unlinked any requests; |
1032 | * that's not our job. just leak this memory. | |
1033 | */ | |
1034 | ehci_err (ehci, "qh %p (#%02x) state %d%s\n", | |
1035 | qh, ep->desc.bEndpointAddress, qh->qh_state, | |
1036 | list_empty (&qh->qtd_list) ? "" : "(has tds)"); | |
1037 | break; | |
1038 | } | |
8c5bf7be | 1039 | done: |
1da177e4 | 1040 | ep->hcpriv = NULL; |
1da177e4 | 1041 | spin_unlock_irqrestore (&ehci->lock, flags); |
1da177e4 LT |
1042 | } |
1043 | ||
b18ffd49 AS |
1044 | static void |
1045 | ehci_endpoint_reset(struct usb_hcd *hcd, struct usb_host_endpoint *ep) | |
1046 | { | |
1047 | struct ehci_hcd *ehci = hcd_to_ehci(hcd); | |
1048 | struct ehci_qh *qh; | |
1049 | int eptype = usb_endpoint_type(&ep->desc); | |
a455212d AS |
1050 | int epnum = usb_endpoint_num(&ep->desc); |
1051 | int is_out = usb_endpoint_dir_out(&ep->desc); | |
1052 | unsigned long flags; | |
b18ffd49 AS |
1053 | |
1054 | if (eptype != USB_ENDPOINT_XFER_BULK && eptype != USB_ENDPOINT_XFER_INT) | |
1055 | return; | |
1056 | ||
a455212d | 1057 | spin_lock_irqsave(&ehci->lock, flags); |
b18ffd49 AS |
1058 | qh = ep->hcpriv; |
1059 | ||
1060 | /* For Bulk and Interrupt endpoints we maintain the toggle state | |
1061 | * in the hardware; the toggle bits in udev aren't used at all. | |
1062 | * When an endpoint is reset by usb_clear_halt() we must reset | |
1063 | * the toggle bit in the QH. | |
1064 | */ | |
1065 | if (qh) { | |
a455212d | 1066 | usb_settoggle(qh->dev, epnum, is_out, 0); |
b18ffd49 AS |
1067 | if (!list_empty(&qh->qtd_list)) { |
1068 | WARN_ONCE(1, "clear_halt for a busy endpoint\n"); | |
3a44494e AS |
1069 | } else if (qh->qh_state == QH_STATE_LINKED || |
1070 | qh->qh_state == QH_STATE_COMPLETING) { | |
a455212d AS |
1071 | |
1072 | /* The toggle value in the QH can't be updated | |
1073 | * while the QH is active. Unlink it now; | |
1074 | * re-linking will call qh_refresh(). | |
b18ffd49 | 1075 | */ |
a448c9d8 | 1076 | if (eptype == USB_ENDPOINT_XFER_BULK) |
3c273a05 | 1077 | start_unlink_async(ehci, qh); |
a448c9d8 | 1078 | else |
df202255 | 1079 | start_unlink_intr(ehci, qh); |
b18ffd49 AS |
1080 | } |
1081 | } | |
a455212d | 1082 | spin_unlock_irqrestore(&ehci->lock, flags); |
b18ffd49 AS |
1083 | } |
1084 | ||
7ff71d6a MP |
1085 | static int ehci_get_frame (struct usb_hcd *hcd) |
1086 | { | |
1087 | struct ehci_hcd *ehci = hcd_to_ehci (hcd); | |
68aa95d5 | 1088 | return (ehci_read_frame_index(ehci) >> 3) % ehci->periodic_size; |
7ff71d6a | 1089 | } |
1da177e4 LT |
1090 | |
1091 | /*-------------------------------------------------------------------------*/ | |
c5cf9212 AS |
1092 | |
1093 | #ifdef CONFIG_PM | |
1094 | ||
1095 | /* suspend/resume, section 4.3 */ | |
1096 | ||
1097 | /* These routines handle the generic parts of controller suspend/resume */ | |
1098 | ||
1099 | static int __maybe_unused ehci_suspend(struct usb_hcd *hcd, bool do_wakeup) | |
1100 | { | |
1101 | struct ehci_hcd *ehci = hcd_to_ehci(hcd); | |
1102 | ||
1103 | if (time_before(jiffies, ehci->next_statechange)) | |
1104 | msleep(10); | |
1105 | ||
1106 | /* | |
1107 | * Root hub was already suspended. Disable IRQ emission and | |
1108 | * mark HW unaccessible. The PM and USB cores make sure that | |
1109 | * the root hub is either suspended or stopped. | |
1110 | */ | |
1111 | ehci_prepare_ports_for_controller_suspend(ehci, do_wakeup); | |
1112 | ||
1113 | spin_lock_irq(&ehci->lock); | |
1114 | ehci_writel(ehci, 0, &ehci->regs->intr_enable); | |
1115 | (void) ehci_readl(ehci, &ehci->regs->intr_enable); | |
1116 | ||
1117 | clear_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags); | |
1118 | spin_unlock_irq(&ehci->lock); | |
1119 | ||
1120 | return 0; | |
1121 | } | |
1122 | ||
1123 | /* Returns 0 if power was preserved, 1 if power was lost */ | |
1124 | static int __maybe_unused ehci_resume(struct usb_hcd *hcd, bool hibernated) | |
1125 | { | |
1126 | struct ehci_hcd *ehci = hcd_to_ehci(hcd); | |
1127 | ||
1128 | if (time_before(jiffies, ehci->next_statechange)) | |
1129 | msleep(100); | |
1130 | ||
1131 | /* Mark hardware accessible again as we are back to full power by now */ | |
1132 | set_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags); | |
1133 | ||
43fe3a99 AS |
1134 | if (ehci->shutdown) |
1135 | return 0; /* Controller is dead */ | |
1136 | ||
c5cf9212 AS |
1137 | /* |
1138 | * If CF is still set and we aren't resuming from hibernation | |
1139 | * then we maintained suspend power. | |
1140 | * Just undo the effect of ehci_suspend(). | |
1141 | */ | |
1142 | if (ehci_readl(ehci, &ehci->regs->configured_flag) == FLAG_CF && | |
1143 | !hibernated) { | |
1144 | int mask = INTR_MASK; | |
1145 | ||
1146 | ehci_prepare_ports_for_controller_resume(ehci); | |
43fe3a99 AS |
1147 | |
1148 | spin_lock_irq(&ehci->lock); | |
1149 | if (ehci->shutdown) | |
1150 | goto skip; | |
1151 | ||
c5cf9212 AS |
1152 | if (!hcd->self.root_hub->do_remote_wakeup) |
1153 | mask &= ~STS_PCD; | |
1154 | ehci_writel(ehci, mask, &ehci->regs->intr_enable); | |
1155 | ehci_readl(ehci, &ehci->regs->intr_enable); | |
43fe3a99 AS |
1156 | skip: |
1157 | spin_unlock_irq(&ehci->lock); | |
c5cf9212 AS |
1158 | return 0; |
1159 | } | |
1160 | ||
1161 | /* | |
1162 | * Else reset, to cope with power loss or resume from hibernation | |
1163 | * having let the firmware kick in during reboot. | |
1164 | */ | |
1165 | usb_root_hub_lost_power(hcd->self.root_hub); | |
1166 | (void) ehci_halt(ehci); | |
1167 | (void) ehci_reset(ehci); | |
1168 | ||
43fe3a99 AS |
1169 | spin_lock_irq(&ehci->lock); |
1170 | if (ehci->shutdown) | |
1171 | goto skip; | |
1172 | ||
c5cf9212 AS |
1173 | ehci_writel(ehci, ehci->command, &ehci->regs->command); |
1174 | ehci_writel(ehci, FLAG_CF, &ehci->regs->configured_flag); | |
1175 | ehci_readl(ehci, &ehci->regs->command); /* unblock posted writes */ | |
1176 | ||
43fe3a99 AS |
1177 | ehci->rh_state = EHCI_RH_SUSPENDED; |
1178 | spin_unlock_irq(&ehci->lock); | |
1179 | ||
c5cf9212 AS |
1180 | /* here we "know" root ports should always stay powered */ |
1181 | ehci_port_power(ehci, 1); | |
1182 | ||
c5cf9212 AS |
1183 | return 1; |
1184 | } | |
1185 | ||
1186 | #endif | |
1187 | ||
1188 | /*-------------------------------------------------------------------------*/ | |
1189 | ||
eb70e5ab AS |
1190 | /* |
1191 | * The EHCI in ChipIdea HDRC cannot be a separate module or device, | |
1192 | * because its registers (and irq) are shared between host/gadget/otg | |
1193 | * functions and in order to facilitate role switching we cannot | |
1194 | * give the ehci driver exclusive access to those. | |
1195 | */ | |
1196 | #ifndef CHIPIDEA_EHCI | |
1da177e4 | 1197 | |
2b70f073 | 1198 | MODULE_DESCRIPTION(DRIVER_DESC); |
1da177e4 LT |
1199 | MODULE_AUTHOR (DRIVER_AUTHOR); |
1200 | MODULE_LICENSE ("GPL"); | |
1201 | ||
7ff71d6a MP |
1202 | #ifdef CONFIG_PCI |
1203 | #include "ehci-pci.c" | |
01cced25 | 1204 | #define PCI_DRIVER ehci_pci_driver |
7ff71d6a | 1205 | #endif |
1da177e4 | 1206 | |
ba02978a | 1207 | #ifdef CONFIG_USB_EHCI_FSL |
80cb9aee | 1208 | #include "ehci-fsl.c" |
01cced25 | 1209 | #define PLATFORM_DRIVER ehci_fsl_driver |
80cb9aee RV |
1210 | #endif |
1211 | ||
7e8d5cd9 DM |
1212 | #ifdef CONFIG_USB_EHCI_MXC |
1213 | #include "ehci-mxc.c" | |
1214 | #define PLATFORM_DRIVER ehci_mxc_driver | |
1215 | #endif | |
1216 | ||
60b0bf0f | 1217 | #ifdef CONFIG_USB_EHCI_SH |
63c84552 PM |
1218 | #include "ehci-sh.c" |
1219 | #define PLATFORM_DRIVER ehci_hcd_sh_driver | |
1220 | #endif | |
1221 | ||
37663860 | 1222 | #ifdef CONFIG_MIPS_ALCHEMY |
76fa9a24 | 1223 | #include "ehci-au1xxx.c" |
01cced25 | 1224 | #define PLATFORM_DRIVER ehci_hcd_au1xxx_driver |
76fa9a24 JC |
1225 | #endif |
1226 | ||
7f124f4b | 1227 | #ifdef CONFIG_USB_EHCI_HCD_OMAP |
54ab2b02 FB |
1228 | #include "ehci-omap.c" |
1229 | #define PLATFORM_DRIVER ehci_hcd_omap_driver | |
1230 | #endif | |
1231 | ||
ad75a410 GL |
1232 | #ifdef CONFIG_PPC_PS3 |
1233 | #include "ehci-ps3.c" | |
7a4eb7fd | 1234 | #define PS3_SYSTEM_BUS_DRIVER ps3_ehci_driver |
ad75a410 GL |
1235 | #endif |
1236 | ||
da0e8fb0 VB |
1237 | #ifdef CONFIG_USB_EHCI_HCD_PPC_OF |
1238 | #include "ehci-ppc-of.c" | |
1239 | #define OF_PLATFORM_DRIVER ehci_hcd_ppc_of_driver | |
1240 | #endif | |
1241 | ||
08d3c18e JZ |
1242 | #ifdef CONFIG_XPS_USB_HCD_XILINX |
1243 | #include "ehci-xilinx-of.c" | |
1f23b2d9 | 1244 | #define XILINX_OF_PLATFORM_DRIVER ehci_hcd_xilinx_of_driver |
08d3c18e JZ |
1245 | #endif |
1246 | ||
705a7521 | 1247 | #ifdef CONFIG_PLAT_ORION |
e96ffe2f TP |
1248 | #include "ehci-orion.c" |
1249 | #define PLATFORM_DRIVER ehci_orion_driver | |
1250 | #endif | |
1251 | ||
586dfc8c WZ |
1252 | #ifdef CONFIG_USB_W90X900_EHCI |
1253 | #include "ehci-w90x900.c" | |
1254 | #define PLATFORM_DRIVER ehci_hcd_w90x900_driver | |
1255 | #endif | |
1256 | ||
501c9c08 NF |
1257 | #ifdef CONFIG_ARCH_AT91 |
1258 | #include "ehci-atmel.c" | |
1259 | #define PLATFORM_DRIVER ehci_atmel_driver | |
1260 | #endif | |
1261 | ||
1643accd DD |
1262 | #ifdef CONFIG_USB_OCTEON_EHCI |
1263 | #include "ehci-octeon.c" | |
1264 | #define PLATFORM_DRIVER ehci_octeon_driver | |
1265 | #endif | |
1266 | ||
760efe69 ML |
1267 | #ifdef CONFIG_USB_CNS3XXX_EHCI |
1268 | #include "ehci-cns3xxx.c" | |
1269 | #define PLATFORM_DRIVER cns3xxx_ehci_driver | |
1270 | #endif | |
1271 | ||
ad78acaf AC |
1272 | #ifdef CONFIG_ARCH_VT8500 |
1273 | #include "ehci-vt8500.c" | |
1274 | #define PLATFORM_DRIVER vt8500_ehci_driver | |
1275 | #endif | |
1276 | ||
c8c38de9 DS |
1277 | #ifdef CONFIG_PLAT_SPEAR |
1278 | #include "ehci-spear.c" | |
1279 | #define PLATFORM_DRIVER spear_ehci_hcd_driver | |
1280 | #endif | |
1281 | ||
b0848aea PK |
1282 | #ifdef CONFIG_USB_EHCI_MSM |
1283 | #include "ehci-msm.c" | |
1284 | #define PLATFORM_DRIVER ehci_msm_driver | |
1285 | #endif | |
1286 | ||
47fc28bf CM |
1287 | #ifdef CONFIG_TILE_USB |
1288 | #include "ehci-tilegx.c" | |
1289 | #define PLATFORM_DRIVER ehci_hcd_tilegx_driver | |
1290 | #endif | |
1291 | ||
22ced687 A |
1292 | #ifdef CONFIG_USB_EHCI_HCD_PMC_MSP |
1293 | #include "ehci-pmcmsp.c" | |
1294 | #define PLATFORM_DRIVER ehci_hcd_msp_driver | |
1295 | #endif | |
1296 | ||
79ad3b5a BG |
1297 | #ifdef CONFIG_USB_EHCI_TEGRA |
1298 | #include "ehci-tegra.c" | |
1299 | #define PLATFORM_DRIVER tegra_ehci_driver | |
1300 | #endif | |
1301 | ||
1bcc5aa8 JS |
1302 | #ifdef CONFIG_USB_EHCI_S5P |
1303 | #include "ehci-s5p.c" | |
1304 | #define PLATFORM_DRIVER s5p_ehci_driver | |
1305 | #endif | |
1306 | ||
9be03929 JA |
1307 | #ifdef CONFIG_SPARC_LEON |
1308 | #include "ehci-grlib.c" | |
1309 | #define PLATFORM_DRIVER ehci_grlib_driver | |
1310 | #endif | |
1311 | ||
3a082ec9 NZ |
1312 | #ifdef CONFIG_USB_EHCI_MV |
1313 | #include "ehci-mv.c" | |
1314 | #define PLATFORM_DRIVER ehci_mv_driver | |
1315 | #endif | |
f30cdbcb | 1316 | |
c256667f SH |
1317 | #ifdef CONFIG_MIPS_SEAD3 |
1318 | #include "ehci-sead3.c" | |
1319 | #define PLATFORM_DRIVER ehci_hcd_sead3_driver | |
1320 | #endif | |
1321 | ||
7a7a4a59 HM |
1322 | #ifdef CONFIG_USB_EHCI_HCD_PLATFORM |
1323 | #include "ehci-platform.c" | |
1324 | #define PLATFORM_DRIVER ehci_platform_driver | |
1325 | #endif | |
1326 | ||
ad75a410 | 1327 | #if !defined(PCI_DRIVER) && !defined(PLATFORM_DRIVER) && \ |
1f23b2d9 GL |
1328 | !defined(PS3_SYSTEM_BUS_DRIVER) && !defined(OF_PLATFORM_DRIVER) && \ |
1329 | !defined(XILINX_OF_PLATFORM_DRIVER) | |
7ff71d6a MP |
1330 | #error "missing bus glue for ehci-hcd" |
1331 | #endif | |
01cced25 KG |
1332 | |
1333 | static int __init ehci_hcd_init(void) | |
1334 | { | |
1335 | int retval = 0; | |
1336 | ||
2b70f073 AS |
1337 | if (usb_disabled()) |
1338 | return -ENODEV; | |
1339 | ||
1340 | printk(KERN_INFO "%s: " DRIVER_DESC "\n", hcd_name); | |
9beeee65 AS |
1341 | set_bit(USB_EHCI_LOADED, &usb_hcds_loaded); |
1342 | if (test_bit(USB_UHCI_LOADED, &usb_hcds_loaded) || | |
1343 | test_bit(USB_OHCI_LOADED, &usb_hcds_loaded)) | |
1344 | printk(KERN_WARNING "Warning! ehci_hcd should always be loaded" | |
1345 | " before uhci_hcd and ohci_hcd, not after\n"); | |
1346 | ||
01cced25 KG |
1347 | pr_debug("%s: block sizes: qh %Zd qtd %Zd itd %Zd sitd %Zd\n", |
1348 | hcd_name, | |
1349 | sizeof(struct ehci_qh), sizeof(struct ehci_qtd), | |
1350 | sizeof(struct ehci_itd), sizeof(struct ehci_sitd)); | |
1351 | ||
694cc208 | 1352 | #ifdef DEBUG |
08f4e586 | 1353 | ehci_debug_root = debugfs_create_dir("ehci", usb_debug_root); |
9beeee65 AS |
1354 | if (!ehci_debug_root) { |
1355 | retval = -ENOENT; | |
1356 | goto err_debug; | |
1357 | } | |
694cc208 TJ |
1358 | #endif |
1359 | ||
01cced25 KG |
1360 | #ifdef PLATFORM_DRIVER |
1361 | retval = platform_driver_register(&PLATFORM_DRIVER); | |
da0e8fb0 VB |
1362 | if (retval < 0) |
1363 | goto clean0; | |
01cced25 KG |
1364 | #endif |
1365 | ||
1366 | #ifdef PCI_DRIVER | |
1367 | retval = pci_register_driver(&PCI_DRIVER); | |
da0e8fb0 VB |
1368 | if (retval < 0) |
1369 | goto clean1; | |
ad75a410 GL |
1370 | #endif |
1371 | ||
1372 | #ifdef PS3_SYSTEM_BUS_DRIVER | |
7a4eb7fd | 1373 | retval = ps3_ehci_driver_register(&PS3_SYSTEM_BUS_DRIVER); |
da0e8fb0 VB |
1374 | if (retval < 0) |
1375 | goto clean2; | |
694cc208 | 1376 | #endif |
da0e8fb0 VB |
1377 | |
1378 | #ifdef OF_PLATFORM_DRIVER | |
d35fb641 | 1379 | retval = platform_driver_register(&OF_PLATFORM_DRIVER); |
da0e8fb0 VB |
1380 | if (retval < 0) |
1381 | goto clean3; | |
1382 | #endif | |
1f23b2d9 GL |
1383 | |
1384 | #ifdef XILINX_OF_PLATFORM_DRIVER | |
d35fb641 | 1385 | retval = platform_driver_register(&XILINX_OF_PLATFORM_DRIVER); |
1f23b2d9 GL |
1386 | if (retval < 0) |
1387 | goto clean4; | |
1388 | #endif | |
da0e8fb0 VB |
1389 | return retval; |
1390 | ||
1f23b2d9 | 1391 | #ifdef XILINX_OF_PLATFORM_DRIVER |
d35fb641 | 1392 | /* platform_driver_unregister(&XILINX_OF_PLATFORM_DRIVER); */ |
1f23b2d9 GL |
1393 | clean4: |
1394 | #endif | |
da0e8fb0 | 1395 | #ifdef OF_PLATFORM_DRIVER |
d35fb641 | 1396 | platform_driver_unregister(&OF_PLATFORM_DRIVER); |
da0e8fb0 VB |
1397 | clean3: |
1398 | #endif | |
1399 | #ifdef PS3_SYSTEM_BUS_DRIVER | |
1400 | ps3_ehci_driver_unregister(&PS3_SYSTEM_BUS_DRIVER); | |
1401 | clean2: | |
ad75a410 GL |
1402 | #endif |
1403 | #ifdef PCI_DRIVER | |
da0e8fb0 VB |
1404 | pci_unregister_driver(&PCI_DRIVER); |
1405 | clean1: | |
ad75a410 | 1406 | #endif |
da0e8fb0 VB |
1407 | #ifdef PLATFORM_DRIVER |
1408 | platform_driver_unregister(&PLATFORM_DRIVER); | |
1409 | clean0: | |
1410 | #endif | |
1411 | #ifdef DEBUG | |
1412 | debugfs_remove(ehci_debug_root); | |
1413 | ehci_debug_root = NULL; | |
9beeee65 | 1414 | err_debug: |
a9b6148d | 1415 | #endif |
9beeee65 | 1416 | clear_bit(USB_EHCI_LOADED, &usb_hcds_loaded); |
01cced25 KG |
1417 | return retval; |
1418 | } | |
1419 | module_init(ehci_hcd_init); | |
1420 | ||
1421 | static void __exit ehci_hcd_cleanup(void) | |
1422 | { | |
1f23b2d9 | 1423 | #ifdef XILINX_OF_PLATFORM_DRIVER |
d35fb641 | 1424 | platform_driver_unregister(&XILINX_OF_PLATFORM_DRIVER); |
1f23b2d9 | 1425 | #endif |
da0e8fb0 | 1426 | #ifdef OF_PLATFORM_DRIVER |
d35fb641 | 1427 | platform_driver_unregister(&OF_PLATFORM_DRIVER); |
da0e8fb0 | 1428 | #endif |
01cced25 KG |
1429 | #ifdef PLATFORM_DRIVER |
1430 | platform_driver_unregister(&PLATFORM_DRIVER); | |
1431 | #endif | |
1432 | #ifdef PCI_DRIVER | |
1433 | pci_unregister_driver(&PCI_DRIVER); | |
1434 | #endif | |
ad75a410 | 1435 | #ifdef PS3_SYSTEM_BUS_DRIVER |
7a4eb7fd | 1436 | ps3_ehci_driver_unregister(&PS3_SYSTEM_BUS_DRIVER); |
ad75a410 | 1437 | #endif |
694cc208 TJ |
1438 | #ifdef DEBUG |
1439 | debugfs_remove(ehci_debug_root); | |
1440 | #endif | |
9beeee65 | 1441 | clear_bit(USB_EHCI_LOADED, &usb_hcds_loaded); |
01cced25 KG |
1442 | } |
1443 | module_exit(ehci_hcd_cleanup); | |
1444 | ||
eb70e5ab | 1445 | #endif /* CHIPIDEA_EHCI */ |