Linux Audio

Check our new training course

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