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