Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 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 |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 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> |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 30 | #include <linux/init.h> |
| 31 | #include <linux/list.h> |
| 32 | #include <linux/clk.h> |
| 33 | #include <linux/io.h> |
Felipe Balbi | dc09886 | 2010-12-01 15:01:11 +0200 | [diff] [blame] | 34 | #include <linux/platform_device.h> |
| 35 | #include <linux/dma-mapping.h> |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 36 | |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 37 | #include "musb_core.h" |
| 38 | #include "omap2430.h" |
| 39 | |
Felipe Balbi | a3cee12 | 2010-12-02 09:27:29 +0200 | [diff] [blame] | 40 | struct omap2430_glue { |
| 41 | struct device *dev; |
| 42 | struct platform_device *musb; |
Felipe Balbi | 0349176 | 2010-12-02 09:57:08 +0200 | [diff] [blame^] | 43 | struct clk *clk; |
Felipe Balbi | a3cee12 | 2010-12-02 09:27:29 +0200 | [diff] [blame] | 44 | }; |
| 45 | |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 46 | static struct timer_list musb_idle_timer; |
| 47 | |
| 48 | static void musb_do_idle(unsigned long _musb) |
| 49 | { |
| 50 | struct musb *musb = (void *)_musb; |
| 51 | unsigned long flags; |
Ajay Kumar Gupta | eef767b | 2008-10-29 15:10:38 +0200 | [diff] [blame] | 52 | #ifdef CONFIG_USB_MUSB_HDRC_HCD |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 53 | u8 power; |
Ajay Kumar Gupta | eef767b | 2008-10-29 15:10:38 +0200 | [diff] [blame] | 54 | #endif |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 55 | u8 devctl; |
| 56 | |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 57 | spin_lock_irqsave(&musb->lock, flags); |
| 58 | |
David Brownell | 71783e0 | 2008-11-24 13:06:49 +0200 | [diff] [blame] | 59 | devctl = musb_readb(musb->mregs, MUSB_DEVCTL); |
| 60 | |
David Brownell | 84e250f | 2009-03-31 12:30:04 -0700 | [diff] [blame] | 61 | switch (musb->xceiv->state) { |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 62 | case OTG_STATE_A_WAIT_BCON: |
| 63 | devctl &= ~MUSB_DEVCTL_SESSION; |
| 64 | musb_writeb(musb->mregs, MUSB_DEVCTL, devctl); |
| 65 | |
| 66 | devctl = musb_readb(musb->mregs, MUSB_DEVCTL); |
| 67 | if (devctl & MUSB_DEVCTL_BDEVICE) { |
David Brownell | 84e250f | 2009-03-31 12:30:04 -0700 | [diff] [blame] | 68 | musb->xceiv->state = OTG_STATE_B_IDLE; |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 69 | MUSB_DEV_MODE(musb); |
| 70 | } else { |
David Brownell | 84e250f | 2009-03-31 12:30:04 -0700 | [diff] [blame] | 71 | musb->xceiv->state = OTG_STATE_A_IDLE; |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 72 | MUSB_HST_MODE(musb); |
| 73 | } |
| 74 | break; |
| 75 | #ifdef CONFIG_USB_MUSB_HDRC_HCD |
| 76 | case OTG_STATE_A_SUSPEND: |
| 77 | /* finish RESUME signaling? */ |
| 78 | if (musb->port1_status & MUSB_PORT_STAT_RESUME) { |
| 79 | power = musb_readb(musb->mregs, MUSB_POWER); |
| 80 | power &= ~MUSB_POWER_RESUME; |
| 81 | DBG(1, "root port resume stopped, power %02x\n", power); |
| 82 | musb_writeb(musb->mregs, MUSB_POWER, power); |
| 83 | musb->is_active = 1; |
| 84 | musb->port1_status &= ~(USB_PORT_STAT_SUSPEND |
| 85 | | MUSB_PORT_STAT_RESUME); |
| 86 | musb->port1_status |= USB_PORT_STAT_C_SUSPEND << 16; |
| 87 | usb_hcd_poll_rh_status(musb_to_hcd(musb)); |
| 88 | /* NOTE: it might really be A_WAIT_BCON ... */ |
David Brownell | 84e250f | 2009-03-31 12:30:04 -0700 | [diff] [blame] | 89 | musb->xceiv->state = OTG_STATE_A_HOST; |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 90 | } |
| 91 | break; |
| 92 | #endif |
| 93 | #ifdef CONFIG_USB_MUSB_HDRC_HCD |
| 94 | case OTG_STATE_A_HOST: |
| 95 | devctl = musb_readb(musb->mregs, MUSB_DEVCTL); |
| 96 | if (devctl & MUSB_DEVCTL_BDEVICE) |
David Brownell | 84e250f | 2009-03-31 12:30:04 -0700 | [diff] [blame] | 97 | musb->xceiv->state = OTG_STATE_B_IDLE; |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 98 | else |
David Brownell | 84e250f | 2009-03-31 12:30:04 -0700 | [diff] [blame] | 99 | musb->xceiv->state = OTG_STATE_A_WAIT_BCON; |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 100 | #endif |
| 101 | default: |
| 102 | break; |
| 103 | } |
| 104 | spin_unlock_irqrestore(&musb->lock, flags); |
| 105 | } |
| 106 | |
| 107 | |
Felipe Balbi | 743411b | 2010-12-01 13:22:05 +0200 | [diff] [blame] | 108 | static void omap2430_musb_try_idle(struct musb *musb, unsigned long timeout) |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 109 | { |
| 110 | unsigned long default_timeout = jiffies + msecs_to_jiffies(3); |
| 111 | static unsigned long last_timer; |
| 112 | |
| 113 | if (timeout == 0) |
| 114 | timeout = default_timeout; |
| 115 | |
| 116 | /* Never idle if active, or when VBUS timeout is not set as host */ |
| 117 | if (musb->is_active || ((musb->a_wait_bcon == 0) |
David Brownell | 84e250f | 2009-03-31 12:30:04 -0700 | [diff] [blame] | 118 | && (musb->xceiv->state == OTG_STATE_A_WAIT_BCON))) { |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 119 | DBG(4, "%s active, deleting timer\n", otg_state_string(musb)); |
| 120 | del_timer(&musb_idle_timer); |
| 121 | last_timer = jiffies; |
| 122 | return; |
| 123 | } |
| 124 | |
| 125 | if (time_after(last_timer, timeout)) { |
| 126 | if (!timer_pending(&musb_idle_timer)) |
| 127 | last_timer = timeout; |
| 128 | else { |
| 129 | DBG(4, "Longer idle timer already pending, ignoring\n"); |
| 130 | return; |
| 131 | } |
| 132 | } |
| 133 | last_timer = timeout; |
| 134 | |
| 135 | DBG(4, "%s inactive, for idle timer for %lu ms\n", |
| 136 | otg_state_string(musb), |
| 137 | (unsigned long)jiffies_to_msecs(timeout - jiffies)); |
| 138 | mod_timer(&musb_idle_timer, timeout); |
| 139 | } |
| 140 | |
Felipe Balbi | 743411b | 2010-12-01 13:22:05 +0200 | [diff] [blame] | 141 | static void omap2430_musb_enable(struct musb *musb) |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 142 | { |
| 143 | } |
Felipe Balbi | 743411b | 2010-12-01 13:22:05 +0200 | [diff] [blame] | 144 | |
| 145 | static void omap2430_musb_disable(struct musb *musb) |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 146 | { |
| 147 | } |
Felipe Balbi | 743411b | 2010-12-01 13:22:05 +0200 | [diff] [blame] | 148 | |
| 149 | static void omap2430_musb_set_vbus(struct musb *musb, int is_on) |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 150 | { |
| 151 | u8 devctl; |
| 152 | /* HDRC controls CPEN, but beware current surges during device |
| 153 | * connect. They can trigger transient overcurrent conditions |
| 154 | * that must be ignored. |
| 155 | */ |
| 156 | |
| 157 | devctl = musb_readb(musb->mregs, MUSB_DEVCTL); |
| 158 | |
| 159 | if (is_on) { |
| 160 | musb->is_active = 1; |
David Brownell | 84e250f | 2009-03-31 12:30:04 -0700 | [diff] [blame] | 161 | musb->xceiv->default_a = 1; |
| 162 | musb->xceiv->state = OTG_STATE_A_WAIT_VRISE; |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 163 | devctl |= MUSB_DEVCTL_SESSION; |
| 164 | |
| 165 | MUSB_HST_MODE(musb); |
| 166 | } else { |
| 167 | musb->is_active = 0; |
| 168 | |
| 169 | /* NOTE: we're skipping A_WAIT_VFALL -> A_IDLE and |
| 170 | * jumping right to B_IDLE... |
| 171 | */ |
| 172 | |
David Brownell | 84e250f | 2009-03-31 12:30:04 -0700 | [diff] [blame] | 173 | musb->xceiv->default_a = 0; |
| 174 | musb->xceiv->state = OTG_STATE_B_IDLE; |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 175 | devctl &= ~MUSB_DEVCTL_SESSION; |
| 176 | |
| 177 | MUSB_DEV_MODE(musb); |
| 178 | } |
| 179 | musb_writeb(musb->mregs, MUSB_DEVCTL, devctl); |
| 180 | |
| 181 | DBG(1, "VBUS %s, devctl %02x " |
| 182 | /* otg %3x conf %08x prcm %08x */ "\n", |
| 183 | otg_state_string(musb), |
| 184 | musb_readb(musb->mregs, MUSB_DEVCTL)); |
| 185 | } |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 186 | |
Felipe Balbi | 743411b | 2010-12-01 13:22:05 +0200 | [diff] [blame] | 187 | static int omap2430_musb_resume(struct musb *musb); |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 188 | |
Felipe Balbi | 743411b | 2010-12-01 13:22:05 +0200 | [diff] [blame] | 189 | static int omap2430_musb_set_mode(struct musb *musb, u8 musb_mode) |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 190 | { |
| 191 | u8 devctl = musb_readb(musb->mregs, MUSB_DEVCTL); |
| 192 | |
| 193 | devctl |= MUSB_DEVCTL_SESSION; |
| 194 | musb_writeb(musb->mregs, MUSB_DEVCTL, devctl); |
| 195 | |
David Brownell | 96a274d | 2008-11-24 13:06:47 +0200 | [diff] [blame] | 196 | return 0; |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 197 | } |
| 198 | |
Felipe Balbi | 743411b | 2010-12-01 13:22:05 +0200 | [diff] [blame] | 199 | static int omap2430_musb_init(struct musb *musb) |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 200 | { |
| 201 | u32 l; |
Hema Kalliguddi | ea65df5 | 2010-09-22 19:27:40 -0500 | [diff] [blame] | 202 | struct device *dev = musb->controller; |
| 203 | struct musb_hdrc_platform_data *plat = dev->platform_data; |
| 204 | struct omap_musb_board_data *data = plat->board_data; |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 205 | |
David Brownell | 84e250f | 2009-03-31 12:30:04 -0700 | [diff] [blame] | 206 | /* We require some kind of external transceiver, hooked |
| 207 | * up through ULPI. TWL4030-family PMICs include one, |
| 208 | * which needs a driver, drivers aren't always needed. |
| 209 | */ |
| 210 | musb->xceiv = otg_get_transceiver(); |
| 211 | if (!musb->xceiv) { |
| 212 | pr_err("HS USB OTG: no transceiver configured\n"); |
| 213 | return -ENODEV; |
| 214 | } |
| 215 | |
Felipe Balbi | 743411b | 2010-12-01 13:22:05 +0200 | [diff] [blame] | 216 | omap2430_musb_resume(musb); |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 217 | |
Felipe Balbi | 8573e6a | 2010-01-21 15:33:53 +0200 | [diff] [blame] | 218 | l = musb_readl(musb->mregs, OTG_SYSCONFIG); |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 219 | l &= ~ENABLEWAKEUP; /* disable wakeup */ |
| 220 | l &= ~NOSTDBY; /* remove possible nostdby */ |
| 221 | l |= SMARTSTDBY; /* enable smart standby */ |
| 222 | l &= ~AUTOIDLE; /* disable auto idle */ |
| 223 | l &= ~NOIDLE; /* remove possible noidle */ |
| 224 | l |= SMARTIDLE; /* enable smart idle */ |
Niilo Minkkinen | 9a4b5e3 | 2009-05-18 17:54:16 +0300 | [diff] [blame] | 225 | /* |
| 226 | * MUSB AUTOIDLE don't work in 3430. |
| 227 | * Workaround by Richard Woodruff/TI |
| 228 | */ |
| 229 | if (!cpu_is_omap3430()) |
| 230 | l |= AUTOIDLE; /* enable auto idle */ |
Felipe Balbi | 8573e6a | 2010-01-21 15:33:53 +0200 | [diff] [blame] | 231 | musb_writel(musb->mregs, OTG_SYSCONFIG, l); |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 232 | |
Felipe Balbi | 8573e6a | 2010-01-21 15:33:53 +0200 | [diff] [blame] | 233 | l = musb_readl(musb->mregs, OTG_INTERFSEL); |
Maulik Mankad | de2e1b0 | 2010-03-12 10:29:07 +0200 | [diff] [blame] | 234 | |
| 235 | if (data->interface_type == MUSB_INTERFACE_UTMI) { |
| 236 | /* OMAP4 uses Internal PHY GS70 which uses UTMI interface */ |
| 237 | l &= ~ULPI_12PIN; /* Disable ULPI */ |
| 238 | l |= UTMI_8BIT; /* Enable UTMI */ |
| 239 | } else { |
| 240 | l |= ULPI_12PIN; |
| 241 | } |
| 242 | |
Felipe Balbi | 8573e6a | 2010-01-21 15:33:53 +0200 | [diff] [blame] | 243 | musb_writel(musb->mregs, OTG_INTERFSEL, l); |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 244 | |
| 245 | pr_debug("HS USB OTG: revision 0x%x, sysconfig 0x%02x, " |
| 246 | "sysstatus 0x%x, intrfsel 0x%x, simenable 0x%x\n", |
Felipe Balbi | 8573e6a | 2010-01-21 15:33:53 +0200 | [diff] [blame] | 247 | musb_readl(musb->mregs, OTG_REVISION), |
| 248 | musb_readl(musb->mregs, OTG_SYSCONFIG), |
| 249 | musb_readl(musb->mregs, OTG_SYSSTATUS), |
| 250 | musb_readl(musb->mregs, OTG_INTERFSEL), |
| 251 | musb_readl(musb->mregs, OTG_SIMENABLE)); |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 252 | |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 253 | if (is_host_enabled(musb)) |
Felipe Balbi | 743411b | 2010-12-01 13:22:05 +0200 | [diff] [blame] | 254 | musb->board_set_vbus = omap2430_musb_set_vbus; |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 255 | |
| 256 | setup_timer(&musb_idle_timer, musb_do_idle, (unsigned long) musb); |
| 257 | |
| 258 | return 0; |
| 259 | } |
| 260 | |
Ajay Kumar Gupta | 4f712e0 | 2010-01-21 15:33:52 +0200 | [diff] [blame] | 261 | #ifdef CONFIG_PM |
Felipe Balbi | 8573e6a | 2010-01-21 15:33:53 +0200 | [diff] [blame] | 262 | void musb_platform_save_context(struct musb *musb, |
| 263 | struct musb_context_registers *musb_context) |
Ajay Kumar Gupta | 4f712e0 | 2010-01-21 15:33:52 +0200 | [diff] [blame] | 264 | { |
Felipe Balbi | 8573e6a | 2010-01-21 15:33:53 +0200 | [diff] [blame] | 265 | musb_context->otg_sysconfig = musb_readl(musb->mregs, OTG_SYSCONFIG); |
| 266 | musb_context->otg_forcestandby = musb_readl(musb->mregs, OTG_FORCESTDBY); |
Ajay Kumar Gupta | 4f712e0 | 2010-01-21 15:33:52 +0200 | [diff] [blame] | 267 | } |
| 268 | |
Felipe Balbi | 8573e6a | 2010-01-21 15:33:53 +0200 | [diff] [blame] | 269 | void musb_platform_restore_context(struct musb *musb, |
| 270 | struct musb_context_registers *musb_context) |
Ajay Kumar Gupta | 4f712e0 | 2010-01-21 15:33:52 +0200 | [diff] [blame] | 271 | { |
Felipe Balbi | 8573e6a | 2010-01-21 15:33:53 +0200 | [diff] [blame] | 272 | musb_writel(musb->mregs, OTG_SYSCONFIG, musb_context->otg_sysconfig); |
| 273 | musb_writel(musb->mregs, OTG_FORCESTDBY, musb_context->otg_forcestandby); |
Ajay Kumar Gupta | 4f712e0 | 2010-01-21 15:33:52 +0200 | [diff] [blame] | 274 | } |
| 275 | #endif |
| 276 | |
Felipe Balbi | 743411b | 2010-12-01 13:22:05 +0200 | [diff] [blame] | 277 | static int omap2430_musb_suspend(struct musb *musb) |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 278 | { |
| 279 | u32 l; |
| 280 | |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 281 | /* in any role */ |
Felipe Balbi | 8573e6a | 2010-01-21 15:33:53 +0200 | [diff] [blame] | 282 | l = musb_readl(musb->mregs, OTG_FORCESTDBY); |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 283 | l |= ENABLEFORCE; /* enable MSTANDBY */ |
Felipe Balbi | 8573e6a | 2010-01-21 15:33:53 +0200 | [diff] [blame] | 284 | musb_writel(musb->mregs, OTG_FORCESTDBY, l); |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 285 | |
Felipe Balbi | 8573e6a | 2010-01-21 15:33:53 +0200 | [diff] [blame] | 286 | l = musb_readl(musb->mregs, OTG_SYSCONFIG); |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 287 | l |= ENABLEWAKEUP; /* enable wakeup */ |
Felipe Balbi | 8573e6a | 2010-01-21 15:33:53 +0200 | [diff] [blame] | 288 | musb_writel(musb->mregs, OTG_SYSCONFIG, l); |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 289 | |
David Brownell | 84e250f | 2009-03-31 12:30:04 -0700 | [diff] [blame] | 290 | otg_set_suspend(musb->xceiv, 1); |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 291 | |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 292 | return 0; |
| 293 | } |
| 294 | |
Felipe Balbi | 743411b | 2010-12-01 13:22:05 +0200 | [diff] [blame] | 295 | static int omap2430_musb_resume(struct musb *musb) |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 296 | { |
| 297 | u32 l; |
| 298 | |
David Brownell | 84e250f | 2009-03-31 12:30:04 -0700 | [diff] [blame] | 299 | otg_set_suspend(musb->xceiv, 0); |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 300 | |
Felipe Balbi | 8573e6a | 2010-01-21 15:33:53 +0200 | [diff] [blame] | 301 | l = musb_readl(musb->mregs, OTG_SYSCONFIG); |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 302 | l &= ~ENABLEWAKEUP; /* disable wakeup */ |
Felipe Balbi | 8573e6a | 2010-01-21 15:33:53 +0200 | [diff] [blame] | 303 | musb_writel(musb->mregs, OTG_SYSCONFIG, l); |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 304 | |
Felipe Balbi | 8573e6a | 2010-01-21 15:33:53 +0200 | [diff] [blame] | 305 | l = musb_readl(musb->mregs, OTG_FORCESTDBY); |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 306 | l &= ~ENABLEFORCE; /* disable MSTANDBY */ |
Felipe Balbi | 8573e6a | 2010-01-21 15:33:53 +0200 | [diff] [blame] | 307 | musb_writel(musb->mregs, OTG_FORCESTDBY, l); |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 308 | |
| 309 | return 0; |
| 310 | } |
| 311 | |
Felipe Balbi | 743411b | 2010-12-01 13:22:05 +0200 | [diff] [blame] | 312 | static int omap2430_musb_exit(struct musb *musb) |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 313 | { |
| 314 | |
Felipe Balbi | 743411b | 2010-12-01 13:22:05 +0200 | [diff] [blame] | 315 | omap2430_musb_suspend(musb); |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 316 | |
Sergei Shtylyov | f405387 | 2010-09-29 09:54:29 +0300 | [diff] [blame] | 317 | otg_put_transceiver(musb->xceiv); |
Felipe Balbi | 550a737 | 2008-07-24 12:27:36 +0300 | [diff] [blame] | 318 | return 0; |
| 319 | } |
Felipe Balbi | 743411b | 2010-12-01 13:22:05 +0200 | [diff] [blame] | 320 | |
Felipe Balbi | f7ec943 | 2010-12-02 09:48:58 +0200 | [diff] [blame] | 321 | static const struct musb_platform_ops omap2430_ops = { |
Felipe Balbi | 743411b | 2010-12-01 13:22:05 +0200 | [diff] [blame] | 322 | .init = omap2430_musb_init, |
| 323 | .exit = omap2430_musb_exit, |
| 324 | |
| 325 | .suspend = omap2430_musb_suspend, |
| 326 | .resume = omap2430_musb_resume, |
| 327 | |
| 328 | .enable = omap2430_musb_enable, |
| 329 | .disable = omap2430_musb_disable, |
| 330 | |
| 331 | .set_mode = omap2430_musb_set_mode, |
| 332 | .try_idle = omap2430_musb_try_idle, |
| 333 | |
| 334 | .set_vbus = omap2430_musb_set_vbus, |
| 335 | }; |
Felipe Balbi | dc09886 | 2010-12-01 15:01:11 +0200 | [diff] [blame] | 336 | |
| 337 | static u64 omap2430_dmamask = DMA_BIT_MASK(32); |
| 338 | |
| 339 | static int __init omap2430_probe(struct platform_device *pdev) |
| 340 | { |
| 341 | struct musb_hdrc_platform_data *pdata = pdev->dev.platform_data; |
| 342 | struct platform_device *musb; |
Felipe Balbi | a3cee12 | 2010-12-02 09:27:29 +0200 | [diff] [blame] | 343 | struct omap2430_glue *glue; |
Felipe Balbi | 0349176 | 2010-12-02 09:57:08 +0200 | [diff] [blame^] | 344 | struct clk *clk; |
Felipe Balbi | dc09886 | 2010-12-01 15:01:11 +0200 | [diff] [blame] | 345 | |
| 346 | int ret = -ENOMEM; |
| 347 | |
Felipe Balbi | a3cee12 | 2010-12-02 09:27:29 +0200 | [diff] [blame] | 348 | glue = kzalloc(sizeof(*glue), GFP_KERNEL); |
| 349 | if (!glue) { |
| 350 | dev_err(&pdev->dev, "failed to allocate glue context\n"); |
| 351 | goto err0; |
| 352 | } |
| 353 | |
Felipe Balbi | dc09886 | 2010-12-01 15:01:11 +0200 | [diff] [blame] | 354 | musb = platform_device_alloc("musb-hdrc", -1); |
| 355 | if (!musb) { |
| 356 | dev_err(&pdev->dev, "failed to allocate musb device\n"); |
Felipe Balbi | a3cee12 | 2010-12-02 09:27:29 +0200 | [diff] [blame] | 357 | goto err1; |
Felipe Balbi | dc09886 | 2010-12-01 15:01:11 +0200 | [diff] [blame] | 358 | } |
| 359 | |
Felipe Balbi | 0349176 | 2010-12-02 09:57:08 +0200 | [diff] [blame^] | 360 | clk = clk_get(&pdev->dev, "ick"); |
| 361 | if (IS_ERR(clk)) { |
| 362 | dev_err(&pdev->dev, "failed to get clock\n"); |
| 363 | ret = PTR_ERR(clk); |
| 364 | goto err2; |
| 365 | } |
| 366 | |
| 367 | ret = clk_enable(clk); |
| 368 | if (ret) { |
| 369 | dev_err(&pdev->dev, "failed to enable clock\n"); |
| 370 | goto err3; |
| 371 | } |
| 372 | |
Felipe Balbi | dc09886 | 2010-12-01 15:01:11 +0200 | [diff] [blame] | 373 | musb->dev.parent = &pdev->dev; |
| 374 | musb->dev.dma_mask = &omap2430_dmamask; |
| 375 | musb->dev.coherent_dma_mask = omap2430_dmamask; |
| 376 | |
Felipe Balbi | a3cee12 | 2010-12-02 09:27:29 +0200 | [diff] [blame] | 377 | glue->dev = &pdev->dev; |
| 378 | glue->musb = musb; |
Felipe Balbi | 0349176 | 2010-12-02 09:57:08 +0200 | [diff] [blame^] | 379 | glue->clk = clk; |
Felipe Balbi | a3cee12 | 2010-12-02 09:27:29 +0200 | [diff] [blame] | 380 | |
Felipe Balbi | f7ec943 | 2010-12-02 09:48:58 +0200 | [diff] [blame] | 381 | pdata->platform_ops = &omap2430_ops; |
| 382 | |
Felipe Balbi | a3cee12 | 2010-12-02 09:27:29 +0200 | [diff] [blame] | 383 | platform_set_drvdata(pdev, glue); |
Felipe Balbi | dc09886 | 2010-12-01 15:01:11 +0200 | [diff] [blame] | 384 | |
| 385 | ret = platform_device_add_resources(musb, pdev->resource, |
| 386 | pdev->num_resources); |
| 387 | if (ret) { |
| 388 | dev_err(&pdev->dev, "failed to add resources\n"); |
Felipe Balbi | 0349176 | 2010-12-02 09:57:08 +0200 | [diff] [blame^] | 389 | goto err4; |
Felipe Balbi | dc09886 | 2010-12-01 15:01:11 +0200 | [diff] [blame] | 390 | } |
| 391 | |
| 392 | ret = platform_device_add_data(musb, pdata, sizeof(*pdata)); |
| 393 | if (ret) { |
| 394 | dev_err(&pdev->dev, "failed to add platform_data\n"); |
Felipe Balbi | 0349176 | 2010-12-02 09:57:08 +0200 | [diff] [blame^] | 395 | goto err4; |
Felipe Balbi | dc09886 | 2010-12-01 15:01:11 +0200 | [diff] [blame] | 396 | } |
| 397 | |
| 398 | ret = platform_device_add(musb); |
| 399 | if (ret) { |
| 400 | dev_err(&pdev->dev, "failed to register musb device\n"); |
Felipe Balbi | 0349176 | 2010-12-02 09:57:08 +0200 | [diff] [blame^] | 401 | goto err4; |
Felipe Balbi | dc09886 | 2010-12-01 15:01:11 +0200 | [diff] [blame] | 402 | } |
| 403 | |
| 404 | return 0; |
| 405 | |
Felipe Balbi | 0349176 | 2010-12-02 09:57:08 +0200 | [diff] [blame^] | 406 | err4: |
| 407 | clk_disable(clk); |
| 408 | |
| 409 | err3: |
| 410 | clk_put(clk); |
| 411 | |
Felipe Balbi | a3cee12 | 2010-12-02 09:27:29 +0200 | [diff] [blame] | 412 | err2: |
Felipe Balbi | dc09886 | 2010-12-01 15:01:11 +0200 | [diff] [blame] | 413 | platform_device_put(musb); |
| 414 | |
Felipe Balbi | a3cee12 | 2010-12-02 09:27:29 +0200 | [diff] [blame] | 415 | err1: |
| 416 | kfree(glue); |
| 417 | |
Felipe Balbi | dc09886 | 2010-12-01 15:01:11 +0200 | [diff] [blame] | 418 | err0: |
| 419 | return ret; |
| 420 | } |
| 421 | |
| 422 | static int __exit omap2430_remove(struct platform_device *pdev) |
| 423 | { |
Felipe Balbi | a3cee12 | 2010-12-02 09:27:29 +0200 | [diff] [blame] | 424 | struct omap2430_glue *glue = platform_get_drvdata(pdev); |
Felipe Balbi | dc09886 | 2010-12-01 15:01:11 +0200 | [diff] [blame] | 425 | |
Felipe Balbi | a3cee12 | 2010-12-02 09:27:29 +0200 | [diff] [blame] | 426 | platform_device_del(glue->musb); |
| 427 | platform_device_put(glue->musb); |
Felipe Balbi | 0349176 | 2010-12-02 09:57:08 +0200 | [diff] [blame^] | 428 | clk_disable(glue->clk); |
| 429 | clk_put(glue->clk); |
Felipe Balbi | a3cee12 | 2010-12-02 09:27:29 +0200 | [diff] [blame] | 430 | kfree(glue); |
Felipe Balbi | dc09886 | 2010-12-01 15:01:11 +0200 | [diff] [blame] | 431 | |
| 432 | return 0; |
| 433 | } |
| 434 | |
| 435 | static struct platform_driver omap2430_driver = { |
| 436 | .remove = __exit_p(omap2430_remove), |
| 437 | .driver = { |
| 438 | .name = "musb-omap2430", |
| 439 | }, |
| 440 | }; |
| 441 | |
| 442 | MODULE_DESCRIPTION("OMAP2PLUS MUSB Glue Layer"); |
| 443 | MODULE_AUTHOR("Felipe Balbi <balbi@ti.com>"); |
| 444 | MODULE_LICENSE("GPL v2"); |
| 445 | |
| 446 | static int __init omap2430_init(void) |
| 447 | { |
| 448 | return platform_driver_probe(&omap2430_driver, omap2430_probe); |
| 449 | } |
| 450 | subsys_initcall(omap2430_init); |
| 451 | |
| 452 | static void __exit omap2430_exit(void) |
| 453 | { |
| 454 | platform_driver_unregister(&omap2430_driver); |
| 455 | } |
| 456 | module_exit(omap2430_exit); |