322 lines
		
	
	
		
			7.7 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			322 lines
		
	
	
		
			7.7 KiB
		
	
	
	
		
			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/slab.h>
 | |
| #include <linux/init.h>
 | |
| #include <linux/list.h>
 | |
| #include <linux/clk.h>
 | |
| #include <linux/io.h>
 | |
| 
 | |
| #include <asm/mach-types.h>
 | |
| #include <mach/hardware.h>
 | |
| #include <mach/mux.h>
 | |
| 
 | |
| #include "musb_core.h"
 | |
| #include "omap2430.h"
 | |
| 
 | |
| #ifdef CONFIG_ARCH_OMAP3430
 | |
| #define	get_cpu_rev()	2
 | |
| #endif
 | |
| 
 | |
| 
 | |
| 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);
 | |
| 
 | |
| 	devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
 | |
| 
 | |
| 	switch (musb->xceiv->state) {
 | |
| 	case OTG_STATE_A_WAIT_BCON:
 | |
| 		devctl &= ~MUSB_DEVCTL_SESSION;
 | |
| 		musb_writeb(musb->mregs, MUSB_DEVCTL, devctl);
 | |
| 
 | |
| 		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);
 | |
| }
 | |
| 
 | |
| 
 | |
| void musb_platform_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);
 | |
| }
 | |
| 
 | |
| void musb_platform_enable(struct musb *musb)
 | |
| {
 | |
| }
 | |
| void musb_platform_disable(struct musb *musb)
 | |
| {
 | |
| }
 | |
| static void omap_vbus_power(struct musb *musb, int is_on, int sleeping)
 | |
| {
 | |
| }
 | |
| 
 | |
| static void omap_set_vbus(struct musb *musb, int is_on)
 | |
| {
 | |
| 	u8		devctl;
 | |
| 	/* 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) {
 | |
| 		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 musb_platform_resume(struct musb *musb);
 | |
| 
 | |
| int musb_platform_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;
 | |
| }
 | |
| 
 | |
| int __init musb_platform_init(struct musb *musb)
 | |
| {
 | |
| 	u32 l;
 | |
| 
 | |
| #if defined(CONFIG_ARCH_OMAP2430)
 | |
| 	omap_cfg_reg(AE5_2430_USB0HS_STP);
 | |
| #endif
 | |
| 
 | |
| 	/* 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;
 | |
| 	}
 | |
| 
 | |
| 	musb_platform_resume(musb);
 | |
| 
 | |
| 	l = omap_readl(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 */
 | |
| 	omap_writel(l, OTG_SYSCONFIG);
 | |
| 
 | |
| 	l = omap_readl(OTG_INTERFSEL);
 | |
| 	l |= ULPI_12PIN;
 | |
| 	omap_writel(l, OTG_INTERFSEL);
 | |
| 
 | |
| 	pr_debug("HS USB OTG: revision 0x%x, sysconfig 0x%02x, "
 | |
| 			"sysstatus 0x%x, intrfsel 0x%x, simenable  0x%x\n",
 | |
| 			omap_readl(OTG_REVISION), omap_readl(OTG_SYSCONFIG),
 | |
| 			omap_readl(OTG_SYSSTATUS), omap_readl(OTG_INTERFSEL),
 | |
| 			omap_readl(OTG_SIMENABLE));
 | |
| 
 | |
| 	omap_vbus_power(musb, musb->board_mode == MUSB_HOST, 1);
 | |
| 
 | |
| 	if (is_host_enabled(musb))
 | |
| 		musb->board_set_vbus = omap_set_vbus;
 | |
| 
 | |
| 	setup_timer(&musb_idle_timer, musb_do_idle, (unsigned long) musb);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| int musb_platform_suspend(struct musb *musb)
 | |
| {
 | |
| 	u32 l;
 | |
| 
 | |
| 	if (!musb->clock)
 | |
| 		return 0;
 | |
| 
 | |
| 	/* in any role */
 | |
| 	l = omap_readl(OTG_FORCESTDBY);
 | |
| 	l |= ENABLEFORCE;	/* enable MSTANDBY */
 | |
| 	omap_writel(l, OTG_FORCESTDBY);
 | |
| 
 | |
| 	l = omap_readl(OTG_SYSCONFIG);
 | |
| 	l |= ENABLEWAKEUP;	/* enable wakeup */
 | |
| 	omap_writel(l, OTG_SYSCONFIG);
 | |
| 
 | |
| 	otg_set_suspend(musb->xceiv, 1);
 | |
| 
 | |
| 	if (musb->set_clock)
 | |
| 		musb->set_clock(musb->clock, 0);
 | |
| 	else
 | |
| 		clk_disable(musb->clock);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int musb_platform_resume(struct musb *musb)
 | |
| {
 | |
| 	u32 l;
 | |
| 
 | |
| 	if (!musb->clock)
 | |
| 		return 0;
 | |
| 
 | |
| 	otg_set_suspend(musb->xceiv, 0);
 | |
| 
 | |
| 	if (musb->set_clock)
 | |
| 		musb->set_clock(musb->clock, 1);
 | |
| 	else
 | |
| 		clk_enable(musb->clock);
 | |
| 
 | |
| 	l = omap_readl(OTG_SYSCONFIG);
 | |
| 	l &= ~ENABLEWAKEUP;	/* disable wakeup */
 | |
| 	omap_writel(l, OTG_SYSCONFIG);
 | |
| 
 | |
| 	l = omap_readl(OTG_FORCESTDBY);
 | |
| 	l &= ~ENABLEFORCE;	/* disable MSTANDBY */
 | |
| 	omap_writel(l, OTG_FORCESTDBY);
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| 
 | |
| int musb_platform_exit(struct musb *musb)
 | |
| {
 | |
| 
 | |
| 	omap_vbus_power(musb, 0 /*off*/, 1);
 | |
| 
 | |
| 	musb_platform_suspend(musb);
 | |
| 
 | |
| 	clk_put(musb->clock);
 | |
| 	musb->clock = 0;
 | |
| 
 | |
| 	return 0;
 | |
| }
 |