]>
Commit | Line | Data |
---|---|---|
5fd54ace | 1 | // SPDX-License-Identifier: GPL-2.0 |
550a7375 FB |
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 | |
550a7375 FB |
7 | * Tony Lindgren <tony@atomide.com> |
8 | * | |
9 | * This file is part of the Inventra Controller Driver for Linux. | |
550a7375 FB |
10 | */ |
11 | #include <linux/module.h> | |
12 | #include <linux/kernel.h> | |
13 | #include <linux/sched.h> | |
550a7375 FB |
14 | #include <linux/init.h> |
15 | #include <linux/list.h> | |
550a7375 | 16 | #include <linux/io.h> |
00a0b1d5 | 17 | #include <linux/of.h> |
dc09886b FB |
18 | #include <linux/platform_device.h> |
19 | #include <linux/dma-mapping.h> | |
207b0e1f HH |
20 | #include <linux/pm_runtime.h> |
21 | #include <linux/err.h> | |
12a19b5f | 22 | #include <linux/delay.h> |
8055555f | 23 | #include <linux/usb/musb.h> |
14da699b | 24 | #include <linux/phy/omap_control_phy.h> |
8934d3e4 | 25 | #include <linux/of_platform.h> |
550a7375 | 26 | |
550a7375 FB |
27 | #include "musb_core.h" |
28 | #include "omap2430.h" | |
29 | ||
a3cee12a FB |
30 | struct omap2430_glue { |
31 | struct device *dev; | |
32 | struct platform_device *musb; | |
8055555f | 33 | enum musb_vbus_id_status status; |
1e5acb8d | 34 | struct work_struct omap_musb_mailbox_work; |
ca784be3 | 35 | struct device *control_otghs; |
a3cee12a | 36 | }; |
c20aebb9 | 37 | #define glue_to_musb(g) platform_get_drvdata(g->musb) |
a3cee12a | 38 | |
4b58ed11 | 39 | static struct omap2430_glue *_glue; |
c9721438 | 40 | |
743411b3 | 41 | static void omap2430_musb_set_vbus(struct musb *musb, int is_on) |
550a7375 | 42 | { |
d445b6da | 43 | struct usb_otg *otg = musb->xceiv->otg; |
550a7375 | 44 | u8 devctl; |
594632ef | 45 | unsigned long timeout = jiffies + msecs_to_jiffies(1000); |
550a7375 FB |
46 | /* HDRC controls CPEN, but beware current surges during device |
47 | * connect. They can trigger transient overcurrent conditions | |
48 | * that must be ignored. | |
49 | */ | |
50 | ||
51 | devctl = musb_readb(musb->mregs, MUSB_DEVCTL); | |
52 | ||
53 | if (is_on) { | |
e47d9254 | 54 | if (musb->xceiv->otg->state == OTG_STATE_A_IDLE) { |
12a19b5f | 55 | int loops = 100; |
594632ef HH |
56 | /* start the session */ |
57 | devctl |= MUSB_DEVCTL_SESSION; | |
58 | musb_writeb(musb->mregs, MUSB_DEVCTL, devctl); | |
59 | /* | |
60 | * Wait for the musb to set as A device to enable the | |
61 | * VBUS | |
62 | */ | |
5a805309 SS |
63 | while (musb_readb(musb->mregs, MUSB_DEVCTL) & |
64 | MUSB_DEVCTL_BDEVICE) { | |
594632ef | 65 | |
12a19b5f | 66 | mdelay(5); |
594632ef HH |
67 | cpu_relax(); |
68 | ||
12a19b5f N |
69 | if (time_after(jiffies, timeout) |
70 | || loops-- <= 0) { | |
594632ef HH |
71 | dev_err(musb->controller, |
72 | "configured as A device timeout"); | |
594632ef HH |
73 | break; |
74 | } | |
75 | } | |
76 | ||
bb467cf5 | 77 | otg_set_vbus(otg, 1); |
594632ef HH |
78 | } else { |
79 | musb->is_active = 1; | |
e47d9254 | 80 | musb->xceiv->otg->state = OTG_STATE_A_WAIT_VRISE; |
594632ef HH |
81 | devctl |= MUSB_DEVCTL_SESSION; |
82 | MUSB_HST_MODE(musb); | |
83 | } | |
550a7375 FB |
84 | } else { |
85 | musb->is_active = 0; | |
86 | ||
87 | /* NOTE: we're skipping A_WAIT_VFALL -> A_IDLE and | |
88 | * jumping right to B_IDLE... | |
89 | */ | |
90 | ||
e47d9254 | 91 | musb->xceiv->otg->state = OTG_STATE_B_IDLE; |
550a7375 FB |
92 | devctl &= ~MUSB_DEVCTL_SESSION; |
93 | ||
94 | MUSB_DEV_MODE(musb); | |
95 | } | |
96 | musb_writeb(musb->mregs, MUSB_DEVCTL, devctl); | |
97 | ||
5c8a86e1 | 98 | dev_dbg(musb->controller, "VBUS %s, devctl %02x " |
550a7375 | 99 | /* otg %3x conf %08x prcm %08x */ "\n", |
e47d9254 | 100 | usb_otg_state_string(musb->xceiv->otg->state), |
550a7375 FB |
101 | musb_readb(musb->mregs, MUSB_DEVCTL)); |
102 | } | |
550a7375 | 103 | |
c20aebb9 FB |
104 | static inline void omap2430_low_level_exit(struct musb *musb) |
105 | { | |
106 | u32 l; | |
107 | ||
108 | /* in any role */ | |
109 | l = musb_readl(musb->mregs, OTG_FORCESTDBY); | |
110 | l |= ENABLEFORCE; /* enable MSTANDBY */ | |
111 | musb_writel(musb->mregs, OTG_FORCESTDBY, l); | |
c20aebb9 FB |
112 | } |
113 | ||
114 | static inline void omap2430_low_level_init(struct musb *musb) | |
115 | { | |
116 | u32 l; | |
117 | ||
c20aebb9 FB |
118 | l = musb_readl(musb->mregs, OTG_FORCESTDBY); |
119 | l &= ~ENABLEFORCE; /* disable MSTANDBY */ | |
120 | musb_writel(musb->mregs, OTG_FORCESTDBY, l); | |
121 | } | |
122 | ||
12b7db2b | 123 | static int omap2430_musb_mailbox(enum musb_vbus_id_status status) |
594632ef | 124 | { |
c9721438 | 125 | struct omap2430_glue *glue = _glue; |
712d8efa | 126 | |
f8c4b0e7 AK |
127 | if (!glue) { |
128 | pr_err("%s: musb core is not yet initialized\n", __func__); | |
12b7db2b | 129 | return -EPROBE_DEFER; |
f8c4b0e7 AK |
130 | } |
131 | glue->status = status; | |
132 | ||
133 | if (!glue_to_musb(glue)) { | |
80ab72e1 | 134 | pr_err("%s: musb core is not yet ready\n", __func__); |
12b7db2b | 135 | return -EPROBE_DEFER; |
c9721438 | 136 | } |
712d8efa | 137 | |
c9721438 | 138 | schedule_work(&glue->omap_musb_mailbox_work); |
12b7db2b TL |
139 | |
140 | return 0; | |
712d8efa VP |
141 | } |
142 | ||
c9721438 | 143 | static void omap_musb_set_mailbox(struct omap2430_glue *glue) |
712d8efa | 144 | { |
1e5acb8d | 145 | struct musb *musb = glue_to_musb(glue); |
ae909fe4 TL |
146 | struct musb_hdrc_platform_data *pdata = |
147 | dev_get_platdata(musb->controller); | |
594632ef HH |
148 | struct omap_musb_board_data *data = pdata->board_data; |
149 | ||
ae909fe4 | 150 | pm_runtime_get_sync(musb->controller); |
c9721438 | 151 | switch (glue->status) { |
8055555f | 152 | case MUSB_ID_GROUND: |
ae909fe4 | 153 | dev_dbg(musb->controller, "ID GND\n"); |
594632ef | 154 | |
e47d9254 | 155 | musb->xceiv->otg->state = OTG_STATE_A_IDLE; |
c9721438 | 156 | musb->xceiv->last_event = USB_EVENT_ID; |
032ec49f | 157 | if (musb->gadget_driver) { |
ca784be3 KVA |
158 | omap_control_usb_set_mode(glue->control_otghs, |
159 | USB_MODE_HOST); | |
70045c57 | 160 | omap2430_musb_set_vbus(musb, 1); |
594632ef HH |
161 | } |
162 | break; | |
163 | ||
8055555f | 164 | case MUSB_VBUS_VALID: |
ae909fe4 | 165 | dev_dbg(musb->controller, "VBUS Connect\n"); |
594632ef | 166 | |
e47d9254 | 167 | musb->xceiv->otg->state = OTG_STATE_B_IDLE; |
c9721438 | 168 | musb->xceiv->last_event = USB_EVENT_VBUS; |
ca784be3 | 169 | omap_control_usb_set_mode(glue->control_otghs, USB_MODE_DEVICE); |
594632ef HH |
170 | break; |
171 | ||
8055555f TL |
172 | case MUSB_ID_FLOAT: |
173 | case MUSB_VBUS_OFF: | |
ae909fe4 | 174 | dev_dbg(musb->controller, "VBUS Disconnect\n"); |
594632ef | 175 | |
c9721438 | 176 | musb->xceiv->last_event = USB_EVENT_NONE; |
21f77bee | 177 | if (musb->gadget_driver) |
2c1fe89d | 178 | omap2430_musb_set_vbus(musb, 0); |
7acc6197 | 179 | |
bb467cf5 KVA |
180 | if (data->interface_type == MUSB_INTERFACE_UTMI) |
181 | otg_set_vbus(musb->xceiv->otg, 0); | |
182 | ||
ca784be3 KVA |
183 | omap_control_usb_set_mode(glue->control_otghs, |
184 | USB_MODE_DISCONNECT); | |
594632ef HH |
185 | break; |
186 | default: | |
ae909fe4 | 187 | dev_dbg(musb->controller, "ID float\n"); |
594632ef | 188 | } |
ae909fe4 TL |
189 | pm_runtime_mark_last_busy(musb->controller); |
190 | pm_runtime_put_autosuspend(musb->controller); | |
6fa7178c PR |
191 | atomic_notifier_call_chain(&musb->xceiv->notifier, |
192 | musb->xceiv->last_event, NULL); | |
594632ef HH |
193 | } |
194 | ||
c9721438 KVA |
195 | |
196 | static void omap_musb_mailbox_work(struct work_struct *mailbox_work) | |
197 | { | |
198 | struct omap2430_glue *glue = container_of(mailbox_work, | |
199 | struct omap2430_glue, omap_musb_mailbox_work); | |
8b2bc2c9 | 200 | |
c9721438 KVA |
201 | omap_musb_set_mailbox(glue); |
202 | } | |
203 | ||
baef653a PDS |
204 | static irqreturn_t omap2430_musb_interrupt(int irq, void *__hci) |
205 | { | |
206 | unsigned long flags; | |
207 | irqreturn_t retval = IRQ_NONE; | |
208 | struct musb *musb = __hci; | |
209 | ||
210 | spin_lock_irqsave(&musb->lock, flags); | |
211 | ||
212 | musb->int_usb = musb_readb(musb->mregs, MUSB_INTRUSB); | |
213 | musb->int_tx = musb_readw(musb->mregs, MUSB_INTRTX); | |
214 | musb->int_rx = musb_readw(musb->mregs, MUSB_INTRRX); | |
215 | ||
216 | if (musb->int_usb || musb->int_tx || musb->int_rx) | |
217 | retval = musb_interrupt(musb); | |
218 | ||
219 | spin_unlock_irqrestore(&musb->lock, flags); | |
220 | ||
221 | return retval; | |
222 | } | |
223 | ||
743411b3 | 224 | static int omap2430_musb_init(struct musb *musb) |
550a7375 | 225 | { |
ad579699 S |
226 | u32 l; |
227 | int status = 0; | |
ea65df57 | 228 | struct device *dev = musb->controller; |
c9721438 | 229 | struct omap2430_glue *glue = dev_get_drvdata(dev->parent); |
c1a7d67c | 230 | struct musb_hdrc_platform_data *plat = dev_get_platdata(dev); |
ea65df57 | 231 | struct omap_musb_board_data *data = plat->board_data; |
550a7375 | 232 | |
84e250ff DB |
233 | /* We require some kind of external transceiver, hooked |
234 | * up through ULPI. TWL4030-family PMICs include one, | |
235 | * which needs a driver, drivers aren't always needed. | |
236 | */ | |
5ee1787e JH |
237 | musb->phy = devm_phy_get(dev->parent, "usb2-phy"); |
238 | ||
239 | /* We can't totally remove musb->xceiv as of now because | |
240 | * musb core uses xceiv.state and xceiv.otg. Once we have | |
241 | * a separate state machine to handle otg, these can be moved | |
242 | * out of xceiv and then we can start using the generic PHY | |
243 | * framework | |
244 | */ | |
245 | musb->xceiv = devm_usb_get_phy_by_phandle(dev->parent, "usb-phy", 0); | |
b16604f2 | 246 | |
a90199bb FB |
247 | if (IS_ERR(musb->xceiv)) { |
248 | status = PTR_ERR(musb->xceiv); | |
249 | ||
250 | if (status == -ENXIO) | |
251 | return status; | |
252 | ||
dc66ba8d | 253 | dev_dbg(dev, "HS USB OTG: no transceiver configured\n"); |
25736e0c | 254 | return -EPROBE_DEFER; |
84e250ff DB |
255 | } |
256 | ||
3e3101d5 | 257 | if (IS_ERR(musb->phy)) { |
71127a79 | 258 | dev_err(dev, "HS USB OTG: no PHY configured\n"); |
3e3101d5 KVA |
259 | return PTR_ERR(musb->phy); |
260 | } | |
baef653a | 261 | musb->isr = omap2430_musb_interrupt; |
a83e17d0 | 262 | phy_init(musb->phy); |
d8e5f0ec | 263 | phy_power_on(musb->phy); |
baef653a | 264 | |
8573e6a6 | 265 | l = musb_readl(musb->mregs, OTG_INTERFSEL); |
de2e1b0c MM |
266 | |
267 | if (data->interface_type == MUSB_INTERFACE_UTMI) { | |
268 | /* OMAP4 uses Internal PHY GS70 which uses UTMI interface */ | |
269 | l &= ~ULPI_12PIN; /* Disable ULPI */ | |
270 | l |= UTMI_8BIT; /* Enable UTMI */ | |
271 | } else { | |
272 | l |= ULPI_12PIN; | |
273 | } | |
274 | ||
8573e6a6 | 275 | musb_writel(musb->mregs, OTG_INTERFSEL, l); |
550a7375 | 276 | |
71127a79 | 277 | dev_dbg(dev, "HS USB OTG: revision 0x%x, sysconfig 0x%02x, " |
550a7375 | 278 | "sysstatus 0x%x, intrfsel 0x%x, simenable 0x%x\n", |
8573e6a6 FB |
279 | musb_readl(musb->mregs, OTG_REVISION), |
280 | musb_readl(musb->mregs, OTG_SYSCONFIG), | |
281 | musb_readl(musb->mregs, OTG_SYSSTATUS), | |
282 | musb_readl(musb->mregs, OTG_INTERFSEL), | |
283 | musb_readl(musb->mregs, OTG_SIMENABLE)); | |
550a7375 | 284 | |
8055555f | 285 | if (glue->status != MUSB_UNKNOWN) |
c9721438 KVA |
286 | omap_musb_set_mailbox(glue); |
287 | ||
550a7375 FB |
288 | return 0; |
289 | } | |
290 | ||
002eda13 HH |
291 | static void omap2430_musb_enable(struct musb *musb) |
292 | { | |
293 | u8 devctl; | |
294 | unsigned long timeout = jiffies + msecs_to_jiffies(1000); | |
295 | struct device *dev = musb->controller; | |
c9721438 | 296 | struct omap2430_glue *glue = dev_get_drvdata(dev->parent); |
c1a7d67c | 297 | struct musb_hdrc_platform_data *pdata = dev_get_platdata(dev); |
002eda13 HH |
298 | struct omap_musb_board_data *data = pdata->board_data; |
299 | ||
a83e17d0 | 300 | |
c9721438 | 301 | switch (glue->status) { |
002eda13 | 302 | |
8055555f | 303 | case MUSB_ID_GROUND: |
ca784be3 | 304 | omap_control_usb_set_mode(glue->control_otghs, USB_MODE_HOST); |
08dec56e FC |
305 | if (data->interface_type != MUSB_INTERFACE_UTMI) |
306 | break; | |
307 | devctl = musb_readb(musb->mregs, MUSB_DEVCTL); | |
308 | /* start the session */ | |
309 | devctl |= MUSB_DEVCTL_SESSION; | |
310 | musb_writeb(musb->mregs, MUSB_DEVCTL, devctl); | |
311 | while (musb_readb(musb->mregs, MUSB_DEVCTL) & | |
312 | MUSB_DEVCTL_BDEVICE) { | |
313 | cpu_relax(); | |
314 | ||
315 | if (time_after(jiffies, timeout)) { | |
316 | dev_err(dev, "configured as A device timeout"); | |
317 | break; | |
002eda13 HH |
318 | } |
319 | } | |
320 | break; | |
321 | ||
8055555f | 322 | case MUSB_VBUS_VALID: |
ca784be3 | 323 | omap_control_usb_set_mode(glue->control_otghs, USB_MODE_DEVICE); |
002eda13 HH |
324 | break; |
325 | ||
326 | default: | |
327 | break; | |
328 | } | |
329 | } | |
330 | ||
331 | static void omap2430_musb_disable(struct musb *musb) | |
332 | { | |
c9721438 KVA |
333 | struct device *dev = musb->controller; |
334 | struct omap2430_glue *glue = dev_get_drvdata(dev->parent); | |
335 | ||
8055555f | 336 | if (glue->status != MUSB_UNKNOWN) |
ca784be3 KVA |
337 | omap_control_usb_set_mode(glue->control_otghs, |
338 | USB_MODE_DISCONNECT); | |
550a7375 FB |
339 | } |
340 | ||
743411b3 | 341 | static int omap2430_musb_exit(struct musb *musb) |
550a7375 | 342 | { |
a83e17d0 TL |
343 | struct device *dev = musb->controller; |
344 | struct omap2430_glue *glue = dev_get_drvdata(dev->parent); | |
550a7375 | 345 | |
c20aebb9 | 346 | omap2430_low_level_exit(musb); |
d8e5f0ec | 347 | phy_power_off(musb->phy); |
3e3101d5 | 348 | phy_exit(musb->phy); |
a83e17d0 TL |
349 | musb->phy = NULL; |
350 | cancel_work_sync(&glue->omap_musb_mailbox_work); | |
c20aebb9 | 351 | |
550a7375 FB |
352 | return 0; |
353 | } | |
743411b3 | 354 | |
f7ec9437 | 355 | static const struct musb_platform_ops omap2430_ops = { |
f8e9f34f | 356 | .quirks = MUSB_DMA_INVENTRA, |
7f6283ed TL |
357 | #ifdef CONFIG_USB_INVENTRA_DMA |
358 | .dma_init = musbhs_dma_controller_create, | |
359 | .dma_exit = musbhs_dma_controller_destroy, | |
360 | #endif | |
743411b3 FB |
361 | .init = omap2430_musb_init, |
362 | .exit = omap2430_musb_exit, | |
363 | ||
002eda13 HH |
364 | .enable = omap2430_musb_enable, |
365 | .disable = omap2430_musb_disable, | |
8055555f TL |
366 | |
367 | .phy_callback = omap2430_musb_mailbox, | |
743411b3 | 368 | }; |
dc09886b FB |
369 | |
370 | static u64 omap2430_dmamask = DMA_BIT_MASK(32); | |
371 | ||
41ac7b3a | 372 | static int omap2430_probe(struct platform_device *pdev) |
dc09886b | 373 | { |
c1f01be4 | 374 | struct resource musb_resources[3]; |
c1a7d67c | 375 | struct musb_hdrc_platform_data *pdata = dev_get_platdata(&pdev->dev); |
00a0b1d5 | 376 | struct omap_musb_board_data *data; |
dc09886b | 377 | struct platform_device *musb; |
a3cee12a | 378 | struct omap2430_glue *glue; |
00a0b1d5 KVA |
379 | struct device_node *np = pdev->dev.of_node; |
380 | struct musb_hdrc_config *config; | |
5ee1787e JH |
381 | struct device_node *control_node; |
382 | struct platform_device *control_pdev; | |
606bf4d5 | 383 | int ret = -ENOMEM, val; |
dc09886b | 384 | |
5ee1787e JH |
385 | if (!np) |
386 | return -ENODEV; | |
387 | ||
b1183c24 | 388 | glue = devm_kzalloc(&pdev->dev, sizeof(*glue), GFP_KERNEL); |
af1bdfc9 | 389 | if (!glue) |
a3cee12a | 390 | goto err0; |
a3cee12a | 391 | |
2f771164 | 392 | musb = platform_device_alloc("musb-hdrc", PLATFORM_DEVID_AUTO); |
dc09886b FB |
393 | if (!musb) { |
394 | dev_err(&pdev->dev, "failed to allocate musb device\n"); | |
2f771164 | 395 | goto err0; |
dc09886b FB |
396 | } |
397 | ||
398 | musb->dev.parent = &pdev->dev; | |
399 | musb->dev.dma_mask = &omap2430_dmamask; | |
400 | musb->dev.coherent_dma_mask = omap2430_dmamask; | |
401 | ||
a3cee12a FB |
402 | glue->dev = &pdev->dev; |
403 | glue->musb = musb; | |
8055555f | 404 | glue->status = MUSB_UNKNOWN; |
8934d3e4 | 405 | glue->control_otghs = ERR_PTR(-ENODEV); |
a3cee12a | 406 | |
5ee1787e JH |
407 | pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL); |
408 | if (!pdata) | |
409 | goto err2; | |
410 | ||
411 | data = devm_kzalloc(&pdev->dev, sizeof(*data), GFP_KERNEL); | |
412 | if (!data) | |
413 | goto err2; | |
414 | ||
415 | config = devm_kzalloc(&pdev->dev, sizeof(*config), GFP_KERNEL); | |
416 | if (!config) | |
417 | goto err2; | |
418 | ||
419 | of_property_read_u32(np, "mode", (u32 *)&pdata->mode); | |
420 | of_property_read_u32(np, "interface-type", | |
421 | (u32 *)&data->interface_type); | |
422 | of_property_read_u32(np, "num-eps", (u32 *)&config->num_eps); | |
423 | of_property_read_u32(np, "ram-bits", (u32 *)&config->ram_bits); | |
424 | of_property_read_u32(np, "power", (u32 *)&pdata->power); | |
425 | ||
426 | ret = of_property_read_u32(np, "multipoint", &val); | |
427 | if (!ret && val) | |
428 | config->multipoint = true; | |
429 | ||
430 | pdata->board_data = data; | |
431 | pdata->config = config; | |
432 | ||
433 | control_node = of_parse_phandle(np, "ctrl-module", 0); | |
434 | if (control_node) { | |
435 | control_pdev = of_find_device_by_node(control_node); | |
436 | if (!control_pdev) { | |
437 | dev_err(&pdev->dev, "Failed to get control device\n"); | |
438 | ret = -EINVAL; | |
2f771164 | 439 | goto err2; |
ca784be3 | 440 | } |
5ee1787e | 441 | glue->control_otghs = &control_pdev->dev; |
ca784be3 | 442 | } |
5ee1787e | 443 | |
f7ec9437 FB |
444 | pdata->platform_ops = &omap2430_ops; |
445 | ||
a3cee12a | 446 | platform_set_drvdata(pdev, glue); |
dc09886b | 447 | |
c9721438 KVA |
448 | /* |
449 | * REVISIT if we ever have two instances of the wrapper, we will be | |
450 | * in big trouble | |
451 | */ | |
452 | _glue = glue; | |
453 | ||
1e5acb8d KVA |
454 | INIT_WORK(&glue->omap_musb_mailbox_work, omap_musb_mailbox_work); |
455 | ||
3a0ddc71 | 456 | memset(musb_resources, 0x00, sizeof(*musb_resources) * |
09fc7d22 FB |
457 | ARRAY_SIZE(musb_resources)); |
458 | ||
459 | musb_resources[0].name = pdev->resource[0].name; | |
460 | musb_resources[0].start = pdev->resource[0].start; | |
461 | musb_resources[0].end = pdev->resource[0].end; | |
462 | musb_resources[0].flags = pdev->resource[0].flags; | |
463 | ||
464 | musb_resources[1].name = pdev->resource[1].name; | |
465 | musb_resources[1].start = pdev->resource[1].start; | |
466 | musb_resources[1].end = pdev->resource[1].end; | |
467 | musb_resources[1].flags = pdev->resource[1].flags; | |
468 | ||
c1f01be4 KVA |
469 | musb_resources[2].name = pdev->resource[2].name; |
470 | musb_resources[2].start = pdev->resource[2].start; | |
471 | musb_resources[2].end = pdev->resource[2].end; | |
472 | musb_resources[2].flags = pdev->resource[2].flags; | |
473 | ||
09fc7d22 FB |
474 | ret = platform_device_add_resources(musb, musb_resources, |
475 | ARRAY_SIZE(musb_resources)); | |
dc09886b FB |
476 | if (ret) { |
477 | dev_err(&pdev->dev, "failed to add resources\n"); | |
65b3d52d | 478 | goto err2; |
dc09886b FB |
479 | } |
480 | ||
481 | ret = platform_device_add_data(musb, pdata, sizeof(*pdata)); | |
482 | if (ret) { | |
483 | dev_err(&pdev->dev, "failed to add platform_data\n"); | |
65b3d52d | 484 | goto err2; |
dc09886b FB |
485 | } |
486 | ||
87326e85 | 487 | pm_runtime_enable(glue->dev); |
3006dc8c | 488 | |
dc09886b FB |
489 | ret = platform_device_add(musb); |
490 | if (ret) { | |
491 | dev_err(&pdev->dev, "failed to register musb device\n"); | |
536d599d | 492 | goto err3; |
dc09886b FB |
493 | } |
494 | ||
207b0e1f | 495 | return 0; |
03491761 | 496 | |
536d599d TL |
497 | err3: |
498 | pm_runtime_disable(glue->dev); | |
499 | ||
65b3d52d | 500 | err2: |
b1183c24 | 501 | platform_device_put(musb); |
a3cee12a | 502 | |
dc09886b FB |
503 | err0: |
504 | return ret; | |
505 | } | |
506 | ||
fb4e98ab | 507 | static int omap2430_remove(struct platform_device *pdev) |
dc09886b | 508 | { |
21f77bee | 509 | struct omap2430_glue *glue = platform_get_drvdata(pdev); |
dc09886b | 510 | |
f039df58 | 511 | platform_device_unregister(glue->musb); |
03e43528 | 512 | pm_runtime_disable(glue->dev); |
dc09886b FB |
513 | |
514 | return 0; | |
515 | } | |
516 | ||
c20aebb9 | 517 | #ifdef CONFIG_PM |
c20aebb9 | 518 | |
7acc6197 | 519 | static int omap2430_runtime_suspend(struct device *dev) |
c20aebb9 FB |
520 | { |
521 | struct omap2430_glue *glue = dev_get_drvdata(dev); | |
522 | struct musb *musb = glue_to_musb(glue); | |
523 | ||
a83e17d0 TL |
524 | if (!musb) |
525 | return 0; | |
e25bec16 | 526 | |
a83e17d0 TL |
527 | musb->context.otg_interfsel = musb_readl(musb->mregs, |
528 | OTG_INTERFSEL); | |
529 | ||
530 | omap2430_low_level_exit(musb); | |
c20aebb9 | 531 | |
10ac7e77 TL |
532 | phy_power_off(musb->phy); |
533 | phy_exit(musb->phy); | |
534 | ||
c20aebb9 FB |
535 | return 0; |
536 | } | |
537 | ||
7acc6197 | 538 | static int omap2430_runtime_resume(struct device *dev) |
c20aebb9 FB |
539 | { |
540 | struct omap2430_glue *glue = dev_get_drvdata(dev); | |
541 | struct musb *musb = glue_to_musb(glue); | |
c20aebb9 | 542 | |
8f2279d5 | 543 | if (!musb) |
a83e17d0 | 544 | return 0; |
8f2279d5 | 545 | |
10ac7e77 TL |
546 | phy_init(musb->phy); |
547 | phy_power_on(musb->phy); | |
548 | ||
8f2279d5 TL |
549 | omap2430_low_level_init(musb); |
550 | musb_writel(musb->mregs, OTG_INTERFSEL, | |
551 | musb->context.otg_interfsel); | |
c20aebb9 FB |
552 | |
553 | return 0; | |
554 | } | |
555 | ||
c0927fea | 556 | static const struct dev_pm_ops omap2430_pm_ops = { |
7acc6197 HH |
557 | .runtime_suspend = omap2430_runtime_suspend, |
558 | .runtime_resume = omap2430_runtime_resume, | |
c20aebb9 FB |
559 | }; |
560 | ||
561 | #define DEV_PM_OPS (&omap2430_pm_ops) | |
562 | #else | |
563 | #define DEV_PM_OPS NULL | |
564 | #endif | |
565 | ||
00a0b1d5 KVA |
566 | #ifdef CONFIG_OF |
567 | static const struct of_device_id omap2430_id_table[] = { | |
568 | { | |
569 | .compatible = "ti,omap4-musb" | |
570 | }, | |
571 | { | |
572 | .compatible = "ti,omap3-musb" | |
573 | }, | |
574 | {}, | |
575 | }; | |
576 | MODULE_DEVICE_TABLE(of, omap2430_id_table); | |
577 | #endif | |
578 | ||
dc09886b | 579 | static struct platform_driver omap2430_driver = { |
e9e8c85e | 580 | .probe = omap2430_probe, |
7690417d | 581 | .remove = omap2430_remove, |
dc09886b FB |
582 | .driver = { |
583 | .name = "musb-omap2430", | |
c20aebb9 | 584 | .pm = DEV_PM_OPS, |
00a0b1d5 | 585 | .of_match_table = of_match_ptr(omap2430_id_table), |
dc09886b FB |
586 | }, |
587 | }; | |
588 | ||
aec373c1 TL |
589 | module_platform_driver(omap2430_driver); |
590 | ||
dc09886b FB |
591 | MODULE_DESCRIPTION("OMAP2PLUS MUSB Glue Layer"); |
592 | MODULE_AUTHOR("Felipe Balbi <balbi@ti.com>"); | |
593 | MODULE_LICENSE("GPL v2"); |