Linux Audio

Check our new training course

Loading...
v6.13.7
  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		= 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");
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);