xref: /linux/drivers/usb/musb/omap2430.c (revision ca55b2fef3a9373fcfc30f82fd26bc7fccbda732)
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);
752