USB: Properly unregister reboot notifier in case of failure in ehci hcd
[deliverable/linux.git] / drivers / usb / host / ohci-at91.c
1 /*
2 * OHCI HCD (Host Controller Driver) for USB.
3 *
4 * Copyright (C) 2004 SAN People (Pty) Ltd.
5 * Copyright (C) 2005 Thibaut VARENE <varenet@parisc-linux.org>
6 *
7 * AT91 Bus Glue
8 *
9 * Based on fragments of 2.4 driver by Rick Bronson.
10 * Based on ohci-omap.c
11 *
12 * This file is licenced under the GPL.
13 */
14
15 #include <linux/clk.h>
16 #include <linux/platform_device.h>
17
18 #include <asm/mach-types.h>
19 #include <asm/hardware.h>
20 #include <asm/arch/board.h>
21
22 #ifndef CONFIG_ARCH_AT91
23 #error "CONFIG_ARCH_AT91 must be defined."
24 #endif
25
26 /* interface and function clocks */
27 static struct clk *iclk, *fclk;
28 static int clocked;
29
30 extern int usb_disabled(void);
31
32 /*-------------------------------------------------------------------------*/
33
34 static void at91_start_hc(struct platform_device *pdev)
35 {
36 struct usb_hcd *hcd = platform_get_drvdata(pdev);
37 struct ohci_regs __iomem *regs = hcd->regs;
38
39 dev_dbg(&pdev->dev, "start\n");
40
41 /*
42 * Start the USB clocks.
43 */
44 clk_enable(iclk);
45 clk_enable(fclk);
46 clocked = 1;
47
48 /*
49 * The USB host controller must remain in reset.
50 */
51 writel(0, &regs->control);
52 }
53
54 static void at91_stop_hc(struct platform_device *pdev)
55 {
56 struct usb_hcd *hcd = platform_get_drvdata(pdev);
57 struct ohci_regs __iomem *regs = hcd->regs;
58
59 dev_dbg(&pdev->dev, "stop\n");
60
61 /*
62 * Put the USB host controller into reset.
63 */
64 writel(0, &regs->control);
65
66 /*
67 * Stop the USB clocks.
68 */
69 clk_disable(fclk);
70 clk_disable(iclk);
71 clocked = 0;
72 }
73
74
75 /*-------------------------------------------------------------------------*/
76
77 static int usb_hcd_at91_remove (struct usb_hcd *, struct platform_device *);
78
79 /* configure so an HC device and id are always provided */
80 /* always called with process context; sleeping is OK */
81
82
83 /**
84 * usb_hcd_at91_probe - initialize AT91-based HCDs
85 * Context: !in_interrupt()
86 *
87 * Allocates basic resources for this USB host controller, and
88 * then invokes the start() method for the HCD associated with it
89 * through the hotplug entry's driver_data.
90 */
91 static int usb_hcd_at91_probe(const struct hc_driver *driver,
92 struct platform_device *pdev)
93 {
94 int retval;
95 struct usb_hcd *hcd = NULL;
96
97 if (pdev->num_resources != 2) {
98 pr_debug("hcd probe: invalid num_resources");
99 return -ENODEV;
100 }
101
102 if ((pdev->resource[0].flags != IORESOURCE_MEM)
103 || (pdev->resource[1].flags != IORESOURCE_IRQ)) {
104 pr_debug("hcd probe: invalid resource type\n");
105 return -ENODEV;
106 }
107
108 hcd = usb_create_hcd(driver, &pdev->dev, "at91");
109 if (!hcd)
110 return -ENOMEM;
111 hcd->rsrc_start = pdev->resource[0].start;
112 hcd->rsrc_len = pdev->resource[0].end - pdev->resource[0].start + 1;
113
114 if (!request_mem_region(hcd->rsrc_start, hcd->rsrc_len, hcd_name)) {
115 pr_debug("request_mem_region failed\n");
116 retval = -EBUSY;
117 goto err1;
118 }
119
120 hcd->regs = ioremap(hcd->rsrc_start, hcd->rsrc_len);
121 if (!hcd->regs) {
122 pr_debug("ioremap failed\n");
123 retval = -EIO;
124 goto err2;
125 }
126
127 iclk = clk_get(&pdev->dev, "ohci_clk");
128 fclk = clk_get(&pdev->dev, "uhpck");
129
130 at91_start_hc(pdev);
131 ohci_hcd_init(hcd_to_ohci(hcd));
132
133 retval = usb_add_hcd(hcd, pdev->resource[1].start, IRQF_DISABLED);
134 if (retval == 0)
135 return retval;
136
137 /* Error handling */
138 at91_stop_hc(pdev);
139
140 clk_put(fclk);
141 clk_put(iclk);
142
143 iounmap(hcd->regs);
144
145 err2:
146 release_mem_region(hcd->rsrc_start, hcd->rsrc_len);
147
148 err1:
149 usb_put_hcd(hcd);
150 return retval;
151 }
152
153
154 /* may be called with controller, bus, and devices active */
155
156 /**
157 * usb_hcd_at91_remove - shutdown processing for AT91-based HCDs
158 * @dev: USB Host Controller being removed
159 * Context: !in_interrupt()
160 *
161 * Reverses the effect of usb_hcd_at91_probe(), first invoking
162 * the HCD's stop() method. It is always called from a thread
163 * context, "rmmod" or something similar.
164 *
165 */
166 static int usb_hcd_at91_remove(struct usb_hcd *hcd,
167 struct platform_device *pdev)
168 {
169 usb_remove_hcd(hcd);
170 at91_stop_hc(pdev);
171 iounmap(hcd->regs);
172 release_mem_region(hcd->rsrc_start, hcd->rsrc_len);
173 disable_irq_wake(hcd->irq);
174
175 clk_put(fclk);
176 clk_put(iclk);
177 fclk = iclk = NULL;
178
179 dev_set_drvdata(&pdev->dev, NULL);
180 return 0;
181 }
182
183 /*-------------------------------------------------------------------------*/
184
185 static int __devinit
186 ohci_at91_start (struct usb_hcd *hcd)
187 {
188 struct at91_usbh_data *board = hcd->self.controller->platform_data;
189 struct ohci_hcd *ohci = hcd_to_ohci (hcd);
190 struct usb_device *root = hcd->self.root_hub;
191 int ret;
192
193 if ((ret = ohci_init(ohci)) < 0)
194 return ret;
195
196 root->maxchild = board->ports;
197
198 if ((ret = ohci_run(ohci)) < 0) {
199 err("can't start %s", hcd->self.bus_name);
200 ohci_stop(hcd);
201 return ret;
202 }
203 return 0;
204 }
205
206 /*-------------------------------------------------------------------------*/
207
208 static const struct hc_driver ohci_at91_hc_driver = {
209 .description = hcd_name,
210 .product_desc = "AT91 OHCI",
211 .hcd_priv_size = sizeof(struct ohci_hcd),
212
213 /*
214 * generic hardware linkage
215 */
216 .irq = ohci_irq,
217 .flags = HCD_USB11 | HCD_MEMORY,
218
219 /*
220 * basic lifecycle operations
221 */
222 .start = ohci_at91_start,
223 .stop = ohci_stop,
224 .shutdown = ohci_shutdown,
225
226 /*
227 * managing i/o requests and associated device resources
228 */
229 .urb_enqueue = ohci_urb_enqueue,
230 .urb_dequeue = ohci_urb_dequeue,
231 .endpoint_disable = ohci_endpoint_disable,
232
233 /*
234 * scheduling support
235 */
236 .get_frame_number = ohci_get_frame,
237
238 /*
239 * root hub support
240 */
241 .hub_status_data = ohci_hub_status_data,
242 .hub_control = ohci_hub_control,
243 .hub_irq_enable = ohci_rhsc_enable,
244 #ifdef CONFIG_PM
245 .bus_suspend = ohci_bus_suspend,
246 .bus_resume = ohci_bus_resume,
247 #endif
248 .start_port_reset = ohci_start_port_reset,
249 };
250
251 /*-------------------------------------------------------------------------*/
252
253 static int ohci_hcd_at91_drv_probe(struct platform_device *pdev)
254 {
255 device_init_wakeup(&pdev->dev, 1);
256 return usb_hcd_at91_probe(&ohci_at91_hc_driver, pdev);
257 }
258
259 static int ohci_hcd_at91_drv_remove(struct platform_device *pdev)
260 {
261 device_init_wakeup(&pdev->dev, 0);
262 return usb_hcd_at91_remove(platform_get_drvdata(pdev), pdev);
263 }
264
265 #ifdef CONFIG_PM
266
267 static int
268 ohci_hcd_at91_drv_suspend(struct platform_device *pdev, pm_message_t mesg)
269 {
270 struct usb_hcd *hcd = platform_get_drvdata(pdev);
271 struct ohci_hcd *ohci = hcd_to_ohci(hcd);
272
273 if (device_may_wakeup(&pdev->dev))
274 enable_irq_wake(hcd->irq);
275 else
276 disable_irq_wake(hcd->irq);
277
278 /*
279 * The integrated transceivers seem unable to notice disconnect,
280 * reconnect, or wakeup without the 48 MHz clock active. so for
281 * correctness, always discard connection state (using reset).
282 *
283 * REVISIT: some boards will be able to turn VBUS off...
284 */
285 if (at91_suspend_entering_slow_clock()) {
286 ohci_usb_reset (ohci);
287 clk_disable(fclk);
288 clk_disable(iclk);
289 clocked = 0;
290 }
291
292 return 0;
293 }
294
295 static int ohci_hcd_at91_drv_resume(struct platform_device *pdev)
296 {
297 if (!clocked) {
298 clk_enable(iclk);
299 clk_enable(fclk);
300 }
301
302 return 0;
303 }
304 #else
305 #define ohci_hcd_at91_drv_suspend NULL
306 #define ohci_hcd_at91_drv_resume NULL
307 #endif
308
309 MODULE_ALIAS("at91_ohci");
310
311 static struct platform_driver ohci_hcd_at91_driver = {
312 .probe = ohci_hcd_at91_drv_probe,
313 .remove = ohci_hcd_at91_drv_remove,
314 .shutdown = usb_hcd_platform_shutdown,
315 .suspend = ohci_hcd_at91_drv_suspend,
316 .resume = ohci_hcd_at91_drv_resume,
317 .driver = {
318 .name = "at91_ohci",
319 .owner = THIS_MODULE,
320 },
321 };
322
323 static int __init ohci_hcd_at91_init (void)
324 {
325 if (usb_disabled())
326 return -ENODEV;
327
328 return platform_driver_register(&ohci_hcd_at91_driver);
329 }
330
331 static void __exit ohci_hcd_at91_cleanup (void)
332 {
333 platform_driver_unregister(&ohci_hcd_at91_driver);
334 }
335
336 module_init (ohci_hcd_at91_init);
337 module_exit (ohci_hcd_at91_cleanup);
This page took 0.04469 seconds and 5 git commands to generate.