OSDN Git Service

usb: musb: fix some runtime_pm issues
[uclinux-h8/linux.git] / drivers / usb / musb / omap2430.c
1 /*
2  * Copyright (C) 2005-2007 by Texas Instruments
3  * Some code has been taken from tusb6010.c
4  * Copyrights for that are attributable to:
5  * Copyright (C) 2006 Nokia Corporation
6  * Tony Lindgren <tony@atomide.com>
7  *
8  * This file is part of the Inventra Controller Driver for Linux.
9  *
10  * The Inventra Controller Driver for Linux is free software; you
11  * can redistribute it and/or modify it under the terms of the GNU
12  * General Public License version 2 as published by the Free Software
13  * Foundation.
14  *
15  * The Inventra Controller Driver for Linux is distributed in
16  * the hope that it will be useful, but WITHOUT ANY WARRANTY;
17  * without even the implied warranty of MERCHANTABILITY or
18  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public
19  * License for more details.
20  *
21  * You should have received a copy of the GNU General Public License
22  * along with The Inventra Controller Driver for Linux ; if not,
23  * write to the Free Software Foundation, Inc., 59 Temple Place,
24  * Suite 330, Boston, MA  02111-1307  USA
25  *
26  */
27 #include <linux/module.h>
28 #include <linux/kernel.h>
29 #include <linux/sched.h>
30 #include <linux/init.h>
31 #include <linux/list.h>
32 #include <linux/io.h>
33 #include <linux/platform_device.h>
34 #include <linux/dma-mapping.h>
35 #include <linux/pm_runtime.h>
36 #include <linux/err.h>
37
38 #include "musb_core.h"
39 #include "omap2430.h"
40
41 struct omap2430_glue {
42         struct device           *dev;
43         struct platform_device  *musb;
44 };
45 #define glue_to_musb(g)         platform_get_drvdata(g->musb)
46
47 static struct timer_list musb_idle_timer;
48
49 static void musb_do_idle(unsigned long _musb)
50 {
51         struct musb     *musb = (void *)_musb;
52         unsigned long   flags;
53         u8      power;
54         u8      devctl;
55
56         spin_lock_irqsave(&musb->lock, flags);
57
58         switch (musb->xceiv->state) {
59         case OTG_STATE_A_WAIT_BCON:
60
61                 devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
62                 if (devctl & MUSB_DEVCTL_BDEVICE) {
63                         musb->xceiv->state = OTG_STATE_B_IDLE;
64                         MUSB_DEV_MODE(musb);
65                 } else {
66                         musb->xceiv->state = OTG_STATE_A_IDLE;
67                         MUSB_HST_MODE(musb);
68                 }
69                 break;
70         case OTG_STATE_A_SUSPEND:
71                 /* finish RESUME signaling? */
72                 if (musb->port1_status & MUSB_PORT_STAT_RESUME) {
73                         power = musb_readb(musb->mregs, MUSB_POWER);
74                         power &= ~MUSB_POWER_RESUME;
75                         dev_dbg(musb->controller, "root port resume stopped, power %02x\n", power);
76                         musb_writeb(musb->mregs, MUSB_POWER, power);
77                         musb->is_active = 1;
78                         musb->port1_status &= ~(USB_PORT_STAT_SUSPEND
79                                                 | MUSB_PORT_STAT_RESUME);
80                         musb->port1_status |= USB_PORT_STAT_C_SUSPEND << 16;
81                         usb_hcd_poll_rh_status(musb_to_hcd(musb));
82                         /* NOTE: it might really be A_WAIT_BCON ... */
83                         musb->xceiv->state = OTG_STATE_A_HOST;
84                 }
85                 break;
86         case OTG_STATE_A_HOST:
87                 devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
88                 if (devctl &  MUSB_DEVCTL_BDEVICE)
89                         musb->xceiv->state = OTG_STATE_B_IDLE;
90                 else
91                         musb->xceiv->state = OTG_STATE_A_WAIT_BCON;
92         default:
93                 break;
94         }
95         spin_unlock_irqrestore(&musb->lock, flags);
96 }
97
98
99 static void omap2430_musb_try_idle(struct musb *musb, unsigned long timeout)
100 {
101         unsigned long           default_timeout = jiffies + msecs_to_jiffies(3);
102         static unsigned long    last_timer;
103
104         if (timeout == 0)
105                 timeout = default_timeout;
106
107         /* Never idle if active, or when VBUS timeout is not set as host */
108         if (musb->is_active || ((musb->a_wait_bcon == 0)
109                         && (musb->xceiv->state == OTG_STATE_A_WAIT_BCON))) {
110                 dev_dbg(musb->controller, "%s active, deleting timer\n",
111                         otg_state_string(musb->xceiv->state));
112                 del_timer(&musb_idle_timer);
113                 last_timer = jiffies;
114                 return;
115         }
116
117         if (time_after(last_timer, timeout)) {
118                 if (!timer_pending(&musb_idle_timer))
119                         last_timer = timeout;
120                 else {
121                         dev_dbg(musb->controller, "Longer idle timer already pending, ignoring\n");
122                         return;
123                 }
124         }
125         last_timer = timeout;
126
127         dev_dbg(musb->controller, "%s inactive, for idle timer for %lu ms\n",
128                 otg_state_string(musb->xceiv->state),
129                 (unsigned long)jiffies_to_msecs(timeout - jiffies));
130         mod_timer(&musb_idle_timer, timeout);
131 }
132
133 static void omap2430_musb_set_vbus(struct musb *musb, int is_on)
134 {
135         struct usb_otg  *otg = musb->xceiv->otg;
136         u8              devctl;
137         unsigned long timeout = jiffies + msecs_to_jiffies(1000);
138         int ret = 1;
139         /* HDRC controls CPEN, but beware current surges during device
140          * connect.  They can trigger transient overcurrent conditions
141          * that must be ignored.
142          */
143
144         devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
145
146         if (is_on) {
147                 if (musb->xceiv->state == OTG_STATE_A_IDLE) {
148                         /* start the session */
149                         devctl |= MUSB_DEVCTL_SESSION;
150                         musb_writeb(musb->mregs, MUSB_DEVCTL, devctl);
151                         /*
152                          * Wait for the musb to set as A device to enable the
153                          * VBUS
154                          */
155                         while (musb_readb(musb->mregs, MUSB_DEVCTL) & 0x80) {
156
157                                 cpu_relax();
158
159                                 if (time_after(jiffies, timeout)) {
160                                         dev_err(musb->controller,
161                                         "configured as A device timeout");
162                                         ret = -EINVAL;
163                                         break;
164                                 }
165                         }
166
167                         if (ret && otg->set_vbus)
168                                 otg_set_vbus(otg, 1);
169                 } else {
170                         musb->is_active = 1;
171                         otg->default_a = 1;
172                         musb->xceiv->state = OTG_STATE_A_WAIT_VRISE;
173                         devctl |= MUSB_DEVCTL_SESSION;
174                         MUSB_HST_MODE(musb);
175                 }
176         } else {
177                 musb->is_active = 0;
178
179                 /* NOTE:  we're skipping A_WAIT_VFALL -> A_IDLE and
180                  * jumping right to B_IDLE...
181                  */
182
183                 otg->default_a = 0;
184                 musb->xceiv->state = OTG_STATE_B_IDLE;
185                 devctl &= ~MUSB_DEVCTL_SESSION;
186
187                 MUSB_DEV_MODE(musb);
188         }
189         musb_writeb(musb->mregs, MUSB_DEVCTL, devctl);
190
191         dev_dbg(musb->controller, "VBUS %s, devctl %02x "
192                 /* otg %3x conf %08x prcm %08x */ "\n",
193                 otg_state_string(musb->xceiv->state),
194                 musb_readb(musb->mregs, MUSB_DEVCTL));
195 }
196
197 static int omap2430_musb_set_mode(struct musb *musb, u8 musb_mode)
198 {
199         u8      devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
200
201         devctl |= MUSB_DEVCTL_SESSION;
202         musb_writeb(musb->mregs, MUSB_DEVCTL, devctl);
203
204         return 0;
205 }
206
207 static inline void omap2430_low_level_exit(struct musb *musb)
208 {
209         u32 l;
210
211         /* in any role */
212         l = musb_readl(musb->mregs, OTG_FORCESTDBY);
213         l |= ENABLEFORCE;       /* enable MSTANDBY */
214         musb_writel(musb->mregs, OTG_FORCESTDBY, l);
215 }
216
217 static inline void omap2430_low_level_init(struct musb *musb)
218 {
219         u32 l;
220
221         l = musb_readl(musb->mregs, OTG_FORCESTDBY);
222         l &= ~ENABLEFORCE;      /* disable MSTANDBY */
223         musb_writel(musb->mregs, OTG_FORCESTDBY, l);
224 }
225
226 static int musb_otg_notifications(struct notifier_block *nb,
227                 unsigned long event, void *unused)
228 {
229         struct musb     *musb = container_of(nb, struct musb, nb);
230
231         musb->xceiv_event = event;
232         schedule_work(&musb->otg_notifier_work);
233
234         return NOTIFY_OK;
235 }
236
237 static void musb_otg_notifier_work(struct work_struct *data_notifier_work)
238 {
239         struct musb *musb = container_of(data_notifier_work, struct musb, otg_notifier_work);
240         struct device *dev = musb->controller;
241         struct musb_hdrc_platform_data *pdata = dev->platform_data;
242         struct omap_musb_board_data *data = pdata->board_data;
243
244         switch (musb->xceiv_event) {
245         case USB_EVENT_ID:
246                 dev_dbg(musb->controller, "ID GND\n");
247
248                 if (!is_otg_enabled(musb) || musb->gadget_driver) {
249                         pm_runtime_get_sync(musb->controller);
250                         usb_phy_init(musb->xceiv);
251                         omap2430_musb_set_vbus(musb, 1);
252                 }
253                 break;
254
255         case USB_EVENT_VBUS:
256                 dev_dbg(musb->controller, "VBUS Connect\n");
257
258                 if (musb->gadget_driver)
259                         pm_runtime_get_sync(musb->controller);
260                 usb_phy_init(musb->xceiv);
261                 break;
262
263         case USB_EVENT_NONE:
264                 dev_dbg(musb->controller, "VBUS Disconnect\n");
265
266                 if (is_otg_enabled(musb) || is_peripheral_enabled(musb))
267                         if (musb->gadget_driver) {
268                                 pm_runtime_mark_last_busy(musb->controller);
269                                 pm_runtime_put_autosuspend(musb->controller);
270                         }
271
272                 if (data->interface_type == MUSB_INTERFACE_UTMI) {
273                         if (musb->xceiv->otg->set_vbus)
274                                 otg_set_vbus(musb->xceiv->otg, 0);
275                 }
276                 usb_phy_shutdown(musb->xceiv);
277                 break;
278         default:
279                 dev_dbg(musb->controller, "ID float\n");
280         }
281 }
282
283 static int omap2430_musb_init(struct musb *musb)
284 {
285         u32 l, status = 0;
286         struct device *dev = musb->controller;
287         struct musb_hdrc_platform_data *plat = dev->platform_data;
288         struct omap_musb_board_data *data = plat->board_data;
289
290         /* We require some kind of external transceiver, hooked
291          * up through ULPI.  TWL4030-family PMICs include one,
292          * which needs a driver, drivers aren't always needed.
293          */
294         musb->xceiv = usb_get_transceiver();
295         if (!musb->xceiv) {
296                 pr_err("HS USB OTG: no transceiver configured\n");
297                 return -ENODEV;
298         }
299
300         INIT_WORK(&musb->otg_notifier_work, musb_otg_notifier_work);
301
302         status = pm_runtime_get_sync(dev);
303         if (status < 0) {
304                 dev_err(dev, "pm_runtime_get_sync FAILED");
305                 goto err1;
306         }
307
308         l = musb_readl(musb->mregs, OTG_INTERFSEL);
309
310         if (data->interface_type == MUSB_INTERFACE_UTMI) {
311                 /* OMAP4 uses Internal PHY GS70 which uses UTMI interface */
312                 l &= ~ULPI_12PIN;       /* Disable ULPI */
313                 l |= UTMI_8BIT;         /* Enable UTMI  */
314         } else {
315                 l |= ULPI_12PIN;
316         }
317
318         musb_writel(musb->mregs, OTG_INTERFSEL, l);
319
320         pr_debug("HS USB OTG: revision 0x%x, sysconfig 0x%02x, "
321                         "sysstatus 0x%x, intrfsel 0x%x, simenable  0x%x\n",
322                         musb_readl(musb->mregs, OTG_REVISION),
323                         musb_readl(musb->mregs, OTG_SYSCONFIG),
324                         musb_readl(musb->mregs, OTG_SYSSTATUS),
325                         musb_readl(musb->mregs, OTG_INTERFSEL),
326                         musb_readl(musb->mregs, OTG_SIMENABLE));
327
328         musb->nb.notifier_call = musb_otg_notifications;
329         status = usb_register_notifier(musb->xceiv, &musb->nb);
330
331         if (status)
332                 dev_dbg(musb->controller, "notification register failed\n");
333
334         setup_timer(&musb_idle_timer, musb_do_idle, (unsigned long) musb);
335
336         pm_runtime_put_noidle(musb->controller);
337         return 0;
338
339 err1:
340         return status;
341 }
342
343 static void omap2430_musb_enable(struct musb *musb)
344 {
345         u8              devctl;
346         unsigned long timeout = jiffies + msecs_to_jiffies(1000);
347         struct device *dev = musb->controller;
348         struct musb_hdrc_platform_data *pdata = dev->platform_data;
349         struct omap_musb_board_data *data = pdata->board_data;
350
351         switch (musb->xceiv->last_event) {
352
353         case USB_EVENT_ID:
354                 usb_phy_init(musb->xceiv);
355                 if (data->interface_type != MUSB_INTERFACE_UTMI)
356                         break;
357                 devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
358                 /* start the session */
359                 devctl |= MUSB_DEVCTL_SESSION;
360                 musb_writeb(musb->mregs, MUSB_DEVCTL, devctl);
361                 while (musb_readb(musb->mregs, MUSB_DEVCTL) &
362                                 MUSB_DEVCTL_BDEVICE) {
363                         cpu_relax();
364
365                         if (time_after(jiffies, timeout)) {
366                                 dev_err(dev, "configured as A device timeout");
367                                 break;
368                         }
369                 }
370                 break;
371
372         case USB_EVENT_VBUS:
373                 usb_phy_init(musb->xceiv);
374                 break;
375
376         default:
377                 break;
378         }
379 }
380
381 static void omap2430_musb_disable(struct musb *musb)
382 {
383         if (musb->xceiv->last_event)
384                 usb_phy_shutdown(musb->xceiv);
385 }
386
387 static int omap2430_musb_exit(struct musb *musb)
388 {
389         del_timer_sync(&musb_idle_timer);
390         cancel_work_sync(&musb->otg_notifier_work);
391
392         omap2430_low_level_exit(musb);
393         usb_put_transceiver(musb->xceiv);
394
395         return 0;
396 }
397
398 static const struct musb_platform_ops omap2430_ops = {
399         .init           = omap2430_musb_init,
400         .exit           = omap2430_musb_exit,
401
402         .set_mode       = omap2430_musb_set_mode,
403         .try_idle       = omap2430_musb_try_idle,
404
405         .set_vbus       = omap2430_musb_set_vbus,
406
407         .enable         = omap2430_musb_enable,
408         .disable        = omap2430_musb_disable,
409 };
410
411 static u64 omap2430_dmamask = DMA_BIT_MASK(32);
412
413 static int __devinit omap2430_probe(struct platform_device *pdev)
414 {
415         struct musb_hdrc_platform_data  *pdata = pdev->dev.platform_data;
416         struct platform_device          *musb;
417         struct omap2430_glue            *glue;
418         int                             ret = -ENOMEM;
419
420         glue = kzalloc(sizeof(*glue), GFP_KERNEL);
421         if (!glue) {
422                 dev_err(&pdev->dev, "failed to allocate glue context\n");
423                 goto err0;
424         }
425
426         musb = platform_device_alloc("musb-hdrc", -1);
427         if (!musb) {
428                 dev_err(&pdev->dev, "failed to allocate musb device\n");
429                 goto err1;
430         }
431
432         musb->dev.parent                = &pdev->dev;
433         musb->dev.dma_mask              = &omap2430_dmamask;
434         musb->dev.coherent_dma_mask     = omap2430_dmamask;
435
436         glue->dev                       = &pdev->dev;
437         glue->musb                      = musb;
438
439         pdata->platform_ops             = &omap2430_ops;
440
441         platform_set_drvdata(pdev, glue);
442
443         ret = platform_device_add_resources(musb, pdev->resource,
444                         pdev->num_resources);
445         if (ret) {
446                 dev_err(&pdev->dev, "failed to add resources\n");
447                 goto err2;
448         }
449
450         ret = platform_device_add_data(musb, pdata, sizeof(*pdata));
451         if (ret) {
452                 dev_err(&pdev->dev, "failed to add platform_data\n");
453                 goto err2;
454         }
455
456         ret = platform_device_add(musb);
457         if (ret) {
458                 dev_err(&pdev->dev, "failed to register musb device\n");
459                 goto err2;
460         }
461
462         pm_runtime_enable(&pdev->dev);
463
464         return 0;
465
466 err2:
467         platform_device_put(musb);
468
469 err1:
470         kfree(glue);
471
472 err0:
473         return ret;
474 }
475
476 static int __devexit omap2430_remove(struct platform_device *pdev)
477 {
478         struct omap2430_glue            *glue = platform_get_drvdata(pdev);
479
480         platform_device_del(glue->musb);
481         platform_device_put(glue->musb);
482         kfree(glue);
483
484         return 0;
485 }
486
487 #ifdef CONFIG_PM
488
489 static int omap2430_runtime_suspend(struct device *dev)
490 {
491         struct omap2430_glue            *glue = dev_get_drvdata(dev);
492         struct musb                     *musb = glue_to_musb(glue);
493
494         if (musb) {
495                 musb->context.otg_interfsel = musb_readl(musb->mregs,
496                                 OTG_INTERFSEL);
497
498                 omap2430_low_level_exit(musb);
499                 usb_phy_set_suspend(musb->xceiv, 1);
500         }
501
502         return 0;
503 }
504
505 static int omap2430_runtime_resume(struct device *dev)
506 {
507         struct omap2430_glue            *glue = dev_get_drvdata(dev);
508         struct musb                     *musb = glue_to_musb(glue);
509
510         if (musb) {
511                 omap2430_low_level_init(musb);
512                 musb_writel(musb->mregs, OTG_INTERFSEL,
513                                 musb->context.otg_interfsel);
514
515                 usb_phy_set_suspend(musb->xceiv, 0);
516         }
517
518         return 0;
519 }
520
521 static struct dev_pm_ops omap2430_pm_ops = {
522         .runtime_suspend = omap2430_runtime_suspend,
523         .runtime_resume = omap2430_runtime_resume,
524 };
525
526 #define DEV_PM_OPS      (&omap2430_pm_ops)
527 #else
528 #define DEV_PM_OPS      NULL
529 #endif
530
531 static struct platform_driver omap2430_driver = {
532         .probe          = omap2430_probe,
533         .remove         = __devexit_p(omap2430_remove),
534         .driver         = {
535                 .name   = "musb-omap2430",
536                 .pm     = DEV_PM_OPS,
537         },
538 };
539
540 MODULE_DESCRIPTION("OMAP2PLUS MUSB Glue Layer");
541 MODULE_AUTHOR("Felipe Balbi <balbi@ti.com>");
542 MODULE_LICENSE("GPL v2");
543
544 static int __init omap2430_init(void)
545 {
546         return platform_driver_register(&omap2430_driver);
547 }
548 module_init(omap2430_init);
549
550 static void __exit omap2430_exit(void)
551 {
552         platform_driver_unregister(&omap2430_driver);
553 }
554 module_exit(omap2430_exit);