[linux-2.6-block.git] / drivers / usb / musb / omap2430.c

/*
 * Copyright (C) 2005-2007 by Texas Instruments
 * Some code has been taken from tusb6010.c
 * Copyrights for that are attributable to:
 * Copyright (C) 2006 Nokia Corporation
 * Tony Lindgren <tony@atomide.com>
 *
 * This file is part of the Inventra Controller Driver for Linux.
 *
 * The Inventra Controller Driver for Linux is free software; you
 * can redistribute it and/or modify it under the terms of the GNU
 * General Public License version 2 as published by the Free Software
 * Foundation.
 *
 * The Inventra Controller Driver for Linux is distributed in
 * the hope that it will be useful, but WITHOUT ANY WARRANTY;
 * without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public
 * License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with The Inventra Controller Driver for Linux ; if not,
 * write to the Free Software Foundation, Inc., 59 Temple Place,
 * Suite 330, Boston, MA  02111-1307  USA
 *
 */
#include <linux/module.h>
#include <linux/kernel.h>
#include <linux/sched.h>
#include <linux/init.h>
#include <linux/list.h>
#include <linux/clk.h>
#include <linux/io.h>
#include <linux/platform_device.h>
#include <linux/dma-mapping.h>

#include "musb_core.h"
#include "omap2430.h"

struct omap2430_glue {
	struct device		*dev;
	struct platform_device	*musb;
	struct clk		*clk;
};
#define glue_to_musb(g)		platform_get_drvdata(g->musb)

static struct timer_list musb_idle_timer;

static void musb_do_idle(unsigned long _musb)
{
	struct musb	*musb = (void *)_musb;
	unsigned long	flags;
#ifdef CONFIG_USB_MUSB_HDRC_HCD
	u8	power;
#endif
	u8	devctl;

	spin_lock_irqsave(&musb->lock, flags);

	switch (musb->xceiv->state) {
	case OTG_STATE_A_WAIT_BCON:

		devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
		if (devctl & MUSB_DEVCTL_BDEVICE) {
			musb->xceiv->state = OTG_STATE_B_IDLE;
			MUSB_DEV_MODE(musb);
		} else {
			musb->xceiv->state = OTG_STATE_A_IDLE;
			MUSB_HST_MODE(musb);
		}
		break;
#ifdef CONFIG_USB_MUSB_HDRC_HCD
	case OTG_STATE_A_SUSPEND:
		/* finish RESUME signaling? */
		if (musb->port1_status & MUSB_PORT_STAT_RESUME) {
			power = musb_readb(musb->mregs, MUSB_POWER);
			power &= ~MUSB_POWER_RESUME;
			DBG(1, "root port resume stopped, power %02x\n", power);
			musb_writeb(musb->mregs, MUSB_POWER, power);
			musb->is_active = 1;
			musb->port1_status &= ~(USB_PORT_STAT_SUSPEND
						| MUSB_PORT_STAT_RESUME);
			musb->port1_status |= USB_PORT_STAT_C_SUSPEND << 16;
			usb_hcd_poll_rh_status(musb_to_hcd(musb));
			/* NOTE: it might really be A_WAIT_BCON ... */
			musb->xceiv->state = OTG_STATE_A_HOST;
		}
		break;
#endif
#ifdef CONFIG_USB_MUSB_HDRC_HCD
	case OTG_STATE_A_HOST:
		devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
		if (devctl &  MUSB_DEVCTL_BDEVICE)
			musb->xceiv->state = OTG_STATE_B_IDLE;
		else
			musb->xceiv->state = OTG_STATE_A_WAIT_BCON;
#endif
	default:
		break;
	}
	spin_unlock_irqrestore(&musb->lock, flags);
}


static void omap2430_musb_try_idle(struct musb *musb, unsigned long timeout)
{
	unsigned long		default_timeout = jiffies + msecs_to_jiffies(3);
	static unsigned long	last_timer;

	if (timeout == 0)
		timeout = default_timeout;

	/* Never idle if active, or when VBUS timeout is not set as host */
	if (musb->is_active || ((musb->a_wait_bcon == 0)
			&& (musb->xceiv->state == OTG_STATE_A_WAIT_BCON))) {
		DBG(4, "%s active, deleting timer\n", otg_state_string(musb));
		del_timer(&musb_idle_timer);
		last_timer = jiffies;
		return;
	}

	if (time_after(last_timer, timeout)) {
		if (!timer_pending(&musb_idle_timer))
			last_timer = timeout;
		else {
			DBG(4, "Longer idle timer already pending, ignoring\n");
			return;
		}
	}
	last_timer = timeout;

	DBG(4, "%s inactive, for idle timer for %lu ms\n",
		otg_state_string(musb),
		(unsigned long)jiffies_to_msecs(timeout - jiffies));
	mod_timer(&musb_idle_timer, timeout);
}

static void omap2430_musb_set_vbus(struct musb *musb, int is_on)
{
	u8		devctl;
	unsigned long timeout = jiffies + msecs_to_jiffies(1000);
	int ret = 1;
	/* HDRC controls CPEN, but beware current surges during device
	 * connect.  They can trigger transient overcurrent conditions
	 * that must be ignored.
	 */

	devctl = musb_readb(musb->mregs, MUSB_DEVCTL);

	if (is_on) {
		if (musb->xceiv->state == OTG_STATE_A_IDLE) {
			/* start the session */
			devctl |= MUSB_DEVCTL_SESSION;
			musb_writeb(musb->mregs, MUSB_DEVCTL, devctl);
			/*
			 * Wait for the musb to set as A device to enable the
			 * VBUS
			 */
			while (musb_readb(musb->mregs, MUSB_DEVCTL) & 0x80) {

				cpu_relax();

				if (time_after(jiffies, timeout)) {
					dev_err(musb->controller,
					"configured as A device timeout");
					ret = -EINVAL;
					break;
				}
			}

			if (ret && musb->xceiv->set_vbus)
				otg_set_vbus(musb->xceiv, 1);
		} else {
			musb->is_active = 1;
			musb->xceiv->default_a = 1;
			musb->xceiv->state = OTG_STATE_A_WAIT_VRISE;
			devctl |= MUSB_DEVCTL_SESSION;
			MUSB_HST_MODE(musb);
		}
	} else {
		musb->is_active = 0;

		/* NOTE:  we're skipping A_WAIT_VFALL -> A_IDLE and
		 * jumping right to B_IDLE...
		 */

		musb->xceiv->default_a = 0;
		musb->xceiv->state = OTG_STATE_B_IDLE;
		devctl &= ~MUSB_DEVCTL_SESSION;

		MUSB_DEV_MODE(musb);
	}
	musb_writeb(musb->mregs, MUSB_DEVCTL, devctl);

	DBG(1, "VBUS %s, devctl %02x "
		/* otg %3x conf %08x prcm %08x */ "\n",
		otg_state_string(musb),
		musb_readb(musb->mregs, MUSB_DEVCTL));
}

static int omap2430_musb_set_mode(struct musb *musb, u8 musb_mode)
{
	u8	devctl = musb_readb(musb->mregs, MUSB_DEVCTL);

	devctl |= MUSB_DEVCTL_SESSION;
	musb_writeb(musb->mregs, MUSB_DEVCTL, devctl);

	return 0;
}

static inline void omap2430_low_level_exit(struct musb *musb)
{
	u32 l;

	/* in any role */
	l = musb_readl(musb->mregs, OTG_FORCESTDBY);
	l |= ENABLEFORCE;	/* enable MSTANDBY */
	musb_writel(musb->mregs, OTG_FORCESTDBY, l);

	l = musb_readl(musb->mregs, OTG_SYSCONFIG);
	l |= ENABLEWAKEUP;	/* enable wakeup */
	musb_writel(musb->mregs, OTG_SYSCONFIG, l);
}

static inline void omap2430_low_level_init(struct musb *musb)
{
	u32 l;

	l = musb_readl(musb->mregs, OTG_SYSCONFIG);
	l &= ~ENABLEWAKEUP;	/* disable wakeup */
	musb_writel(musb->mregs, OTG_SYSCONFIG, l);

	l = musb_readl(musb->mregs, OTG_FORCESTDBY);
	l &= ~ENABLEFORCE;	/* disable MSTANDBY */
	musb_writel(musb->mregs, OTG_FORCESTDBY, l);
}

/* blocking notifier support */
static int musb_otg_notifications(struct notifier_block *nb,
		unsigned long event, void *unused)
{
	struct musb	*musb = container_of(nb, struct musb, nb);
	struct device *dev = musb->controller;
	struct musb_hdrc_platform_data *pdata = dev->platform_data;
	struct omap_musb_board_data *data = pdata->board_data;

	switch (event) {
	case USB_EVENT_ID:
		DBG(4, "ID GND\n");

		if (is_otg_enabled(musb)) {
#ifdef CONFIG_USB_GADGET_MUSB_HDRC
			if (musb->gadget_driver) {
				otg_init(musb->xceiv);

				if (data->interface_type ==
						MUSB_INTERFACE_UTMI)
					omap2430_musb_set_vbus(musb, 1);

			}
#endif
		} else {
			otg_init(musb->xceiv);
			if (data->interface_type ==
					MUSB_INTERFACE_UTMI)
				omap2430_musb_set_vbus(musb, 1);
		}
		break;

	case USB_EVENT_VBUS:
		DBG(4, "VBUS Connect\n");

		otg_init(musb->xceiv);
		break;

	case USB_EVENT_NONE:
		DBG(4, "VBUS Disconnect\n");

		if (data->interface_type == MUSB_INTERFACE_UTMI) {
			if (musb->xceiv->set_vbus)
				otg_set_vbus(musb->xceiv, 0);
		}
		otg_shutdown(musb->xceiv);
		break;
	default:
		DBG(4, "ID float\n");
		return NOTIFY_DONE;
	}

	return NOTIFY_OK;
}

static int omap2430_musb_init(struct musb *musb)
{
	u32 l, status = 0;
	struct device *dev = musb->controller;
	struct musb_hdrc_platform_data *plat = dev->platform_data;
	struct omap_musb_board_data *data = plat->board_data;

	/* We require some kind of external transceiver, hooked
	 * up through ULPI.  TWL4030-family PMICs include one,
	 * which needs a driver, drivers aren't always needed.
	 */
	musb->xceiv = otg_get_transceiver();
	if (!musb->xceiv) {
		pr_err("HS USB OTG: no transceiver configured\n");
		return -ENODEV;
	}

	omap2430_low_level_init(musb);

	l = musb_readl(musb->mregs, OTG_SYSCONFIG);
	l &= ~ENABLEWAKEUP;	/* disable wakeup */
	l &= ~NOSTDBY;		/* remove possible nostdby */
	l |= SMARTSTDBY;	/* enable smart standby */
	l &= ~AUTOIDLE;		/* disable auto idle */
	l &= ~NOIDLE;		/* remove possible noidle */
	l |= SMARTIDLE;		/* enable smart idle */
	/*
	 * MUSB AUTOIDLE don't work in 3430.
	 * Workaround by Richard Woodruff/TI
	 */
	if (!cpu_is_omap3430())
		l |= AUTOIDLE;		/* enable auto idle */
	musb_writel(musb->mregs, OTG_SYSCONFIG, l);

	l = musb_readl(musb->mregs, OTG_INTERFSEL);

	if (data->interface_type == MUSB_INTERFACE_UTMI) {
		/* OMAP4 uses Internal PHY GS70 which uses UTMI interface */
		l &= ~ULPI_12PIN;       /* Disable ULPI */
		l |= UTMI_8BIT;         /* Enable UTMI  */
	} else {
		l |= ULPI_12PIN;
	}

	musb_writel(musb->mregs, OTG_INTERFSEL, l);

	pr_debug("HS USB OTG: revision 0x%x, sysconfig 0x%02x, "
			"sysstatus 0x%x, intrfsel 0x%x, simenable  0x%x\n",
			musb_readl(musb->mregs, OTG_REVISION),
			musb_readl(musb->mregs, OTG_SYSCONFIG),
			musb_readl(musb->mregs, OTG_SYSSTATUS),
			musb_readl(musb->mregs, OTG_INTERFSEL),
			musb_readl(musb->mregs, OTG_SIMENABLE));

	musb->nb.notifier_call = musb_otg_notifications;
	status = otg_register_notifier(musb->xceiv, &musb->nb);

	if (status)
		DBG(1, "notification register failed\n");

	/* check whether cable is already connected */
	if (musb->xceiv->state ==OTG_STATE_B_IDLE)
		musb_otg_notifications(&musb->nb, 1,
					musb->xceiv->gadget);

	setup_timer(&musb_idle_timer, musb_do_idle, (unsigned long) musb);

	return 0;
}

static int omap2430_musb_exit(struct musb *musb)
{

	omap2430_low_level_exit(musb);
	otg_put_transceiver(musb->xceiv);

	return 0;
}

static const struct musb_platform_ops omap2430_ops = {
	.init		= omap2430_musb_init,
	.exit		= omap2430_musb_exit,

	.set_mode	= omap2430_musb_set_mode,
	.try_idle	= omap2430_musb_try_idle,

	.set_vbus	= omap2430_musb_set_vbus,
};

static u64 omap2430_dmamask = DMA_BIT_MASK(32);

static int __init omap2430_probe(struct platform_device *pdev)
{
	struct musb_hdrc_platform_data	*pdata = pdev->dev.platform_data;
	struct platform_device		*musb;
	struct omap2430_glue		*glue;
	struct clk			*clk;

	int				ret = -ENOMEM;

	glue = kzalloc(sizeof(*glue), GFP_KERNEL);
	if (!glue) {
		dev_err(&pdev->dev, "failed to allocate glue context\n");
		goto err0;
	}

	musb = platform_device_alloc("musb-hdrc", -1);
	if (!musb) {
		dev_err(&pdev->dev, "failed to allocate musb device\n");
		goto err1;
	}

	clk = clk_get(&pdev->dev, "ick");
	if (IS_ERR(clk)) {
		dev_err(&pdev->dev, "failed to get clock\n");
		ret = PTR_ERR(clk);
		goto err2;
	}

	ret = clk_enable(clk);
	if (ret) {
		dev_err(&pdev->dev, "failed to enable clock\n");
		goto err3;
	}

	musb->dev.parent		= &pdev->dev;
	musb->dev.dma_mask		= &omap2430_dmamask;
	musb->dev.coherent_dma_mask	= omap2430_dmamask;

	glue->dev			= &pdev->dev;
	glue->musb			= musb;
	glue->clk			= clk;

	pdata->platform_ops		= &omap2430_ops;

	platform_set_drvdata(pdev, glue);

	ret = platform_device_add_resources(musb, pdev->resource,
			pdev->num_resources);
	if (ret) {
		dev_err(&pdev->dev, "failed to add resources\n");
		goto err4;
	}

	ret = platform_device_add_data(musb, pdata, sizeof(*pdata));
	if (ret) {
		dev_err(&pdev->dev, "failed to add platform_data\n");
		goto err4;
	}

	ret = platform_device_add(musb);
	if (ret) {
		dev_err(&pdev->dev, "failed to register musb device\n");
		goto err4;
	}

	return 0;

err4:
	clk_disable(clk);

err3:
	clk_put(clk);

err2:
	platform_device_put(musb);

err1:
	kfree(glue);

err0:
	return ret;
}

static int __exit omap2430_remove(struct platform_device *pdev)
{
	struct omap2430_glue		*glue = platform_get_drvdata(pdev);

	platform_device_del(glue->musb);
	platform_device_put(glue->musb);
	clk_disable(glue->clk);
	clk_put(glue->clk);
	kfree(glue);

	return 0;
}

#ifdef CONFIG_PM
static void omap2430_save_context(struct musb *musb)
{
	musb->context.otg_sysconfig = musb_readl(musb->mregs, OTG_SYSCONFIG);
	musb->context.otg_forcestandby = musb_readl(musb->mregs, OTG_FORCESTDBY);
}

static void omap2430_restore_context(struct musb *musb)
{
	musb_writel(musb->mregs, OTG_SYSCONFIG, musb->context.otg_sysconfig);
	musb_writel(musb->mregs, OTG_FORCESTDBY, musb->context.otg_forcestandby);
}

static int omap2430_suspend(struct device *dev)
{
	struct omap2430_glue		*glue = dev_get_drvdata(dev);
	struct musb			*musb = glue_to_musb(glue);

	omap2430_low_level_exit(musb);
	otg_set_suspend(musb->xceiv, 1);
	omap2430_save_context(musb);
	clk_disable(glue->clk);

	return 0;
}

static int omap2430_resume(struct device *dev)
{
	struct omap2430_glue		*glue = dev_get_drvdata(dev);
	struct musb			*musb = glue_to_musb(glue);
	int				ret;

	ret = clk_enable(glue->clk);
	if (ret) {
		dev_err(dev, "faled to enable clock\n");
		return ret;
	}

	omap2430_low_level_init(musb);
	omap2430_restore_context(musb);
	otg_set_suspend(musb->xceiv, 0);

	return 0;
}

static struct dev_pm_ops omap2430_pm_ops = {
	.suspend	= omap2430_suspend,
	.resume		= omap2430_resume,
};

#define DEV_PM_OPS	(&omap2430_pm_ops)
#else
#define DEV_PM_OPS	NULL
#endif

static struct platform_driver omap2430_driver = {
	.remove		= __exit_p(omap2430_remove),
	.driver		= {
		.name	= "musb-omap2430",
		.pm	= DEV_PM_OPS,
	},
};

MODULE_DESCRIPTION("OMAP2PLUS MUSB Glue Layer");
MODULE_AUTHOR("Felipe Balbi <balbi@ti.com>");
MODULE_LICENSE("GPL v2");

static int __init omap2430_init(void)
{
	return platform_driver_probe(&omap2430_driver, omap2430_probe);
}
subsys_initcall(omap2430_init);

static void __exit omap2430_exit(void)
{
	platform_driver_unregister(&omap2430_driver);
}
module_exit(omap2430_exit);
Commit	Line	Data
550a7375 FB	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
550a7375 FB	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>
550a7375 FB	30	#include <linux/init.h>
	31	#include <linux/list.h>
	32	#include <linux/clk.h>
	33	#include <linux/io.h>
dc09886b FB	34	#include <linux/platform_device.h>
dc09886b FB	35	#include <linux/dma-mapping.h>
550a7375	36
550a7375 FB	37	#include "musb_core.h"
	38	#include "omap2430.h"
	39
a3cee12a FB	40	struct omap2430_glue {
	41	struct device *dev;
	42	struct platform_device *musb;
03491761	43	struct clk *clk;
a3cee12a	44	};
c20aebb9	45	#define glue_to_musb(g) platform_get_drvdata(g->musb)
a3cee12a	46
550a7375 FB	47	static struct timer_list musb_idle_timer;
	48
	49	static void musb_do_idle(unsigned long _musb)
	50	{
	51	struct musb musb = (void )_musb;
	52	unsigned long flags;
eef767b7	53	#ifdef CONFIG_USB_MUSB_HDRC_HCD
550a7375	54	u8 power;
eef767b7	55	#endif
550a7375 FB	56	u8 devctl;
550a7375 FB	57
550a7375 FB	58	spin_lock_irqsave(&musb->lock, flags);
550a7375 FB	59
84e250ff	60	switch (musb->xceiv->state) {
550a7375	61	case OTG_STATE_A_WAIT_BCON:
550a7375 FB	62
	63	devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
	64	if (devctl & MUSB_DEVCTL_BDEVICE) {
84e250ff	65	musb->xceiv->state = OTG_STATE_B_IDLE;
550a7375 FB	66	MUSB_DEV_MODE(musb);
550a7375 FB	67	} else {
84e250ff	68	musb->xceiv->state = OTG_STATE_A_IDLE;
550a7375 FB	69	MUSB_HST_MODE(musb);
	70	}
	71	break;
	72	#ifdef CONFIG_USB_MUSB_HDRC_HCD
	73	case OTG_STATE_A_SUSPEND:
	74	/* finish RESUME signaling? */
	75	if (musb->port1_status & MUSB_PORT_STAT_RESUME) {
	76	power = musb_readb(musb->mregs, MUSB_POWER);
	77	power &= ~MUSB_POWER_RESUME;
	78	DBG(1, "root port resume stopped, power %02x\n", power);
	79	musb_writeb(musb->mregs, MUSB_POWER, power);
	80	musb->is_active = 1;
	81	musb->port1_status &= ~(USB_PORT_STAT_SUSPEND
	82	\| MUSB_PORT_STAT_RESUME);
	83	musb->port1_status \|= USB_PORT_STAT_C_SUSPEND << 16;
	84	usb_hcd_poll_rh_status(musb_to_hcd(musb));
	85	/* NOTE: it might really be A_WAIT_BCON ... */
84e250ff	86	musb->xceiv->state = OTG_STATE_A_HOST;
550a7375 FB	87	}
	88	break;
	89	#endif
	90	#ifdef CONFIG_USB_MUSB_HDRC_HCD
	91	case OTG_STATE_A_HOST:
	92	devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
	93	if (devctl & MUSB_DEVCTL_BDEVICE)
84e250ff	94	musb->xceiv->state = OTG_STATE_B_IDLE;
550a7375	95	else
84e250ff	96	musb->xceiv->state = OTG_STATE_A_WAIT_BCON;
550a7375 FB	97	#endif
	98	default:
	99	break;
	100	}
	101	spin_unlock_irqrestore(&musb->lock, flags);
	102	}
	103
	104
743411b3	105	static void omap2430_musb_try_idle(struct musb *musb, unsigned long timeout)
550a7375 FB	106	{
	107	unsigned long default_timeout = jiffies + msecs_to_jiffies(3);
	108	static unsigned long last_timer;
	109
	110	if (timeout == 0)
	111	timeout = default_timeout;
	112
	113	/* Never idle if active, or when VBUS timeout is not set as host */
	114	if (musb->is_active \|\| ((musb->a_wait_bcon == 0)
84e250ff	115	&& (musb->xceiv->state == OTG_STATE_A_WAIT_BCON))) {
550a7375 FB	116	DBG(4, "%s active, deleting timer\n", otg_state_string(musb));
	117	del_timer(&musb_idle_timer);
	118	last_timer = jiffies;
	119	return;
	120	}
	121
	122	if (time_after(last_timer, timeout)) {
	123	if (!timer_pending(&musb_idle_timer))
	124	last_timer = timeout;
	125	else {
	126	DBG(4, "Longer idle timer already pending, ignoring\n");
	127	return;
	128	}
	129	}
	130	last_timer = timeout;
	131
	132	DBG(4, "%s inactive, for idle timer for %lu ms\n",
	133	otg_state_string(musb),
	134	(unsigned long)jiffies_to_msecs(timeout - jiffies));
	135	mod_timer(&musb_idle_timer, timeout);
	136	}
	137
743411b3	138	static void omap2430_musb_set_vbus(struct musb *musb, int is_on)
550a7375 FB	139	{
550a7375 FB	140	u8 devctl;
594632ef HH	141	unsigned long timeout = jiffies + msecs_to_jiffies(1000);
594632ef HH	142	int ret = 1;
550a7375 FB	143	/* HDRC controls CPEN, but beware current surges during device
	144	* connect. They can trigger transient overcurrent conditions
	145	* that must be ignored.
	146	*/
	147
	148	devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
	149
	150	if (is_on) {
594632ef HH	151	if (musb->xceiv->state == OTG_STATE_A_IDLE) {
	152	/* start the session */
	153	devctl \|= MUSB_DEVCTL_SESSION;
	154	musb_writeb(musb->mregs, MUSB_DEVCTL, devctl);
	155	/*
	156	* Wait for the musb to set as A device to enable the
	157	* VBUS
	158	*/
	159	while (musb_readb(musb->mregs, MUSB_DEVCTL) & 0x80) {
	160
	161	cpu_relax();
	162
	163	if (time_after(jiffies, timeout)) {
	164	dev_err(musb->controller,
	165	"configured as A device timeout");
	166	ret = -EINVAL;
	167	break;
	168	}
	169	}
	170
	171	if (ret && musb->xceiv->set_vbus)
	172	otg_set_vbus(musb->xceiv, 1);
	173	} else {
	174	musb->is_active = 1;
	175	musb->xceiv->default_a = 1;
	176	musb->xceiv->state = OTG_STATE_A_WAIT_VRISE;
	177	devctl \|= MUSB_DEVCTL_SESSION;
	178	MUSB_HST_MODE(musb);
	179	}
550a7375 FB	180	} else {
	181	musb->is_active = 0;
	182
	183	/* NOTE: we're skipping A_WAIT_VFALL -> A_IDLE and
	184	* jumping right to B_IDLE...
	185	*/
	186
84e250ff DB	187	musb->xceiv->default_a = 0;
84e250ff DB	188	musb->xceiv->state = OTG_STATE_B_IDLE;
550a7375 FB	189	devctl &= ~MUSB_DEVCTL_SESSION;
	190
	191	MUSB_DEV_MODE(musb);
	192	}
	193	musb_writeb(musb->mregs, MUSB_DEVCTL, devctl);
	194
	195	DBG(1, "VBUS %s, devctl %02x "
	196	/* otg %3x conf %08x prcm %08x */ "\n",
	197	otg_state_string(musb),
	198	musb_readb(musb->mregs, MUSB_DEVCTL));
	199	}
550a7375	200
743411b3	201	static int omap2430_musb_set_mode(struct musb *musb, u8 musb_mode)
550a7375 FB	202	{
	203	u8 devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
	204
	205	devctl \|= MUSB_DEVCTL_SESSION;
	206	musb_writeb(musb->mregs, MUSB_DEVCTL, devctl);
	207
96a274d1	208	return 0;
550a7375 FB	209	}
550a7375 FB	210
c20aebb9 FB	211	static inline void omap2430_low_level_exit(struct musb *musb)
	212	{
	213	u32 l;
	214
	215	/* in any role */
	216	l = musb_readl(musb->mregs, OTG_FORCESTDBY);
	217	l \|= ENABLEFORCE; /* enable MSTANDBY */
	218	musb_writel(musb->mregs, OTG_FORCESTDBY, l);
	219
	220	l = musb_readl(musb->mregs, OTG_SYSCONFIG);
	221	l \|= ENABLEWAKEUP; /* enable wakeup */
	222	musb_writel(musb->mregs, OTG_SYSCONFIG, l);
	223	}
	224
	225	static inline void omap2430_low_level_init(struct musb *musb)
	226	{
	227	u32 l;
	228
	229	l = musb_readl(musb->mregs, OTG_SYSCONFIG);
	230	l &= ~ENABLEWAKEUP; /* disable wakeup */
	231	musb_writel(musb->mregs, OTG_SYSCONFIG, l);
	232
	233	l = musb_readl(musb->mregs, OTG_FORCESTDBY);
	234	l &= ~ENABLEFORCE; /* disable MSTANDBY */
	235	musb_writel(musb->mregs, OTG_FORCESTDBY, l);
	236	}
	237
594632ef HH	238	/* blocking notifier support */
	239	static int musb_otg_notifications(struct notifier_block *nb,
	240	unsigned long event, void *unused)
	241	{
	242	struct musb *musb = container_of(nb, struct musb, nb);
	243	struct device *dev = musb->controller;
	244	struct musb_hdrc_platform_data *pdata = dev->platform_data;
	245	struct omap_musb_board_data *data = pdata->board_data;
	246
	247	switch (event) {
	248	case USB_EVENT_ID:
	249	DBG(4, "ID GND\n");
	250
	251	if (is_otg_enabled(musb)) {
	252	#ifdef CONFIG_USB_GADGET_MUSB_HDRC
	253	if (musb->gadget_driver) {
	254	otg_init(musb->xceiv);
	255
	256	if (data->interface_type ==
	257	MUSB_INTERFACE_UTMI)
	258	omap2430_musb_set_vbus(musb, 1);
	259
	260	}
	261	#endif
	262	} else {
	263	otg_init(musb->xceiv);
	264	if (data->interface_type ==
	265	MUSB_INTERFACE_UTMI)
	266	omap2430_musb_set_vbus(musb, 1);
	267	}
	268	break;
	269
	270	case USB_EVENT_VBUS:
	271	DBG(4, "VBUS Connect\n");
	272
	273	otg_init(musb->xceiv);
	274	break;
	275
	276	case USB_EVENT_NONE:
	277	DBG(4, "VBUS Disconnect\n");
	278
	279	if (data->interface_type == MUSB_INTERFACE_UTMI) {
	280	if (musb->xceiv->set_vbus)
	281	otg_set_vbus(musb->xceiv, 0);
	282	}
	283	otg_shutdown(musb->xceiv);
	284	break;
	285	default:
	286	DBG(4, "ID float\n");
	287	return NOTIFY_DONE;
	288	}
	289
	290	return NOTIFY_OK;
	291	}
	292
743411b3	293	static int omap2430_musb_init(struct musb *musb)
550a7375	294	{
594632ef	295	u32 l, status = 0;
ea65df57 HK	296	struct device *dev = musb->controller;
	297	struct musb_hdrc_platform_data *plat = dev->platform_data;
	298	struct omap_musb_board_data *data = plat->board_data;
550a7375	299
84e250ff DB	300	/* We require some kind of external transceiver, hooked
	301	* up through ULPI. TWL4030-family PMICs include one,
	302	* which needs a driver, drivers aren't always needed.
	303	*/
	304	musb->xceiv = otg_get_transceiver();
	305	if (!musb->xceiv) {
	306	pr_err("HS USB OTG: no transceiver configured\n");
	307	return -ENODEV;
	308	}
	309
c20aebb9	310	omap2430_low_level_init(musb);
550a7375	311
8573e6a6	312	l = musb_readl(musb->mregs, OTG_SYSCONFIG);
550a7375 FB	313	l &= ~ENABLEWAKEUP; /* disable wakeup */
	314	l &= ~NOSTDBY; /* remove possible nostdby */
	315	l \|= SMARTSTDBY; /* enable smart standby */
	316	l &= ~AUTOIDLE; /* disable auto idle */
	317	l &= ~NOIDLE; /* remove possible noidle */
	318	l \|= SMARTIDLE; /* enable smart idle */
9a4b5e36 NM	319	/*
	320	* MUSB AUTOIDLE don't work in 3430.
	321	* Workaround by Richard Woodruff/TI
	322	*/
	323	if (!cpu_is_omap3430())
	324	l \|= AUTOIDLE; /* enable auto idle */
8573e6a6	325	musb_writel(musb->mregs, OTG_SYSCONFIG, l);
550a7375	326
8573e6a6	327	l = musb_readl(musb->mregs, OTG_INTERFSEL);
de2e1b0c MM	328
	329	if (data->interface_type == MUSB_INTERFACE_UTMI) {
	330	/* OMAP4 uses Internal PHY GS70 which uses UTMI interface */
	331	l &= ~ULPI_12PIN; /* Disable ULPI */
	332	l \|= UTMI_8BIT; /* Enable UTMI */
	333	} else {
	334	l \|= ULPI_12PIN;
	335	}
	336
8573e6a6	337	musb_writel(musb->mregs, OTG_INTERFSEL, l);
550a7375 FB	338
	339	pr_debug("HS USB OTG: revision 0x%x, sysconfig 0x%02x, "
	340	"sysstatus 0x%x, intrfsel 0x%x, simenable 0x%x\n",
8573e6a6 FB	341	musb_readl(musb->mregs, OTG_REVISION),
	342	musb_readl(musb->mregs, OTG_SYSCONFIG),
	343	musb_readl(musb->mregs, OTG_SYSSTATUS),
	344	musb_readl(musb->mregs, OTG_INTERFSEL),
	345	musb_readl(musb->mregs, OTG_SIMENABLE));
550a7375	346
594632ef HH	347	musb->nb.notifier_call = musb_otg_notifications;
	348	status = otg_register_notifier(musb->xceiv, &musb->nb);
	349
	350	if (status)
	351	DBG(1, "notification register failed\n");
	352
	353	/* check whether cable is already connected */
	354	if (musb->xceiv->state ==OTG_STATE_B_IDLE)
	355	musb_otg_notifications(&musb->nb, 1,
	356	musb->xceiv->gadget);
	357
550a7375 FB	358	setup_timer(&musb_idle_timer, musb_do_idle, (unsigned long) musb);
	359
	360	return 0;
	361	}
	362
743411b3	363	static int omap2430_musb_exit(struct musb *musb)
550a7375 FB	364	{
550a7375 FB	365
c20aebb9	366	omap2430_low_level_exit(musb);
f4053874	367	otg_put_transceiver(musb->xceiv);
c20aebb9	368
550a7375 FB	369	return 0;
550a7375 FB	370	}
743411b3	371
f7ec9437	372	static const struct musb_platform_ops omap2430_ops = {
743411b3 FB	373	.init = omap2430_musb_init,
	374	.exit = omap2430_musb_exit,
	375
743411b3 FB	376	.set_mode = omap2430_musb_set_mode,
	377	.try_idle = omap2430_musb_try_idle,
	378
	379	.set_vbus = omap2430_musb_set_vbus,
	380	};
dc09886b FB	381
	382	static u64 omap2430_dmamask = DMA_BIT_MASK(32);
	383
	384	static int __init omap2430_probe(struct platform_device *pdev)
	385	{
	386	struct musb_hdrc_platform_data *pdata = pdev->dev.platform_data;
	387	struct platform_device *musb;
a3cee12a	388	struct omap2430_glue *glue;
03491761	389	struct clk *clk;
dc09886b FB	390
	391	int ret = -ENOMEM;
	392
a3cee12a FB	393	glue = kzalloc(sizeof(*glue), GFP_KERNEL);
	394	if (!glue) {
	395	dev_err(&pdev->dev, "failed to allocate glue context\n");
	396	goto err0;
	397	}
	398
dc09886b FB	399	musb = platform_device_alloc("musb-hdrc", -1);
	400	if (!musb) {
	401	dev_err(&pdev->dev, "failed to allocate musb device\n");
a3cee12a	402	goto err1;
dc09886b FB	403	}
dc09886b FB	404
03491761 FB	405	clk = clk_get(&pdev->dev, "ick");
	406	if (IS_ERR(clk)) {
	407	dev_err(&pdev->dev, "failed to get clock\n");
	408	ret = PTR_ERR(clk);
	409	goto err2;
	410	}
	411
	412	ret = clk_enable(clk);
	413	if (ret) {
	414	dev_err(&pdev->dev, "failed to enable clock\n");
	415	goto err3;
	416	}
	417
dc09886b FB	418	musb->dev.parent = &pdev->dev;
	419	musb->dev.dma_mask = &omap2430_dmamask;
	420	musb->dev.coherent_dma_mask = omap2430_dmamask;
	421
a3cee12a FB	422	glue->dev = &pdev->dev;
a3cee12a FB	423	glue->musb = musb;
03491761	424	glue->clk = clk;
a3cee12a	425
f7ec9437 FB	426	pdata->platform_ops = &omap2430_ops;
f7ec9437 FB	427
a3cee12a	428	platform_set_drvdata(pdev, glue);
dc09886b FB	429
	430	ret = platform_device_add_resources(musb, pdev->resource,
	431	pdev->num_resources);
	432	if (ret) {
	433	dev_err(&pdev->dev, "failed to add resources\n");
03491761	434	goto err4;
dc09886b FB	435	}
	436
	437	ret = platform_device_add_data(musb, pdata, sizeof(*pdata));
	438	if (ret) {
	439	dev_err(&pdev->dev, "failed to add platform_data\n");
03491761	440	goto err4;
dc09886b FB	441	}
	442
	443	ret = platform_device_add(musb);
	444	if (ret) {
	445	dev_err(&pdev->dev, "failed to register musb device\n");
03491761	446	goto err4;
dc09886b FB	447	}
	448
	449	return 0;
	450
03491761 FB	451	err4:
	452	clk_disable(clk);
	453
	454	err3:
	455	clk_put(clk);
	456
a3cee12a	457	err2:
dc09886b FB	458	platform_device_put(musb);
dc09886b FB	459
a3cee12a FB	460	err1:
	461	kfree(glue);
	462
dc09886b FB	463	err0:
	464	return ret;
	465	}
	466
	467	static int __exit omap2430_remove(struct platform_device *pdev)
	468	{
a3cee12a	469	struct omap2430_glue *glue = platform_get_drvdata(pdev);
dc09886b	470
a3cee12a FB	471	platform_device_del(glue->musb);
a3cee12a FB	472	platform_device_put(glue->musb);
03491761 FB	473	clk_disable(glue->clk);
03491761 FB	474	clk_put(glue->clk);
a3cee12a	475	kfree(glue);
dc09886b FB	476
	477	return 0;
	478	}
	479
c20aebb9 FB	480	#ifdef CONFIG_PM
	481	static void omap2430_save_context(struct musb *musb)
	482	{
	483	musb->context.otg_sysconfig = musb_readl(musb->mregs, OTG_SYSCONFIG);
	484	musb->context.otg_forcestandby = musb_readl(musb->mregs, OTG_FORCESTDBY);
	485	}
	486
	487	static void omap2430_restore_context(struct musb *musb)
	488	{
	489	musb_writel(musb->mregs, OTG_SYSCONFIG, musb->context.otg_sysconfig);
	490	musb_writel(musb->mregs, OTG_FORCESTDBY, musb->context.otg_forcestandby);
	491	}
	492
	493	static int omap2430_suspend(struct device *dev)
	494	{
	495	struct omap2430_glue *glue = dev_get_drvdata(dev);
	496	struct musb *musb = glue_to_musb(glue);
	497
	498	omap2430_low_level_exit(musb);
	499	otg_set_suspend(musb->xceiv, 1);
	500	omap2430_save_context(musb);
	501	clk_disable(glue->clk);
	502
	503	return 0;
	504	}
	505
	506	static int omap2430_resume(struct device *dev)
	507	{
	508	struct omap2430_glue *glue = dev_get_drvdata(dev);
	509	struct musb *musb = glue_to_musb(glue);
	510	int ret;
	511
	512	ret = clk_enable(glue->clk);
	513	if (ret) {
	514	dev_err(dev, "faled to enable clock\n");
	515	return ret;
	516	}
	517
	518	omap2430_low_level_init(musb);
	519	omap2430_restore_context(musb);
	520	otg_set_suspend(musb->xceiv, 0);
	521
	522	return 0;
	523	}
	524
	525	static struct dev_pm_ops omap2430_pm_ops = {
	526	.suspend = omap2430_suspend,
	527	.resume = omap2430_resume,
	528	};
	529
	530	#define DEV_PM_OPS (&omap2430_pm_ops)
	531	#else
	532	#define DEV_PM_OPS NULL
	533	#endif
	534
dc09886b FB	535	static struct platform_driver omap2430_driver = {
	536	.remove = __exit_p(omap2430_remove),
	537	.driver = {
	538	.name = "musb-omap2430",
c20aebb9	539	.pm = DEV_PM_OPS,
dc09886b FB	540	},
	541	};
	542
	543	MODULE_DESCRIPTION("OMAP2PLUS MUSB Glue Layer");
	544	MODULE_AUTHOR("Felipe Balbi <balbi@ti.com>");
	545	MODULE_LICENSE("GPL v2");
	546
	547	static int __init omap2430_init(void)
	548	{
	549	return platform_driver_probe(&omap2430_driver, omap2430_probe);
	550	}
	551	subsys_initcall(omap2430_init);
	552
	553	static void __exit omap2430_exit(void)
	554	{
	555	platform_driver_unregister(&omap2430_driver);
	556	}
	557	module_exit(omap2430_exit);