Linux Audio

Check our new training course

Loading...
v3.1
  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/clk.h>
 33#include <linux/io.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
 39#include "musb_core.h"
 40#include "omap2430.h"
 41
 42struct omap2430_glue {
 43	struct device		*dev;
 44	struct platform_device	*musb;
 45};
 46#define glue_to_musb(g)		platform_get_drvdata(g->musb)
 47
 48static struct timer_list musb_idle_timer;
 49
 50static void musb_do_idle(unsigned long _musb)
 51{
 52	struct musb	*musb = (void *)_musb;
 53	unsigned long	flags;
 54	u8	power;
 55	u8	devctl;
 56
 57	spin_lock_irqsave(&musb->lock, flags);
 58
 59	switch (musb->xceiv->state) {
 60	case OTG_STATE_A_WAIT_BCON:
 61
 62		devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
 63		if (devctl & MUSB_DEVCTL_BDEVICE) {
 64			musb->xceiv->state = OTG_STATE_B_IDLE;
 65			MUSB_DEV_MODE(musb);
 66		} else {
 67			musb->xceiv->state = OTG_STATE_A_IDLE;
 68			MUSB_HST_MODE(musb);
 69		}
 70		break;
 71	case OTG_STATE_A_SUSPEND:
 72		/* finish RESUME signaling? */
 73		if (musb->port1_status & MUSB_PORT_STAT_RESUME) {
 74			power = musb_readb(musb->mregs, MUSB_POWER);
 75			power &= ~MUSB_POWER_RESUME;
 76			dev_dbg(musb->controller, "root port resume stopped, power %02x\n", power);
 77			musb_writeb(musb->mregs, MUSB_POWER, power);
 78			musb->is_active = 1;
 79			musb->port1_status &= ~(USB_PORT_STAT_SUSPEND
 80						| MUSB_PORT_STAT_RESUME);
 81			musb->port1_status |= USB_PORT_STAT_C_SUSPEND << 16;
 82			usb_hcd_poll_rh_status(musb_to_hcd(musb));
 83			/* NOTE: it might really be A_WAIT_BCON ... */
 84			musb->xceiv->state = OTG_STATE_A_HOST;
 85		}
 86		break;
 87	case OTG_STATE_A_HOST:
 88		devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
 89		if (devctl &  MUSB_DEVCTL_BDEVICE)
 90			musb->xceiv->state = OTG_STATE_B_IDLE;
 91		else
 92			musb->xceiv->state = OTG_STATE_A_WAIT_BCON;
 93	default:
 94		break;
 95	}
 96	spin_unlock_irqrestore(&musb->lock, flags);
 97}
 98
 99
100static void omap2430_musb_try_idle(struct musb *musb, unsigned long timeout)
101{
102	unsigned long		default_timeout = jiffies + msecs_to_jiffies(3);
103	static unsigned long	last_timer;
104
105	if (timeout == 0)
106		timeout = default_timeout;
107
108	/* Never idle if active, or when VBUS timeout is not set as host */
109	if (musb->is_active || ((musb->a_wait_bcon == 0)
110			&& (musb->xceiv->state == OTG_STATE_A_WAIT_BCON))) {
111		dev_dbg(musb->controller, "%s active, deleting timer\n",
112			otg_state_string(musb->xceiv->state));
113		del_timer(&musb_idle_timer);
114		last_timer = jiffies;
115		return;
116	}
117
118	if (time_after(last_timer, timeout)) {
119		if (!timer_pending(&musb_idle_timer))
120			last_timer = timeout;
121		else {
122			dev_dbg(musb->controller, "Longer idle timer already pending, ignoring\n");
123			return;
124		}
125	}
126	last_timer = timeout;
127
128	dev_dbg(musb->controller, "%s inactive, for idle timer for %lu ms\n",
129		otg_state_string(musb->xceiv->state),
130		(unsigned long)jiffies_to_msecs(timeout - jiffies));
131	mod_timer(&musb_idle_timer, timeout);
132}
133
134static void omap2430_musb_set_vbus(struct musb *musb, int is_on)
135{
 
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 && musb->xceiv->set_vbus)
168				otg_set_vbus(musb->xceiv, 1);
169		} else {
170			musb->is_active = 1;
171			musb->xceiv->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		musb->xceiv->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
197static 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
207static 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
217static 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/* blocking notifier support */
227static int musb_otg_notifications(struct notifier_block *nb,
228		unsigned long event, void *unused)
229{
230	struct musb	*musb = container_of(nb, struct musb, nb);
 
 
 
 
 
 
 
 
 
 
231	struct device *dev = musb->controller;
232	struct musb_hdrc_platform_data *pdata = dev->platform_data;
233	struct omap_musb_board_data *data = pdata->board_data;
234
235	switch (event) {
236	case USB_EVENT_ID:
237		dev_dbg(musb->controller, "ID GND\n");
238
239		if (is_otg_enabled(musb)) {
240			if (musb->gadget_driver) {
241				pm_runtime_get_sync(musb->controller);
242				otg_init(musb->xceiv);
243				omap2430_musb_set_vbus(musb, 1);
244			}
245		} else {
246			pm_runtime_get_sync(musb->controller);
247			otg_init(musb->xceiv);
248			omap2430_musb_set_vbus(musb, 1);
249		}
250		break;
251
252	case USB_EVENT_VBUS:
253		dev_dbg(musb->controller, "VBUS Connect\n");
254
255		if (musb->gadget_driver)
256			pm_runtime_get_sync(musb->controller);
257		otg_init(musb->xceiv);
258		break;
259
260	case USB_EVENT_NONE:
261		dev_dbg(musb->controller, "VBUS Disconnect\n");
262
263		if (is_otg_enabled(musb) || is_peripheral_enabled(musb))
264			if (musb->gadget_driver) {
265				pm_runtime_mark_last_busy(musb->controller);
266				pm_runtime_put_autosuspend(musb->controller);
267			}
268
269		if (data->interface_type == MUSB_INTERFACE_UTMI) {
270			if (musb->xceiv->set_vbus)
271				otg_set_vbus(musb->xceiv, 0);
272		}
273		otg_shutdown(musb->xceiv);
274		break;
275	default:
276		dev_dbg(musb->controller, "ID float\n");
277		return NOTIFY_DONE;
278	}
279
280	return NOTIFY_OK;
281}
282
283static 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 = otg_get_transceiver();
295	if (!musb->xceiv) {
296		pr_err("HS USB OTG: no transceiver configured\n");
297		return -ENODEV;
298	}
299
 
 
300	status = pm_runtime_get_sync(dev);
301	if (status < 0) {
302		dev_err(dev, "pm_runtime_get_sync FAILED");
303		goto err1;
304	}
305
306	l = musb_readl(musb->mregs, OTG_INTERFSEL);
307
308	if (data->interface_type == MUSB_INTERFACE_UTMI) {
309		/* OMAP4 uses Internal PHY GS70 which uses UTMI interface */
310		l &= ~ULPI_12PIN;       /* Disable ULPI */
311		l |= UTMI_8BIT;         /* Enable UTMI  */
312	} else {
313		l |= ULPI_12PIN;
314	}
315
316	musb_writel(musb->mregs, OTG_INTERFSEL, l);
317
318	pr_debug("HS USB OTG: revision 0x%x, sysconfig 0x%02x, "
319			"sysstatus 0x%x, intrfsel 0x%x, simenable  0x%x\n",
320			musb_readl(musb->mregs, OTG_REVISION),
321			musb_readl(musb->mregs, OTG_SYSCONFIG),
322			musb_readl(musb->mregs, OTG_SYSSTATUS),
323			musb_readl(musb->mregs, OTG_INTERFSEL),
324			musb_readl(musb->mregs, OTG_SIMENABLE));
325
326	musb->nb.notifier_call = musb_otg_notifications;
327	status = otg_register_notifier(musb->xceiv, &musb->nb);
328
329	if (status)
330		dev_dbg(musb->controller, "notification register failed\n");
331
332	setup_timer(&musb_idle_timer, musb_do_idle, (unsigned long) musb);
333
 
334	return 0;
335
336err1:
337	pm_runtime_disable(dev);
338	return status;
339}
340
341static void omap2430_musb_enable(struct musb *musb)
342{
343	u8		devctl;
344	unsigned long timeout = jiffies + msecs_to_jiffies(1000);
345	struct device *dev = musb->controller;
346	struct musb_hdrc_platform_data *pdata = dev->platform_data;
347	struct omap_musb_board_data *data = pdata->board_data;
348
349	switch (musb->xceiv->last_event) {
350
351	case USB_EVENT_ID:
352		otg_init(musb->xceiv);
353		if (data->interface_type == MUSB_INTERFACE_UTMI) {
354			devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
355			/* start the session */
356			devctl |= MUSB_DEVCTL_SESSION;
357			musb_writeb(musb->mregs, MUSB_DEVCTL, devctl);
358			while (musb_readb(musb->mregs, MUSB_DEVCTL) &
359						MUSB_DEVCTL_BDEVICE) {
360				cpu_relax();
361
362				if (time_after(jiffies, timeout)) {
363					dev_err(musb->controller,
364					"configured as A device timeout");
365					break;
366				}
367			}
368		}
369		break;
370
371	case USB_EVENT_VBUS:
372		otg_init(musb->xceiv);
373		break;
374
375	default:
376		break;
377	}
378}
379
380static void omap2430_musb_disable(struct musb *musb)
381{
382	if (musb->xceiv->last_event)
383		otg_shutdown(musb->xceiv);
384}
385
386static int omap2430_musb_exit(struct musb *musb)
387{
388	del_timer_sync(&musb_idle_timer);
 
389
390	omap2430_low_level_exit(musb);
391	otg_put_transceiver(musb->xceiv);
392
393	return 0;
394}
395
396static const struct musb_platform_ops omap2430_ops = {
397	.init		= omap2430_musb_init,
398	.exit		= omap2430_musb_exit,
399
400	.set_mode	= omap2430_musb_set_mode,
401	.try_idle	= omap2430_musb_try_idle,
402
403	.set_vbus	= omap2430_musb_set_vbus,
404
405	.enable		= omap2430_musb_enable,
406	.disable	= omap2430_musb_disable,
407};
408
409static u64 omap2430_dmamask = DMA_BIT_MASK(32);
410
411static int __init omap2430_probe(struct platform_device *pdev)
412{
413	struct musb_hdrc_platform_data	*pdata = pdev->dev.platform_data;
414	struct platform_device		*musb;
415	struct omap2430_glue		*glue;
416	int				ret = -ENOMEM;
417
418	glue = kzalloc(sizeof(*glue), GFP_KERNEL);
419	if (!glue) {
420		dev_err(&pdev->dev, "failed to allocate glue context\n");
421		goto err0;
422	}
423
424	musb = platform_device_alloc("musb-hdrc", -1);
425	if (!musb) {
426		dev_err(&pdev->dev, "failed to allocate musb device\n");
427		goto err1;
428	}
429
430	musb->dev.parent		= &pdev->dev;
431	musb->dev.dma_mask		= &omap2430_dmamask;
432	musb->dev.coherent_dma_mask	= omap2430_dmamask;
433
434	glue->dev			= &pdev->dev;
435	glue->musb			= musb;
436
437	pdata->platform_ops		= &omap2430_ops;
438
439	platform_set_drvdata(pdev, glue);
440
441	ret = platform_device_add_resources(musb, pdev->resource,
442			pdev->num_resources);
443	if (ret) {
444		dev_err(&pdev->dev, "failed to add resources\n");
445		goto err2;
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	ret = platform_device_add(musb);
455	if (ret) {
456		dev_err(&pdev->dev, "failed to register musb device\n");
457		goto err2;
458	}
459
460	pm_runtime_enable(&pdev->dev);
461
462	return 0;
463
464err2:
465	platform_device_put(musb);
466
467err1:
468	kfree(glue);
469
470err0:
471	return ret;
472}
473
474static int __exit omap2430_remove(struct platform_device *pdev)
475{
476	struct omap2430_glue		*glue = platform_get_drvdata(pdev);
477
478	platform_device_del(glue->musb);
479	platform_device_put(glue->musb);
480	pm_runtime_put(&pdev->dev);
481	pm_runtime_disable(&pdev->dev);
482	kfree(glue);
483
484	return 0;
485}
486
487#ifdef CONFIG_PM
488
489static 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	omap2430_low_level_exit(musb);
495	otg_set_suspend(musb->xceiv, 1);
 
 
 
 
 
496
497	return 0;
498}
499
500static int omap2430_runtime_resume(struct device *dev)
501{
502	struct omap2430_glue		*glue = dev_get_drvdata(dev);
503	struct musb			*musb = glue_to_musb(glue);
504
505	omap2430_low_level_init(musb);
506	otg_set_suspend(musb->xceiv, 0);
 
 
 
 
 
507
508	return 0;
509}
510
511static struct dev_pm_ops omap2430_pm_ops = {
512	.runtime_suspend = omap2430_runtime_suspend,
513	.runtime_resume = omap2430_runtime_resume,
514};
515
516#define DEV_PM_OPS	(&omap2430_pm_ops)
517#else
518#define DEV_PM_OPS	NULL
519#endif
520
521static struct platform_driver omap2430_driver = {
522	.remove		= __exit_p(omap2430_remove),
 
523	.driver		= {
524		.name	= "musb-omap2430",
525		.pm	= DEV_PM_OPS,
526	},
527};
528
529MODULE_DESCRIPTION("OMAP2PLUS MUSB Glue Layer");
530MODULE_AUTHOR("Felipe Balbi <balbi@ti.com>");
531MODULE_LICENSE("GPL v2");
532
533static int __init omap2430_init(void)
534{
535	return platform_driver_probe(&omap2430_driver, omap2430_probe);
536}
537subsys_initcall(omap2430_init);
538
539static void __exit omap2430_exit(void)
540{
541	platform_driver_unregister(&omap2430_driver);
542}
543module_exit(omap2430_exit);
v3.5.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/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
 41struct omap2430_glue {
 42	struct device		*dev;
 43	struct platform_device	*musb;
 44};
 45#define glue_to_musb(g)		platform_get_drvdata(g->musb)
 46
 47static struct timer_list musb_idle_timer;
 48
 49static 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
 99static 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
133static 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
197static 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
207static 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
217static 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
 
226static 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
237static 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
283static int omap2430_musb_init(struct musb *musb)
284{
285	u32 l;
286	int status = 0;
287	struct device *dev = musb->controller;
288	struct musb_hdrc_platform_data *plat = dev->platform_data;
289	struct omap_musb_board_data *data = plat->board_data;
290
291	/* We require some kind of external transceiver, hooked
292	 * up through ULPI.  TWL4030-family PMICs include one,
293	 * which needs a driver, drivers aren't always needed.
294	 */
295	musb->xceiv = usb_get_transceiver();
296	if (!musb->xceiv) {
297		pr_err("HS USB OTG: no transceiver configured\n");
298		return -ENODEV;
299	}
300
301	INIT_WORK(&musb->otg_notifier_work, musb_otg_notifier_work);
302
303	status = pm_runtime_get_sync(dev);
304	if (status < 0) {
305		dev_err(dev, "pm_runtime_get_sync FAILED %d\n", status);
306		goto err1;
307	}
308
309	l = musb_readl(musb->mregs, OTG_INTERFSEL);
310
311	if (data->interface_type == MUSB_INTERFACE_UTMI) {
312		/* OMAP4 uses Internal PHY GS70 which uses UTMI interface */
313		l &= ~ULPI_12PIN;       /* Disable ULPI */
314		l |= UTMI_8BIT;         /* Enable UTMI  */
315	} else {
316		l |= ULPI_12PIN;
317	}
318
319	musb_writel(musb->mregs, OTG_INTERFSEL, l);
320
321	pr_debug("HS USB OTG: revision 0x%x, sysconfig 0x%02x, "
322			"sysstatus 0x%x, intrfsel 0x%x, simenable  0x%x\n",
323			musb_readl(musb->mregs, OTG_REVISION),
324			musb_readl(musb->mregs, OTG_SYSCONFIG),
325			musb_readl(musb->mregs, OTG_SYSSTATUS),
326			musb_readl(musb->mregs, OTG_INTERFSEL),
327			musb_readl(musb->mregs, OTG_SIMENABLE));
328
329	musb->nb.notifier_call = musb_otg_notifications;
330	status = usb_register_notifier(musb->xceiv, &musb->nb);
331
332	if (status)
333		dev_dbg(musb->controller, "notification register failed\n");
334
335	setup_timer(&musb_idle_timer, musb_do_idle, (unsigned long) musb);
336
337	pm_runtime_put_noidle(musb->controller);
338	return 0;
339
340err1:
 
341	return status;
342}
343
344static void omap2430_musb_enable(struct musb *musb)
345{
346	u8		devctl;
347	unsigned long timeout = jiffies + msecs_to_jiffies(1000);
348	struct device *dev = musb->controller;
349	struct musb_hdrc_platform_data *pdata = dev->platform_data;
350	struct omap_musb_board_data *data = pdata->board_data;
351
352	switch (musb->xceiv->last_event) {
353
354	case USB_EVENT_ID:
355		usb_phy_init(musb->xceiv);
356		if (data->interface_type != MUSB_INTERFACE_UTMI)
357			break;
358		devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
359		/* start the session */
360		devctl |= MUSB_DEVCTL_SESSION;
361		musb_writeb(musb->mregs, MUSB_DEVCTL, devctl);
362		while (musb_readb(musb->mregs, MUSB_DEVCTL) &
363				MUSB_DEVCTL_BDEVICE) {
364			cpu_relax();
365
366			if (time_after(jiffies, timeout)) {
367				dev_err(dev, "configured as A device timeout");
368				break;
 
369			}
370		}
371		break;
372
373	case USB_EVENT_VBUS:
374		usb_phy_init(musb->xceiv);
375		break;
376
377	default:
378		break;
379	}
380}
381
382static void omap2430_musb_disable(struct musb *musb)
383{
384	if (musb->xceiv->last_event)
385		usb_phy_shutdown(musb->xceiv);
386}
387
388static int omap2430_musb_exit(struct musb *musb)
389{
390	del_timer_sync(&musb_idle_timer);
391	cancel_work_sync(&musb->otg_notifier_work);
392
393	omap2430_low_level_exit(musb);
394	usb_put_transceiver(musb->xceiv);
395
396	return 0;
397}
398
399static const struct musb_platform_ops omap2430_ops = {
400	.init		= omap2430_musb_init,
401	.exit		= omap2430_musb_exit,
402
403	.set_mode	= omap2430_musb_set_mode,
404	.try_idle	= omap2430_musb_try_idle,
405
406	.set_vbus	= omap2430_musb_set_vbus,
407
408	.enable		= omap2430_musb_enable,
409	.disable	= omap2430_musb_disable,
410};
411
412static u64 omap2430_dmamask = DMA_BIT_MASK(32);
413
414static int __devinit omap2430_probe(struct platform_device *pdev)
415{
416	struct musb_hdrc_platform_data	*pdata = pdev->dev.platform_data;
417	struct platform_device		*musb;
418	struct omap2430_glue		*glue;
419	int				ret = -ENOMEM;
420
421	glue = kzalloc(sizeof(*glue), GFP_KERNEL);
422	if (!glue) {
423		dev_err(&pdev->dev, "failed to allocate glue context\n");
424		goto err0;
425	}
426
427	musb = platform_device_alloc("musb-hdrc", -1);
428	if (!musb) {
429		dev_err(&pdev->dev, "failed to allocate musb device\n");
430		goto err1;
431	}
432
433	musb->dev.parent		= &pdev->dev;
434	musb->dev.dma_mask		= &omap2430_dmamask;
435	musb->dev.coherent_dma_mask	= omap2430_dmamask;
436
437	glue->dev			= &pdev->dev;
438	glue->musb			= musb;
439
440	pdata->platform_ops		= &omap2430_ops;
441
442	platform_set_drvdata(pdev, glue);
443
444	ret = platform_device_add_resources(musb, pdev->resource,
445			pdev->num_resources);
446	if (ret) {
447		dev_err(&pdev->dev, "failed to add resources\n");
448		goto err2;
449	}
450
451	ret = platform_device_add_data(musb, pdata, sizeof(*pdata));
452	if (ret) {
453		dev_err(&pdev->dev, "failed to add platform_data\n");
454		goto err2;
455	}
456
457	pm_runtime_enable(&pdev->dev);
458
459	ret = platform_device_add(musb);
460	if (ret) {
461		dev_err(&pdev->dev, "failed to register musb device\n");
462		goto err2;
463	}
464
 
 
465	return 0;
466
467err2:
468	platform_device_put(musb);
469
470err1:
471	kfree(glue);
472
473err0:
474	return ret;
475}
476
477static int __devexit omap2430_remove(struct platform_device *pdev)
478{
479	struct omap2430_glue		*glue = platform_get_drvdata(pdev);
480
481	platform_device_del(glue->musb);
482	platform_device_put(glue->musb);
 
 
483	kfree(glue);
484
485	return 0;
486}
487
488#ifdef CONFIG_PM
489
490static int omap2430_runtime_suspend(struct device *dev)
491{
492	struct omap2430_glue		*glue = dev_get_drvdata(dev);
493	struct musb			*musb = glue_to_musb(glue);
494
495	if (musb) {
496		musb->context.otg_interfsel = musb_readl(musb->mregs,
497				OTG_INTERFSEL);
498
499		omap2430_low_level_exit(musb);
500		usb_phy_set_suspend(musb->xceiv, 1);
501	}
502
503	return 0;
504}
505
506static int omap2430_runtime_resume(struct device *dev)
507{
508	struct omap2430_glue		*glue = dev_get_drvdata(dev);
509	struct musb			*musb = glue_to_musb(glue);
510
511	if (musb) {
512		omap2430_low_level_init(musb);
513		musb_writel(musb->mregs, OTG_INTERFSEL,
514				musb->context.otg_interfsel);
515
516		usb_phy_set_suspend(musb->xceiv, 0);
517	}
518
519	return 0;
520}
521
522static struct dev_pm_ops omap2430_pm_ops = {
523	.runtime_suspend = omap2430_runtime_suspend,
524	.runtime_resume = omap2430_runtime_resume,
525};
526
527#define DEV_PM_OPS	(&omap2430_pm_ops)
528#else
529#define DEV_PM_OPS	NULL
530#endif
531
532static struct platform_driver omap2430_driver = {
533	.probe		= omap2430_probe,
534	.remove		= __devexit_p(omap2430_remove),
535	.driver		= {
536		.name	= "musb-omap2430",
537		.pm	= DEV_PM_OPS,
538	},
539};
540
541MODULE_DESCRIPTION("OMAP2PLUS MUSB Glue Layer");
542MODULE_AUTHOR("Felipe Balbi <balbi@ti.com>");
543MODULE_LICENSE("GPL v2");
544
545static int __init omap2430_init(void)
546{
547	return platform_driver_register(&omap2430_driver);
548}
549module_init(omap2430_init);
550
551static void __exit omap2430_exit(void)
552{
553	platform_driver_unregister(&omap2430_driver);
554}
555module_exit(omap2430_exit);