netfilter: remove unnecessary goto statement for error recovery
[cascardo/linux.git] / drivers / usb / host / ohci-omap.c
1 /*
2  * OHCI HCD (Host Controller Driver) for USB.
3  *
4  * (C) Copyright 1999 Roman Weissgaerber <weissg@vienna.at>
5  * (C) Copyright 2000-2005 David Brownell
6  * (C) Copyright 2002 Hewlett-Packard Company
7  *
8  * OMAP Bus Glue
9  *
10  * Modified for OMAP by Tony Lindgren <tony@atomide.com>
11  * Based on the 2.4 OMAP OHCI driver originally done by MontaVista Software Inc.
12  * and on ohci-sa1111.c by Christopher Hoover <ch@hpl.hp.com>
13  *
14  * This file is licenced under the GPL.
15  */
16
17 #include <linux/signal.h>
18 #include <linux/jiffies.h>
19 #include <linux/platform_device.h>
20 #include <linux/clk.h>
21 #include <linux/err.h>
22 #include <linux/gpio.h>
23
24 #include <asm/io.h>
25 #include <asm/mach-types.h>
26
27 #include <plat/mux.h>
28 #include <plat/fpga.h>
29
30 #include <mach/hardware.h>
31 #include <mach/irqs.h>
32 #include <mach/usb.h>
33
34
35 /* OMAP-1510 OHCI has its own MMU for DMA */
36 #define OMAP1510_LB_MEMSIZE     32      /* Should be same as SDRAM size */
37 #define OMAP1510_LB_CLOCK_DIV   0xfffec10c
38 #define OMAP1510_LB_MMU_CTL     0xfffec208
39 #define OMAP1510_LB_MMU_LCK     0xfffec224
40 #define OMAP1510_LB_MMU_LD_TLB  0xfffec228
41 #define OMAP1510_LB_MMU_CAM_H   0xfffec22c
42 #define OMAP1510_LB_MMU_CAM_L   0xfffec230
43 #define OMAP1510_LB_MMU_RAM_H   0xfffec234
44 #define OMAP1510_LB_MMU_RAM_L   0xfffec238
45
46
47 #ifndef CONFIG_ARCH_OMAP
48 #error "This file is OMAP bus glue.  CONFIG_OMAP must be defined."
49 #endif
50
51 #ifdef CONFIG_TPS65010
52 #include <linux/i2c/tps65010.h>
53 #else
54
55 #define LOW     0
56 #define HIGH    1
57
58 #define GPIO1   1
59
60 static inline int tps65010_set_gpio_out_value(unsigned gpio, unsigned value)
61 {
62         return 0;
63 }
64
65 #endif
66
67 extern int usb_disabled(void);
68 extern int ocpi_enable(void);
69
70 static struct clk *usb_host_ck;
71 static struct clk *usb_dc_ck;
72 static int host_enabled;
73 static int host_initialized;
74
75 static void omap_ohci_clock_power(int on)
76 {
77         if (on) {
78                 clk_enable(usb_dc_ck);
79                 clk_enable(usb_host_ck);
80                 /* guesstimate for T5 == 1x 32K clock + APLL lock time */
81                 udelay(100);
82         } else {
83                 clk_disable(usb_host_ck);
84                 clk_disable(usb_dc_ck);
85         }
86 }
87
88 /*
89  * Board specific gang-switched transceiver power on/off.
90  * NOTE:  OSK supplies power from DC, not battery.
91  */
92 static int omap_ohci_transceiver_power(int on)
93 {
94         if (on) {
95                 if (machine_is_omap_innovator() && cpu_is_omap1510())
96                         fpga_write(fpga_read(INNOVATOR_FPGA_CAM_USB_CONTROL)
97                                 | ((1 << 5/*usb1*/) | (1 << 3/*usb2*/)),
98                                INNOVATOR_FPGA_CAM_USB_CONTROL);
99                 else if (machine_is_omap_osk())
100                         tps65010_set_gpio_out_value(GPIO1, LOW);
101         } else {
102                 if (machine_is_omap_innovator() && cpu_is_omap1510())
103                         fpga_write(fpga_read(INNOVATOR_FPGA_CAM_USB_CONTROL)
104                                 & ~((1 << 5/*usb1*/) | (1 << 3/*usb2*/)),
105                                INNOVATOR_FPGA_CAM_USB_CONTROL);
106                 else if (machine_is_omap_osk())
107                         tps65010_set_gpio_out_value(GPIO1, HIGH);
108         }
109
110         return 0;
111 }
112
113 #ifdef CONFIG_ARCH_OMAP15XX
114 /*
115  * OMAP-1510 specific Local Bus clock on/off
116  */
117 static int omap_1510_local_bus_power(int on)
118 {
119         if (on) {
120                 omap_writel((1 << 1) | (1 << 0), OMAP1510_LB_MMU_CTL);
121                 udelay(200);
122         } else {
123                 omap_writel(0, OMAP1510_LB_MMU_CTL);
124         }
125
126         return 0;
127 }
128
129 /*
130  * OMAP-1510 specific Local Bus initialization
131  * NOTE: This assumes 32MB memory size in OMAP1510LB_MEMSIZE.
132  *       See also arch/mach-omap/memory.h for __virt_to_dma() and
133  *       __dma_to_virt() which need to match with the physical
134  *       Local Bus address below.
135  */
136 static int omap_1510_local_bus_init(void)
137 {
138         unsigned int tlb;
139         unsigned long lbaddr, physaddr;
140
141         omap_writel((omap_readl(OMAP1510_LB_CLOCK_DIV) & 0xfffffff8) | 0x4,
142                OMAP1510_LB_CLOCK_DIV);
143
144         /* Configure the Local Bus MMU table */
145         for (tlb = 0; tlb < OMAP1510_LB_MEMSIZE; tlb++) {
146                 lbaddr = tlb * 0x00100000 + OMAP1510_LB_OFFSET;
147                 physaddr = tlb * 0x00100000 + PHYS_OFFSET;
148                 omap_writel((lbaddr & 0x0fffffff) >> 22, OMAP1510_LB_MMU_CAM_H);
149                 omap_writel(((lbaddr & 0x003ffc00) >> 6) | 0xc,
150                        OMAP1510_LB_MMU_CAM_L);
151                 omap_writel(physaddr >> 16, OMAP1510_LB_MMU_RAM_H);
152                 omap_writel((physaddr & 0x0000fc00) | 0x300, OMAP1510_LB_MMU_RAM_L);
153                 omap_writel(tlb << 4, OMAP1510_LB_MMU_LCK);
154                 omap_writel(0x1, OMAP1510_LB_MMU_LD_TLB);
155         }
156
157         /* Enable the walking table */
158         omap_writel(omap_readl(OMAP1510_LB_MMU_CTL) | (1 << 3), OMAP1510_LB_MMU_CTL);
159         udelay(200);
160
161         return 0;
162 }
163 #else
164 #define omap_1510_local_bus_power(x)    {}
165 #define omap_1510_local_bus_init()      {}
166 #endif
167
168 #ifdef  CONFIG_USB_OTG
169
170 static void start_hnp(struct ohci_hcd *ohci)
171 {
172         struct usb_hcd *hcd = ohci_to_hcd(ohci);
173         const unsigned  port = hcd->self.otg_port - 1;
174         unsigned long   flags;
175         u32 l;
176
177         otg_start_hnp(hcd->phy->otg);
178
179         local_irq_save(flags);
180         hcd->phy->state = OTG_STATE_A_SUSPEND;
181         writel (RH_PS_PSS, &ohci->regs->roothub.portstatus [port]);
182         l = omap_readl(OTG_CTRL);
183         l &= ~OTG_A_BUSREQ;
184         omap_writel(l, OTG_CTRL);
185         local_irq_restore(flags);
186 }
187
188 #endif
189
190 /*-------------------------------------------------------------------------*/
191
192 static int ohci_omap_init(struct usb_hcd *hcd)
193 {
194         struct ohci_hcd         *ohci = hcd_to_ohci(hcd);
195         struct omap_usb_config  *config = hcd->self.controller->platform_data;
196         int                     need_transceiver = (config->otg != 0);
197         int                     ret;
198
199         dev_dbg(hcd->self.controller, "starting USB Controller\n");
200
201         if (config->otg) {
202                 ohci_to_hcd(ohci)->self.otg_port = config->otg;
203                 /* default/minimum OTG power budget:  8 mA */
204                 ohci_to_hcd(ohci)->power_budget = 8;
205         }
206
207         /* boards can use OTG transceivers in non-OTG modes */
208         need_transceiver = need_transceiver
209                         || machine_is_omap_h2() || machine_is_omap_h3();
210
211         /* XXX OMAP16xx only */
212         if (config->ocpi_enable)
213                 config->ocpi_enable();
214
215 #ifdef  CONFIG_USB_OTG
216         if (need_transceiver) {
217                 hcd->phy = usb_get_phy(USB_PHY_TYPE_USB2);
218                 if (!IS_ERR_OR_NULL(hcd->phy)) {
219                         int     status = otg_set_host(hcd->phy->otg,
220                                                 &ohci_to_hcd(ohci)->self);
221                         dev_dbg(hcd->self.controller, "init %s phy, status %d\n",
222                                         hcd->phy->label, status);
223                         if (status) {
224                                 usb_put_phy(hcd->phy);
225                                 return status;
226                         }
227                 } else {
228                         dev_err(hcd->self.controller, "can't find phy\n");
229                         return -ENODEV;
230                 }
231                 ohci->start_hnp = start_hnp;
232         }
233 #endif
234
235         omap_ohci_clock_power(1);
236
237         if (cpu_is_omap15xx()) {
238                 omap_1510_local_bus_power(1);
239                 omap_1510_local_bus_init();
240         }
241
242         if ((ret = ohci_init(ohci)) < 0)
243                 return ret;
244
245         /* board-specific power switching and overcurrent support */
246         if (machine_is_omap_osk() || machine_is_omap_innovator()) {
247                 u32     rh = roothub_a (ohci);
248
249                 /* power switching (ganged by default) */
250                 rh &= ~RH_A_NPS;
251
252                 /* TPS2045 switch for internal transceiver (port 1) */
253                 if (machine_is_omap_osk()) {
254                         ohci_to_hcd(ohci)->power_budget = 250;
255
256                         rh &= ~RH_A_NOCP;
257
258                         /* gpio9 for overcurrent detction */
259                         omap_cfg_reg(W8_1610_GPIO9);
260                         gpio_request(9, "OHCI overcurrent");
261                         gpio_direction_input(9);
262
263                         /* for paranoia's sake:  disable USB.PUEN */
264                         omap_cfg_reg(W4_USB_HIGHZ);
265                 }
266                 ohci_writel(ohci, rh, &ohci->regs->roothub.a);
267                 ohci->flags &= ~OHCI_QUIRK_HUB_POWER;
268         } else if (machine_is_nokia770()) {
269                 /* We require a self-powered hub, which should have
270                  * plenty of power. */
271                 ohci_to_hcd(ohci)->power_budget = 0;
272         }
273
274         /* FIXME khubd hub requests should manage power switching */
275         omap_ohci_transceiver_power(1);
276
277         /* board init will have already handled HMC and mux setup.
278          * any external transceiver should already be initialized
279          * too, so all configured ports use the right signaling now.
280          */
281
282         return 0;
283 }
284
285 static void ohci_omap_stop(struct usb_hcd *hcd)
286 {
287         dev_dbg(hcd->self.controller, "stopping USB Controller\n");
288         ohci_stop(hcd);
289         omap_ohci_clock_power(0);
290 }
291
292
293 /*-------------------------------------------------------------------------*/
294
295 /**
296  * usb_hcd_omap_probe - initialize OMAP-based HCDs
297  * Context: !in_interrupt()
298  *
299  * Allocates basic resources for this USB host controller, and
300  * then invokes the start() method for the HCD associated with it
301  * through the hotplug entry's driver_data.
302  */
303 static int usb_hcd_omap_probe (const struct hc_driver *driver,
304                           struct platform_device *pdev)
305 {
306         int retval, irq;
307         struct usb_hcd *hcd = 0;
308         struct ohci_hcd *ohci;
309
310         if (pdev->num_resources != 2) {
311                 printk(KERN_ERR "hcd probe: invalid num_resources: %i\n",
312                        pdev->num_resources);
313                 return -ENODEV;
314         }
315
316         if (pdev->resource[0].flags != IORESOURCE_MEM
317                         || pdev->resource[1].flags != IORESOURCE_IRQ) {
318                 printk(KERN_ERR "hcd probe: invalid resource type\n");
319                 return -ENODEV;
320         }
321
322         usb_host_ck = clk_get(&pdev->dev, "usb_hhc_ck");
323         if (IS_ERR(usb_host_ck))
324                 return PTR_ERR(usb_host_ck);
325
326         if (!cpu_is_omap15xx())
327                 usb_dc_ck = clk_get(&pdev->dev, "usb_dc_ck");
328         else
329                 usb_dc_ck = clk_get(&pdev->dev, "lb_ck");
330
331         if (IS_ERR(usb_dc_ck)) {
332                 clk_put(usb_host_ck);
333                 return PTR_ERR(usb_dc_ck);
334         }
335
336
337         hcd = usb_create_hcd (driver, &pdev->dev, dev_name(&pdev->dev));
338         if (!hcd) {
339                 retval = -ENOMEM;
340                 goto err0;
341         }
342         hcd->rsrc_start = pdev->resource[0].start;
343         hcd->rsrc_len = pdev->resource[0].end - pdev->resource[0].start + 1;
344
345         if (!request_mem_region(hcd->rsrc_start, hcd->rsrc_len, hcd_name)) {
346                 dev_dbg(&pdev->dev, "request_mem_region failed\n");
347                 retval = -EBUSY;
348                 goto err1;
349         }
350
351         hcd->regs = ioremap(hcd->rsrc_start, hcd->rsrc_len);
352         if (!hcd->regs) {
353                 dev_err(&pdev->dev, "can't ioremap OHCI HCD\n");
354                 retval = -ENOMEM;
355                 goto err2;
356         }
357
358         ohci = hcd_to_ohci(hcd);
359         ohci_hcd_init(ohci);
360
361         host_initialized = 0;
362         host_enabled = 1;
363
364         irq = platform_get_irq(pdev, 0);
365         if (irq < 0) {
366                 retval = -ENXIO;
367                 goto err3;
368         }
369         retval = usb_add_hcd(hcd, irq, 0);
370         if (retval)
371                 goto err3;
372
373         host_initialized = 1;
374
375         if (!host_enabled)
376                 omap_ohci_clock_power(0);
377
378         return 0;
379 err3:
380         iounmap(hcd->regs);
381 err2:
382         release_mem_region(hcd->rsrc_start, hcd->rsrc_len);
383 err1:
384         usb_put_hcd(hcd);
385 err0:
386         clk_put(usb_dc_ck);
387         clk_put(usb_host_ck);
388         return retval;
389 }
390
391
392 /* may be called with controller, bus, and devices active */
393
394 /**
395  * usb_hcd_omap_remove - shutdown processing for OMAP-based HCDs
396  * @dev: USB Host Controller being removed
397  * Context: !in_interrupt()
398  *
399  * Reverses the effect of usb_hcd_omap_probe(), first invoking
400  * the HCD's stop() method.  It is always called from a thread
401  * context, normally "rmmod", "apmd", or something similar.
402  */
403 static inline void
404 usb_hcd_omap_remove (struct usb_hcd *hcd, struct platform_device *pdev)
405 {
406         struct ohci_hcd         *ohci = hcd_to_ohci (hcd);
407
408         usb_remove_hcd(hcd);
409         if (!IS_ERR_OR_NULL(hcd->phy)) {
410                 (void) otg_set_host(hcd->phy->otg, 0);
411                 usb_put_phy(hcd->phy);
412         }
413         if (machine_is_omap_osk())
414                 gpio_free(9);
415         iounmap(hcd->regs);
416         release_mem_region(hcd->rsrc_start, hcd->rsrc_len);
417         usb_put_hcd(hcd);
418         clk_put(usb_dc_ck);
419         clk_put(usb_host_ck);
420 }
421
422 /*-------------------------------------------------------------------------*/
423
424 static int
425 ohci_omap_start (struct usb_hcd *hcd)
426 {
427         struct omap_usb_config *config;
428         struct ohci_hcd *ohci = hcd_to_ohci (hcd);
429         int             ret;
430
431         if (!host_enabled)
432                 return 0;
433         config = hcd->self.controller->platform_data;
434         if (config->otg || config->rwc) {
435                 ohci->hc_control = OHCI_CTRL_RWC;
436                 writel(OHCI_CTRL_RWC, &ohci->regs->control);
437         }
438
439         if ((ret = ohci_run (ohci)) < 0) {
440                 dev_err(hcd->self.controller, "can't start\n");
441                 ohci_stop (hcd);
442                 return ret;
443         }
444         return 0;
445 }
446
447 /*-------------------------------------------------------------------------*/
448
449 static const struct hc_driver ohci_omap_hc_driver = {
450         .description =          hcd_name,
451         .product_desc =         "OMAP OHCI",
452         .hcd_priv_size =        sizeof(struct ohci_hcd),
453
454         /*
455          * generic hardware linkage
456          */
457         .irq =                  ohci_irq,
458         .flags =                HCD_USB11 | HCD_MEMORY,
459
460         /*
461          * basic lifecycle operations
462          */
463         .reset =                ohci_omap_init,
464         .start =                ohci_omap_start,
465         .stop =                 ohci_omap_stop,
466         .shutdown =             ohci_shutdown,
467
468         /*
469          * managing i/o requests and associated device resources
470          */
471         .urb_enqueue =          ohci_urb_enqueue,
472         .urb_dequeue =          ohci_urb_dequeue,
473         .endpoint_disable =     ohci_endpoint_disable,
474
475         /*
476          * scheduling support
477          */
478         .get_frame_number =     ohci_get_frame,
479
480         /*
481          * root hub support
482          */
483         .hub_status_data =      ohci_hub_status_data,
484         .hub_control =          ohci_hub_control,
485 #ifdef  CONFIG_PM
486         .bus_suspend =          ohci_bus_suspend,
487         .bus_resume =           ohci_bus_resume,
488 #endif
489         .start_port_reset =     ohci_start_port_reset,
490 };
491
492 /*-------------------------------------------------------------------------*/
493
494 static int ohci_hcd_omap_drv_probe(struct platform_device *dev)
495 {
496         return usb_hcd_omap_probe(&ohci_omap_hc_driver, dev);
497 }
498
499 static int ohci_hcd_omap_drv_remove(struct platform_device *dev)
500 {
501         struct usb_hcd          *hcd = platform_get_drvdata(dev);
502
503         usb_hcd_omap_remove(hcd, dev);
504         platform_set_drvdata(dev, NULL);
505
506         return 0;
507 }
508
509 /*-------------------------------------------------------------------------*/
510
511 #ifdef  CONFIG_PM
512
513 static int ohci_omap_suspend(struct platform_device *dev, pm_message_t message)
514 {
515         struct ohci_hcd *ohci = hcd_to_ohci(platform_get_drvdata(dev));
516
517         if (time_before(jiffies, ohci->next_statechange))
518                 msleep(5);
519         ohci->next_statechange = jiffies;
520
521         omap_ohci_clock_power(0);
522         return 0;
523 }
524
525 static int ohci_omap_resume(struct platform_device *dev)
526 {
527         struct usb_hcd  *hcd = platform_get_drvdata(dev);
528         struct ohci_hcd *ohci = hcd_to_ohci(hcd);
529
530         if (time_before(jiffies, ohci->next_statechange))
531                 msleep(5);
532         ohci->next_statechange = jiffies;
533
534         omap_ohci_clock_power(1);
535         ohci_finish_controller_resume(hcd);
536         return 0;
537 }
538
539 #endif
540
541 /*-------------------------------------------------------------------------*/
542
543 /*
544  * Driver definition to register with the OMAP bus
545  */
546 static struct platform_driver ohci_hcd_omap_driver = {
547         .probe          = ohci_hcd_omap_drv_probe,
548         .remove         = ohci_hcd_omap_drv_remove,
549         .shutdown       = usb_hcd_platform_shutdown,
550 #ifdef  CONFIG_PM
551         .suspend        = ohci_omap_suspend,
552         .resume         = ohci_omap_resume,
553 #endif
554         .driver         = {
555                 .owner  = THIS_MODULE,
556                 .name   = "ohci",
557         },
558 };
559
560 MODULE_ALIAS("platform:ohci");