?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
net: ipmr: adjust mroute.h style and drop extern
[linux/fpc-iii.git] / drivers / usb / musb / omap2430.c
blob1bd9232ff76fcb774e6b1e9e1fb8acdb62ef267d
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/of.h>
34 #include <linux/platform_device.h>
35 #include <linux/dma-mapping.h>
36 #include <linux/pm_runtime.h>
37 #include <linux/err.h>
38 #include <linux/delay.h>
39 #include <linux/usb/musb-omap.h>
40 #include <linux/phy/omap_control_phy.h>
41 #include <linux/of_platform.h>
42
43 #include "musb_core.h"
44 #include "omap2430.h"
45
46 struct omap2430_glue {
47 struct device *dev;
48 struct platform_device *musb;
49 enum omap_musb_vbus_id_status status;
50 struct work_struct omap_musb_mailbox_work;
51 struct device *control_otghs;
52 };
53 #define glue_to_musb(g) platform_get_drvdata(g->musb)
54
55 static struct omap2430_glue *_glue;
56
57 static struct timer_list musb_idle_timer;
58
59 static void musb_do_idle(unsigned long _musb)
60 {
61 struct musb *musb = (void *)_musb;
62 unsigned long flags;
63 u8 power;
64 u8 devctl;
65
66 spin_lock_irqsave(&musb->lock, flags);
67
68 switch (musb->xceiv->otg->state) {
69 case OTG_STATE_A_WAIT_BCON:
70
71 devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
72 if (devctl & MUSB_DEVCTL_BDEVICE) {
73 musb->xceiv->otg->state = OTG_STATE_B_IDLE;
74 MUSB_DEV_MODE(musb);
75 } else {
76 musb->xceiv->otg->state = OTG_STATE_A_IDLE;
77 MUSB_HST_MODE(musb);
78 }
79 break;
80 case OTG_STATE_A_SUSPEND:
81 /* finish RESUME signaling? */
82 if (musb->port1_status & MUSB_PORT_STAT_RESUME) {
83 power = musb_readb(musb->mregs, MUSB_POWER);
84 power &= ~MUSB_POWER_RESUME;
85 dev_dbg(musb->controller, "root port resume stopped, power %02x\n", power);
86 musb_writeb(musb->mregs, MUSB_POWER, power);
87 musb->is_active = 1;
88 musb->port1_status &= ~(USB_PORT_STAT_SUSPEND
89 | MUSB_PORT_STAT_RESUME);
90 musb->port1_status |= USB_PORT_STAT_C_SUSPEND << 16;
91 usb_hcd_poll_rh_status(musb->hcd);
92 /* NOTE: it might really be A_WAIT_BCON ... */
93 musb->xceiv->otg->state = OTG_STATE_A_HOST;
94 }
95 break;
96 case OTG_STATE_A_HOST:
97 devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
98 if (devctl & MUSB_DEVCTL_BDEVICE)
99 musb->xceiv->otg->state = OTG_STATE_B_IDLE;
100 else
101 musb->xceiv->otg->state = OTG_STATE_A_WAIT_BCON;
102 default:
103 break;
104 }
105 spin_unlock_irqrestore(&musb->lock, flags);
106 }
107
108
109 static void omap2430_musb_try_idle(struct musb *musb, unsigned long timeout)
110 {
111 unsigned long default_timeout = jiffies + msecs_to_jiffies(3);
112 static unsigned long last_timer;
113
114 if (timeout == 0)
115 timeout = default_timeout;
116
117 /* Never idle if active, or when VBUS timeout is not set as host */
118 if (musb->is_active || ((musb->a_wait_bcon == 0)
119 && (musb->xceiv->otg->state == OTG_STATE_A_WAIT_BCON))) {
120 dev_dbg(musb->controller, "%s active, deleting timer\n",
121 usb_otg_state_string(musb->xceiv->otg->state));
122 del_timer(&musb_idle_timer);
123 last_timer = jiffies;
124 return;
125 }
126
127 if (time_after(last_timer, timeout)) {
128 if (!timer_pending(&musb_idle_timer))
129 last_timer = timeout;
130 else {
131 dev_dbg(musb->controller, "Longer idle timer already pending, ignoring\n");
132 return;
133 }
134 }
135 last_timer = timeout;
136
137 dev_dbg(musb->controller, "%s inactive, for idle timer for %lu ms\n",
138 usb_otg_state_string(musb->xceiv->otg->state),
139 (unsigned long)jiffies_to_msecs(timeout - jiffies));
140 mod_timer(&musb_idle_timer, timeout);
141 }
142
143 static void omap2430_musb_set_vbus(struct musb *musb, int is_on)
144 {
145 struct usb_otg *otg = musb->xceiv->otg;
146 u8 devctl;
147 unsigned long timeout = jiffies + msecs_to_jiffies(1000);
148 /* HDRC controls CPEN, but beware current surges during device
149 * connect. They can trigger transient overcurrent conditions
150 * that must be ignored.
151 */
152
153 devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
154
155 if (is_on) {
156 if (musb->xceiv->otg->state == OTG_STATE_A_IDLE) {
157 int loops = 100;
158 /* start the session */
159 devctl |= MUSB_DEVCTL_SESSION;
160 musb_writeb(musb->mregs, MUSB_DEVCTL, devctl);
161 /*
162 * Wait for the musb to set as A device to enable the
163 * VBUS
164 */
165 while (musb_readb(musb->mregs, MUSB_DEVCTL) &
166 MUSB_DEVCTL_BDEVICE) {
167
168 mdelay(5);
169 cpu_relax();
170
171 if (time_after(jiffies, timeout)
172 || loops-- <= 0) {
173 dev_err(musb->controller,
174 "configured as A device timeout");
175 break;
176 }
177 }
178
179 otg_set_vbus(otg, 1);
180 } else {
181 musb->is_active = 1;
182 otg->default_a = 1;
183 musb->xceiv->otg->state = OTG_STATE_A_WAIT_VRISE;
184 devctl |= MUSB_DEVCTL_SESSION;
185 MUSB_HST_MODE(musb);
186 }
187 } else {
188 musb->is_active = 0;
189
190 /* NOTE: we're skipping A_WAIT_VFALL -> A_IDLE and
191 * jumping right to B_IDLE...
192 */
193
194 otg->default_a = 0;
195 musb->xceiv->otg->state = OTG_STATE_B_IDLE;
196 devctl &= ~MUSB_DEVCTL_SESSION;
197
198 MUSB_DEV_MODE(musb);
199 }
200 musb_writeb(musb->mregs, MUSB_DEVCTL, devctl);
201
202 dev_dbg(musb->controller, "VBUS %s, devctl %02x "
203 /* otg %3x conf %08x prcm %08x */ "\n",
204 usb_otg_state_string(musb->xceiv->otg->state),
205 musb_readb(musb->mregs, MUSB_DEVCTL));
206 }
207
208 static int omap2430_musb_set_mode(struct musb *musb, u8 musb_mode)
209 {
210 u8 devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
211
212 devctl |= MUSB_DEVCTL_SESSION;
213 musb_writeb(musb->mregs, MUSB_DEVCTL, devctl);
214
215 return 0;
216 }
217
218 static inline void omap2430_low_level_exit(struct musb *musb)
219 {
220 u32 l;
221
222 /* in any role */
223 l = musb_readl(musb->mregs, OTG_FORCESTDBY);
224 l |= ENABLEFORCE; /* enable MSTANDBY */
225 musb_writel(musb->mregs, OTG_FORCESTDBY, l);
226 }
227
228 static inline void omap2430_low_level_init(struct musb *musb)
229 {
230 u32 l;
231
232 l = musb_readl(musb->mregs, OTG_FORCESTDBY);
233 l &= ~ENABLEFORCE; /* disable MSTANDBY */
234 musb_writel(musb->mregs, OTG_FORCESTDBY, l);
235 }
236
237 void omap_musb_mailbox(enum omap_musb_vbus_id_status status)
238 {
239 struct omap2430_glue *glue = _glue;
240
241 if (!glue) {
242 pr_err("%s: musb core is not yet initialized\n", __func__);
243 return;
244 }
245 glue->status = status;
246
247 if (!glue_to_musb(glue)) {
248 pr_err("%s: musb core is not yet ready\n", __func__);
249 return;
250 }
251
252 schedule_work(&glue->omap_musb_mailbox_work);
253 }
254 EXPORT_SYMBOL_GPL(omap_musb_mailbox);
255
256 static void omap_musb_set_mailbox(struct omap2430_glue *glue)
257 {
258 struct musb *musb = glue_to_musb(glue);
259 struct device *dev = musb->controller;
260 struct musb_hdrc_platform_data *pdata = dev_get_platdata(dev);
261 struct omap_musb_board_data *data = pdata->board_data;
262 struct usb_otg *otg = musb->xceiv->otg;
263
264 switch (glue->status) {
265 case OMAP_MUSB_ID_GROUND:
266 dev_dbg(dev, "ID GND\n");
267
268 otg->default_a = true;
269 musb->xceiv->otg->state = OTG_STATE_A_IDLE;
270 musb->xceiv->last_event = USB_EVENT_ID;
271 if (musb->gadget_driver) {
272 pm_runtime_get_sync(dev);
273 omap_control_usb_set_mode(glue->control_otghs,
274 USB_MODE_HOST);
275 omap2430_musb_set_vbus(musb, 1);
276 }
277 break;
278
279 case OMAP_MUSB_VBUS_VALID:
280 dev_dbg(dev, "VBUS Connect\n");
281
282 otg->default_a = false;
283 musb->xceiv->otg->state = OTG_STATE_B_IDLE;
284 musb->xceiv->last_event = USB_EVENT_VBUS;
285 if (musb->gadget_driver)
286 pm_runtime_get_sync(dev);
287 omap_control_usb_set_mode(glue->control_otghs, USB_MODE_DEVICE);
288 break;
289
290 case OMAP_MUSB_ID_FLOAT:
291 case OMAP_MUSB_VBUS_OFF:
292 dev_dbg(dev, "VBUS Disconnect\n");
293
294 musb->xceiv->last_event = USB_EVENT_NONE;
295 if (musb->gadget_driver) {
296 omap2430_musb_set_vbus(musb, 0);
297 pm_runtime_mark_last_busy(dev);
298 pm_runtime_put_autosuspend(dev);
299 }
300
301 if (data->interface_type == MUSB_INTERFACE_UTMI)
302 otg_set_vbus(musb->xceiv->otg, 0);
303
304 omap_control_usb_set_mode(glue->control_otghs,
305 USB_MODE_DISCONNECT);
306 break;
307 default:
308 dev_dbg(dev, "ID float\n");
309 }
310
311 atomic_notifier_call_chain(&musb->xceiv->notifier,
312 musb->xceiv->last_event, NULL);
313 }
314
315
316 static void omap_musb_mailbox_work(struct work_struct *mailbox_work)
317 {
318 struct omap2430_glue *glue = container_of(mailbox_work,
319 struct omap2430_glue, omap_musb_mailbox_work);
320 struct musb *musb = glue_to_musb(glue);
321 struct device *dev = musb->controller;
322
323 pm_runtime_get_sync(dev);
324 omap_musb_set_mailbox(glue);
325 pm_runtime_mark_last_busy(dev);
326 pm_runtime_put_autosuspend(dev);
327 }
328
329 static irqreturn_t omap2430_musb_interrupt(int irq, void *__hci)
330 {
331 unsigned long flags;
332 irqreturn_t retval = IRQ_NONE;
333 struct musb *musb = __hci;
334
335 spin_lock_irqsave(&musb->lock, flags);
336
337 musb->int_usb = musb_readb(musb->mregs, MUSB_INTRUSB);
338 musb->int_tx = musb_readw(musb->mregs, MUSB_INTRTX);
339 musb->int_rx = musb_readw(musb->mregs, MUSB_INTRRX);
340
341 if (musb->int_usb || musb->int_tx || musb->int_rx)
342 retval = musb_interrupt(musb);
343
344 spin_unlock_irqrestore(&musb->lock, flags);
345
346 return retval;
347 }
348
349 static int omap2430_musb_init(struct musb *musb)
350 {
351 u32 l;
352 int status = 0;
353 struct device *dev = musb->controller;
354 struct omap2430_glue *glue = dev_get_drvdata(dev->parent);
355 struct musb_hdrc_platform_data *plat = dev_get_platdata(dev);
356 struct omap_musb_board_data *data = plat->board_data;
357
358 /* We require some kind of external transceiver, hooked
359 * up through ULPI. TWL4030-family PMICs include one,
360 * which needs a driver, drivers aren't always needed.
361 */
362 if (dev->parent->of_node) {
363 musb->phy = devm_phy_get(dev->parent, "usb2-phy");
364
365 /* We can't totally remove musb->xceiv as of now because
366 * musb core uses xceiv.state and xceiv.otg. Once we have
367 * a separate state machine to handle otg, these can be moved
368 * out of xceiv and then we can start using the generic PHY
369 * framework
370 */
371 musb->xceiv = devm_usb_get_phy_by_phandle(dev->parent,
372 "usb-phy", 0);
373 } else {
374 musb->xceiv = devm_usb_get_phy_dev(dev, 0);
375 musb->phy = devm_phy_get(dev, "usb");
376 }
377
378 if (IS_ERR(musb->xceiv)) {
379 status = PTR_ERR(musb->xceiv);
380
381 if (status == -ENXIO)
382 return status;
383
384 pr_err("HS USB OTG: no transceiver configured\n");
385 return -EPROBE_DEFER;
386 }
387
388 if (IS_ERR(musb->phy)) {
389 pr_err("HS USB OTG: no PHY configured\n");
390 return PTR_ERR(musb->phy);
391 }
392 musb->isr = omap2430_musb_interrupt;
393
394 /*
395 * Enable runtime PM for musb parent (this driver). We can't
396 * do it earlier as struct musb is not yet allocated and we
397 * need to touch the musb registers for runtime PM.
398 */
399 pm_runtime_enable(glue->dev);
400 status = pm_runtime_get_sync(glue->dev);
401 if (status < 0)
402 goto err1;
403
404 status = pm_runtime_get_sync(dev);
405 if (status < 0) {
406 dev_err(dev, "pm_runtime_get_sync FAILED %d\n", status);
407 pm_runtime_put_sync(glue->dev);
408 goto err1;
409 }
410
411 l = musb_readl(musb->mregs, OTG_INTERFSEL);
412
413 if (data->interface_type == MUSB_INTERFACE_UTMI) {
414 /* OMAP4 uses Internal PHY GS70 which uses UTMI interface */
415 l &= ~ULPI_12PIN; /* Disable ULPI */
416 l |= UTMI_8BIT; /* Enable UTMI */
417 } else {
418 l |= ULPI_12PIN;
419 }
420
421 musb_writel(musb->mregs, OTG_INTERFSEL, l);
422
423 pr_debug("HS USB OTG: revision 0x%x, sysconfig 0x%02x, "
424 "sysstatus 0x%x, intrfsel 0x%x, simenable 0x%x\n",
425 musb_readl(musb->mregs, OTG_REVISION),
426 musb_readl(musb->mregs, OTG_SYSCONFIG),
427 musb_readl(musb->mregs, OTG_SYSSTATUS),
428 musb_readl(musb->mregs, OTG_INTERFSEL),
429 musb_readl(musb->mregs, OTG_SIMENABLE));
430
431 setup_timer(&musb_idle_timer, musb_do_idle, (unsigned long) musb);
432
433 if (glue->status != OMAP_MUSB_UNKNOWN)
434 omap_musb_set_mailbox(glue);
435
436 phy_init(musb->phy);
437 phy_power_on(musb->phy);
438
439 pm_runtime_put_noidle(musb->controller);
440 pm_runtime_put_noidle(glue->dev);
441 return 0;
442
443 err1:
444 return status;
445 }
446
447 static void omap2430_musb_enable(struct musb *musb)
448 {
449 u8 devctl;
450 unsigned long timeout = jiffies + msecs_to_jiffies(1000);
451 struct device *dev = musb->controller;
452 struct omap2430_glue *glue = dev_get_drvdata(dev->parent);
453 struct musb_hdrc_platform_data *pdata = dev_get_platdata(dev);
454 struct omap_musb_board_data *data = pdata->board_data;
455
456 switch (glue->status) {
457
458 case OMAP_MUSB_ID_GROUND:
459 omap_control_usb_set_mode(glue->control_otghs, USB_MODE_HOST);
460 if (data->interface_type != MUSB_INTERFACE_UTMI)
461 break;
462 devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
463 /* start the session */
464 devctl |= MUSB_DEVCTL_SESSION;
465 musb_writeb(musb->mregs, MUSB_DEVCTL, devctl);
466 while (musb_readb(musb->mregs, MUSB_DEVCTL) &
467 MUSB_DEVCTL_BDEVICE) {
468 cpu_relax();
469
470 if (time_after(jiffies, timeout)) {
471 dev_err(dev, "configured as A device timeout");
472 break;
473 }
474 }
475 break;
476
477 case OMAP_MUSB_VBUS_VALID:
478 omap_control_usb_set_mode(glue->control_otghs, USB_MODE_DEVICE);
479 break;
480
481 default:
482 break;
483 }
484 }
485
486 static void omap2430_musb_disable(struct musb *musb)
487 {
488 struct device *dev = musb->controller;
489 struct omap2430_glue *glue = dev_get_drvdata(dev->parent);
490
491 if (glue->status != OMAP_MUSB_UNKNOWN)
492 omap_control_usb_set_mode(glue->control_otghs,
493 USB_MODE_DISCONNECT);
494 }
495
496 static int omap2430_musb_exit(struct musb *musb)
497 {
498 del_timer_sync(&musb_idle_timer);
499
500 omap2430_low_level_exit(musb);
501 phy_power_off(musb->phy);
502 phy_exit(musb->phy);
503
504 return 0;
505 }
506
507 static const struct musb_platform_ops omap2430_ops = {
508 .quirks = MUSB_DMA_INVENTRA,
509 #ifdef CONFIG_USB_INVENTRA_DMA
510 .dma_init = musbhs_dma_controller_create,
511 .dma_exit = musbhs_dma_controller_destroy,
512 #endif
513 .init = omap2430_musb_init,
514 .exit = omap2430_musb_exit,
515
516 .set_mode = omap2430_musb_set_mode,
517 .try_idle = omap2430_musb_try_idle,
518
519 .set_vbus = omap2430_musb_set_vbus,
520
521 .enable = omap2430_musb_enable,
522 .disable = omap2430_musb_disable,
523 };
524
525 static u64 omap2430_dmamask = DMA_BIT_MASK(32);
526
527 static int omap2430_probe(struct platform_device *pdev)
528 {
529 struct resource musb_resources[3];
530 struct musb_hdrc_platform_data *pdata = dev_get_platdata(&pdev->dev);
531 struct omap_musb_board_data *data;
532 struct platform_device *musb;
533 struct omap2430_glue *glue;
534 struct device_node *np = pdev->dev.of_node;
535 struct musb_hdrc_config *config;
536 int ret = -ENOMEM, val;
537
538 glue = devm_kzalloc(&pdev->dev, sizeof(*glue), GFP_KERNEL);
539 if (!glue)
540 goto err0;
541
542 musb = platform_device_alloc("musb-hdrc", PLATFORM_DEVID_AUTO);
543 if (!musb) {
544 dev_err(&pdev->dev, "failed to allocate musb device\n");
545 goto err0;
546 }
547
548 musb->dev.parent = &pdev->dev;
549 musb->dev.dma_mask = &omap2430_dmamask;
550 musb->dev.coherent_dma_mask = omap2430_dmamask;
551
552 glue->dev = &pdev->dev;
553 glue->musb = musb;
554 glue->status = OMAP_MUSB_UNKNOWN;
555 glue->control_otghs = ERR_PTR(-ENODEV);
556
557 if (np) {
558 struct device_node *control_node;
559 struct platform_device *control_pdev;
560
561 pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
562 if (!pdata)
563 goto err2;
564
565 data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL);
566 if (!data)
567 goto err2;
568
569 config = devm_kzalloc(&pdev->dev, sizeof(*config), GFP_KERNEL);
570 if (!config)
571 goto err2;
572
573 of_property_read_u32(np, "mode", (u32 *)&pdata->mode);
574 of_property_read_u32(np, "interface-type",
575 (u32 *)&data->interface_type);
576 of_property_read_u32(np, "num-eps", (u32 *)&config->num_eps);
577 of_property_read_u32(np, "ram-bits", (u32 *)&config->ram_bits);
578 of_property_read_u32(np, "power", (u32 *)&pdata->power);
579
580 ret = of_property_read_u32(np, "multipoint", &val);
581 if (!ret && val)
582 config->multipoint = true;
583
584 pdata->board_data = data;
585 pdata->config = config;
586
587 control_node = of_parse_phandle(np, "ctrl-module", 0);
588 if (control_node) {
589 control_pdev = of_find_device_by_node(control_node);
590 if (!control_pdev) {
591 dev_err(&pdev->dev, "Failed to get control device\n");
592 ret = -EINVAL;
593 goto err2;
594 }
595 glue->control_otghs = &control_pdev->dev;
596 }
597 }
598 pdata->platform_ops = &omap2430_ops;
599
600 platform_set_drvdata(pdev, glue);
601
602 /*
603 * REVISIT if we ever have two instances of the wrapper, we will be
604 * in big trouble
605 */
606 _glue = glue;
607
608 INIT_WORK(&glue->omap_musb_mailbox_work, omap_musb_mailbox_work);
609
610 memset(musb_resources, 0x00, sizeof(*musb_resources) *
611 ARRAY_SIZE(musb_resources));
612
613 musb_resources[0].name = pdev->resource[0].name;
614 musb_resources[0].start = pdev->resource[0].start;
615 musb_resources[0].end = pdev->resource[0].end;
616 musb_resources[0].flags = pdev->resource[0].flags;
617
618 musb_resources[1].name = pdev->resource[1].name;
619 musb_resources[1].start = pdev->resource[1].start;
620 musb_resources[1].end = pdev->resource[1].end;
621 musb_resources[1].flags = pdev->resource[1].flags;
622
623 musb_resources[2].name = pdev->resource[2].name;
624 musb_resources[2].start = pdev->resource[2].start;
625 musb_resources[2].end = pdev->resource[2].end;
626 musb_resources[2].flags = pdev->resource[2].flags;
627
628 ret = platform_device_add_resources(musb, musb_resources,
629 ARRAY_SIZE(musb_resources));
630 if (ret) {
631 dev_err(&pdev->dev, "failed to add resources\n");
632 goto err2;
633 }
634
635 ret = platform_device_add_data(musb, pdata, sizeof(*pdata));
636 if (ret) {
637 dev_err(&pdev->dev, "failed to add platform_data\n");
638 goto err2;
639 }
640
641 /*
642 * Note that we cannot enable PM runtime yet for this
643 * driver as we need struct musb initialized first.
644 * See omap2430_musb_init above.
645 */
646
647 ret = platform_device_add(musb);
648 if (ret) {
649 dev_err(&pdev->dev, "failed to register musb device\n");
650 goto err2;
651 }
652
653 return 0;
654
655 err2:
656 platform_device_put(musb);
657
658 err0:
659 return ret;
660 }
661
662 static int omap2430_remove(struct platform_device *pdev)
663 {
664 struct omap2430_glue *glue = platform_get_drvdata(pdev);
665
666 cancel_work_sync(&glue->omap_musb_mailbox_work);
667 platform_device_unregister(glue->musb);
668
669 return 0;
670 }
671
672 #ifdef CONFIG_PM
673
674 static int omap2430_runtime_suspend(struct device *dev)
675 {
676 struct omap2430_glue *glue = dev_get_drvdata(dev);
677 struct musb *musb = glue_to_musb(glue);
678
679 if (musb) {
680 musb->context.otg_interfsel = musb_readl(musb->mregs,
681 OTG_INTERFSEL);
682
683 omap2430_low_level_exit(musb);
684 }
685
686 return 0;
687 }
688
689 static int omap2430_runtime_resume(struct device *dev)
690 {
691 struct omap2430_glue *glue = dev_get_drvdata(dev);
692 struct musb *musb = glue_to_musb(glue);
693
694 if (!musb)
695 return -EPROBE_DEFER;
696
697 omap2430_low_level_init(musb);
698 musb_writel(musb->mregs, OTG_INTERFSEL,
699 musb->context.otg_interfsel);
700
701 return 0;
702 }
703
704 static struct dev_pm_ops omap2430_pm_ops = {
705 .runtime_suspend = omap2430_runtime_suspend,
706 .runtime_resume = omap2430_runtime_resume,
707 };
708
709 #define DEV_PM_OPS (&omap2430_pm_ops)
710 #else
711 #define DEV_PM_OPS NULL
712 #endif
713
714 #ifdef CONFIG_OF
715 static const struct of_device_id omap2430_id_table[] = {
716 {
717 .compatible = "ti,omap4-musb"
718 },
719 {
720 .compatible = "ti,omap3-musb"
721 },
722 {},
723 };
724 MODULE_DEVICE_TABLE(of, omap2430_id_table);
725 #endif
726
727 static struct platform_driver omap2430_driver = {
728 .probe = omap2430_probe,
729 .remove = omap2430_remove,
730 .driver = {
731 .name = "musb-omap2430",
732 .pm = DEV_PM_OPS,
733 .of_match_table = of_match_ptr(omap2430_id_table),
734 },
735 };
736
737 MODULE_DESCRIPTION("OMAP2PLUS MUSB Glue Layer");
738 MODULE_AUTHOR("Felipe Balbi <balbi@ti.com>");
739 MODULE_LICENSE("GPL v2");
740
741 static int __init omap2430_init(void)
742 {
743 return platform_driver_register(&omap2430_driver);
744 }
745 subsys_initcall(omap2430_init);
746
747 static void __exit omap2430_exit(void)
748 {
749 platform_driver_unregister(&omap2430_driver);
750 }
751 module_exit(omap2430_exit);
Linux with added FPC-III support