]> git.proxmox.com Git - mirror_ubuntu-artful-kernel.git/blame - drivers/usb/musb/davinci.c
Merge tag 'sound-4.11-rc1' of git://git.kernel.org/pub/scm/linux/kernel/git/tiwai...
[mirror_ubuntu-artful-kernel.git] / drivers / usb / musb / davinci.c
CommitLineData
550a7375
FB
1/*
2 * Copyright (C) 2005-2006 by Texas Instruments
3 *
4 * This file is part of the Inventra Controller Driver for Linux.
5 *
6 * The Inventra Controller Driver for Linux is free software; you
7 * can redistribute it and/or modify it under the terms of the GNU
8 * General Public License version 2 as published by the Free Software
9 * Foundation.
10 *
11 * The Inventra Controller Driver for Linux is distributed in
12 * the hope that it will be useful, but WITHOUT ANY WARRANTY;
13 * without even the implied warranty of MERCHANTABILITY or
14 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public
15 * License for more details.
16 *
17 * You should have received a copy of the GNU General Public License
18 * along with The Inventra Controller Driver for Linux ; if not,
19 * write to the Free Software Foundation, Inc., 59 Temple Place,
20 * Suite 330, Boston, MA 02111-1307 USA
21 *
22 */
23
24#include <linux/module.h>
25#include <linux/kernel.h>
26#include <linux/sched.h>
550a7375
FB
27#include <linux/list.h>
28#include <linux/delay.h>
29#include <linux/clk.h>
ded017ee 30#include <linux/err.h>
550a7375 31#include <linux/io.h>
c767c1c6 32#include <linux/gpio.h>
73b089b0
FB
33#include <linux/platform_device.h>
34#include <linux/dma-mapping.h>
d7078df6 35#include <linux/usb/usb_phy_generic.h>
550a7375 36
d163ef24 37#include <mach/cputype.h>
6594b2d7 38#include <mach/hardware.h>
10b4eade 39
550a7375
FB
40#include <asm/mach-types.h>
41
42#include "musb_core.h"
43
44#ifdef CONFIG_MACH_DAVINCI_EVM
a2396a32 45#define GPIO_nVBUS_DRV 160
550a7375
FB
46#endif
47
48#include "davinci.h"
49#include "cppi_dma.h"
50
51
a227fd7d
DB
52#define USB_PHY_CTRL IO_ADDRESS(USBPHY_CTL_PADDR)
53#define DM355_DEEPSLEEP IO_ADDRESS(DM355_DEEPSLEEP_PADDR)
54
e110de4d
FB
55struct davinci_glue {
56 struct device *dev;
57 struct platform_device *musb;
03491761 58 struct clk *clk;
e110de4d
FB
59};
60
550a7375
FB
61/* REVISIT (PM) we should be able to keep the PHY in low power mode most
62 * of the time (24 MHZ oscillator and PLL off, etc) by setting POWER.D0
63 * and, when in host mode, autosuspending idle root ports... PHYPLLON
64 * (overriding SUSPENDM?) then likely needs to stay off.
65 */
66
67static inline void phy_on(void)
68{
a227fd7d
DB
69 u32 phy_ctrl = __raw_readl(USB_PHY_CTRL);
70
71 /* power everything up; start the on-chip PHY and its PLL */
72 phy_ctrl &= ~(USBPHY_OSCPDWN | USBPHY_OTGPDWN | USBPHY_PHYPDWN);
73 phy_ctrl |= USBPHY_SESNDEN | USBPHY_VBDTCTEN | USBPHY_PHYPLLON;
74 __raw_writel(phy_ctrl, USB_PHY_CTRL);
75
76 /* wait for PLL to lock before proceeding */
77 while ((__raw_readl(USB_PHY_CTRL) & USBPHY_PHYCLKGD) == 0)
550a7375
FB
78 cpu_relax();
79}
80
81static inline void phy_off(void)
82{
a227fd7d
DB
83 u32 phy_ctrl = __raw_readl(USB_PHY_CTRL);
84
85 /* powerdown the on-chip PHY, its PLL, and the OTG block */
86 phy_ctrl &= ~(USBPHY_SESNDEN | USBPHY_VBDTCTEN | USBPHY_PHYPLLON);
87 phy_ctrl |= USBPHY_OSCPDWN | USBPHY_OTGPDWN | USBPHY_PHYPDWN;
88 __raw_writel(phy_ctrl, USB_PHY_CTRL);
550a7375
FB
89}
90
91static int dma_off = 1;
92
743411b3 93static void davinci_musb_enable(struct musb *musb)
550a7375
FB
94{
95 u32 tmp, old, val;
96
97 /* workaround: setup irqs through both register sets */
98 tmp = (musb->epmask & DAVINCI_USB_TX_ENDPTS_MASK)
99 << DAVINCI_USB_TXINT_SHIFT;
100 musb_writel(musb->ctrl_base, DAVINCI_USB_INT_MASK_SET_REG, tmp);
101 old = tmp;
102 tmp = (musb->epmask & (0xfffe & DAVINCI_USB_RX_ENDPTS_MASK))
103 << DAVINCI_USB_RXINT_SHIFT;
104 musb_writel(musb->ctrl_base, DAVINCI_USB_INT_MASK_SET_REG, tmp);
105 tmp |= old;
106
107 val = ~MUSB_INTR_SOF;
108 tmp |= ((val & 0x01ff) << DAVINCI_USB_USBINT_SHIFT);
109 musb_writel(musb->ctrl_base, DAVINCI_USB_INT_MASK_SET_REG, tmp);
110
111 if (is_dma_capable() && !dma_off)
112 printk(KERN_WARNING "%s %s: dma not reactivated\n",
113 __FILE__, __func__);
114 else
115 dma_off = 0;
116
117 /* force a DRVVBUS irq so we can start polling for ID change */
032ec49f 118 musb_writel(musb->ctrl_base, DAVINCI_USB_INT_SET_REG,
550a7375
FB
119 DAVINCI_INTR_DRVVBUS << DAVINCI_USB_USBINT_SHIFT);
120}
121
122/*
123 * Disable the HDRC and flush interrupts
124 */
743411b3 125static void davinci_musb_disable(struct musb *musb)
550a7375
FB
126{
127 /* because we don't set CTRLR.UINT, "important" to:
128 * - not read/write INTRUSB/INTRUSBE
129 * - (except during initial setup, as workaround)
130 * - use INTSETR/INTCLRR instead
131 */
132 musb_writel(musb->ctrl_base, DAVINCI_USB_INT_MASK_CLR_REG,
133 DAVINCI_USB_USBINT_MASK
134 | DAVINCI_USB_TXINT_MASK
135 | DAVINCI_USB_RXINT_MASK);
550a7375
FB
136 musb_writel(musb->ctrl_base, DAVINCI_USB_EOI_REG, 0);
137
138 if (is_dma_capable() && !dma_off)
139 WARNING("dma still active\n");
140}
141
142
550a7375 143#define portstate(stmt) stmt
550a7375 144
a227fd7d
DB
145/*
146 * VBUS SWITCHING IS BOARD-SPECIFIC ... at least for the DM6446 EVM,
147 * which doesn't wire DRVVBUS to the FET that switches it. Unclear
148 * if that's a problem with the DM6446 chip or just with that board.
149 *
150 * In either case, the DM355 EVM automates DRVVBUS the normal way,
151 * when J10 is out, and TI documents it as handling OTG.
152 */
550a7375
FB
153
154#ifdef CONFIG_MACH_DAVINCI_EVM
550a7375 155
a227fd7d
DB
156static int vbus_state = -1;
157
550a7375
FB
158/* I2C operations are always synchronous, and require a task context.
159 * With unloaded systems, using the shared workqueue seems to suffice
160 * to satisfy the 100msec A_WAIT_VRISE timeout...
161 */
162static void evm_deferred_drvvbus(struct work_struct *ignored)
163{
c767c1c6 164 gpio_set_value_cansleep(GPIO_nVBUS_DRV, vbus_state);
550a7375
FB
165 vbus_state = !vbus_state;
166}
550a7375 167
550a7375
FB
168#endif /* EVM */
169
743411b3 170static void davinci_musb_source_power(struct musb *musb, int is_on, int immediate)
550a7375 171{
a227fd7d 172#ifdef CONFIG_MACH_DAVINCI_EVM
550a7375
FB
173 if (is_on)
174 is_on = 1;
175
176 if (vbus_state == is_on)
177 return;
178 vbus_state = !is_on; /* 0/1 vs "-1 == unknown/init" */
179
550a7375 180 if (machine_is_davinci_evm()) {
a227fd7d
DB
181 static DECLARE_WORK(evm_vbus_work, evm_deferred_drvvbus);
182
550a7375 183 if (immediate)
c767c1c6 184 gpio_set_value_cansleep(GPIO_nVBUS_DRV, vbus_state);
550a7375
FB
185 else
186 schedule_work(&evm_vbus_work);
550a7375 187 }
550a7375
FB
188 if (immediate)
189 vbus_state = is_on;
a227fd7d 190#endif
550a7375
FB
191}
192
743411b3 193static void davinci_musb_set_vbus(struct musb *musb, int is_on)
550a7375
FB
194{
195 WARN_ON(is_on && is_peripheral_active(musb));
743411b3 196 davinci_musb_source_power(musb, is_on, 0);
550a7375
FB
197}
198
199
200#define POLL_SECONDS 2
201
202static struct timer_list otg_workaround;
203
204static void otg_timer(unsigned long _musb)
205{
206 struct musb *musb = (void *)_musb;
207 void __iomem *mregs = musb->mregs;
208 u8 devctl;
209 unsigned long flags;
210
211 /* We poll because DaVinci's won't expose several OTG-critical
212 * status change events (from the transceiver) otherwise.
213 */
214 devctl = musb_readb(mregs, MUSB_DEVCTL);
5c8a86e1 215 dev_dbg(musb->controller, "poll devctl %02x (%s)\n", devctl,
e47d9254 216 usb_otg_state_string(musb->xceiv->otg->state));
550a7375
FB
217
218 spin_lock_irqsave(&musb->lock, flags);
e47d9254 219 switch (musb->xceiv->otg->state) {
550a7375
FB
220 case OTG_STATE_A_WAIT_VFALL:
221 /* Wait till VBUS falls below SessionEnd (~0.2V); the 1.3 RTL
222 * seems to mis-handle session "start" otherwise (or in our
223 * case "recover"), in routine "VBUS was valid by the time
224 * VBUSERR got reported during enumeration" cases.
225 */
226 if (devctl & MUSB_DEVCTL_VBUS) {
227 mod_timer(&otg_workaround, jiffies + POLL_SECONDS * HZ);
228 break;
229 }
e47d9254 230 musb->xceiv->otg->state = OTG_STATE_A_WAIT_VRISE;
550a7375
FB
231 musb_writel(musb->ctrl_base, DAVINCI_USB_INT_SET_REG,
232 MUSB_INTR_VBUSERROR << DAVINCI_USB_USBINT_SHIFT);
233 break;
234 case OTG_STATE_B_IDLE:
032ec49f
FB
235 /*
236 * There's no ID-changed IRQ, so we have no good way to tell
550a7375
FB
237 * when to switch to the A-Default state machine (by setting
238 * the DEVCTL.SESSION flag).
239 *
240 * Workaround: whenever we're in B_IDLE, try setting the
241 * session flag every few seconds. If it works, ID was
242 * grounded and we're now in the A-Default state machine.
243 *
244 * NOTE setting the session flag is _supposed_ to trigger
245 * SRP, but clearly it doesn't.
246 */
247 musb_writeb(mregs, MUSB_DEVCTL,
248 devctl | MUSB_DEVCTL_SESSION);
249 devctl = musb_readb(mregs, MUSB_DEVCTL);
250 if (devctl & MUSB_DEVCTL_BDEVICE)
251 mod_timer(&otg_workaround, jiffies + POLL_SECONDS * HZ);
252 else
e47d9254 253 musb->xceiv->otg->state = OTG_STATE_A_IDLE;
550a7375
FB
254 break;
255 default:
256 break;
257 }
258 spin_unlock_irqrestore(&musb->lock, flags);
259}
260
743411b3 261static irqreturn_t davinci_musb_interrupt(int irq, void *__hci)
550a7375
FB
262{
263 unsigned long flags;
264 irqreturn_t retval = IRQ_NONE;
265 struct musb *musb = __hci;
d445b6da 266 struct usb_otg *otg = musb->xceiv->otg;
550a7375 267 void __iomem *tibase = musb->ctrl_base;
91e9c4fe 268 struct cppi *cppi;
550a7375
FB
269 u32 tmp;
270
271 spin_lock_irqsave(&musb->lock, flags);
272
273 /* NOTE: DaVinci shadows the Mentor IRQs. Don't manage them through
274 * the Mentor registers (except for setup), use the TI ones and EOI.
275 *
dfff0615 276 * Docs describe irq "vector" registers associated with the CPPI and
550a7375
FB
277 * USB EOI registers. These hold a bitmask corresponding to the
278 * current IRQ, not an irq handler address. Would using those bits
279 * resolve some of the races observed in this dispatch code??
280 */
281
282 /* CPPI interrupts share the same IRQ line, but have their own
283 * mask, state, "vector", and EOI registers.
284 */
91e9c4fe 285 cppi = container_of(musb->dma_controller, struct cppi, controller);
f8e9f34f 286 if (is_cppi_enabled(musb) && musb->dma_controller && !cppi->irq)
91e9c4fe 287 retval = cppi_interrupt(irq, __hci);
550a7375
FB
288
289 /* ack and handle non-CPPI interrupts */
290 tmp = musb_readl(tibase, DAVINCI_USB_INT_SRC_MASKED_REG);
291 musb_writel(tibase, DAVINCI_USB_INT_SRC_CLR_REG, tmp);
5c8a86e1 292 dev_dbg(musb->controller, "IRQ %08x\n", tmp);
550a7375
FB
293
294 musb->int_rx = (tmp & DAVINCI_USB_RXINT_MASK)
295 >> DAVINCI_USB_RXINT_SHIFT;
296 musb->int_tx = (tmp & DAVINCI_USB_TXINT_MASK)
297 >> DAVINCI_USB_TXINT_SHIFT;
298 musb->int_usb = (tmp & DAVINCI_USB_USBINT_MASK)
299 >> DAVINCI_USB_USBINT_SHIFT;
300
301 /* DRVVBUS irqs are the only proxy we have (a very poor one!) for
302 * DaVinci's missing ID change IRQ. We need an ID change IRQ to
303 * switch appropriately between halves of the OTG state machine.
304 * Managing DEVCTL.SESSION per Mentor docs requires we know its
305 * value, but DEVCTL.BDEVICE is invalid without DEVCTL.SESSION set.
306 * Also, DRVVBUS pulses for SRP (but not at 5V) ...
307 */
308 if (tmp & (DAVINCI_INTR_DRVVBUS << DAVINCI_USB_USBINT_SHIFT)) {
309 int drvvbus = musb_readl(tibase, DAVINCI_USB_STAT_REG);
310 void __iomem *mregs = musb->mregs;
311 u8 devctl = musb_readb(mregs, MUSB_DEVCTL);
312 int err = musb->int_usb & MUSB_INTR_VBUSERROR;
313
032ec49f 314 err = musb->int_usb & MUSB_INTR_VBUSERROR;
550a7375
FB
315 if (err) {
316 /* The Mentor core doesn't debounce VBUS as needed
317 * to cope with device connect current spikes. This
318 * means it's not uncommon for bus-powered devices
319 * to get VBUS errors during enumeration.
320 *
321 * This is a workaround, but newer RTL from Mentor
322 * seems to allow a better one: "re"starting sessions
323 * without waiting (on EVM, a **long** time) for VBUS
324 * to stop registering in devctl.
325 */
326 musb->int_usb &= ~MUSB_INTR_VBUSERROR;
e47d9254 327 musb->xceiv->otg->state = OTG_STATE_A_WAIT_VFALL;
550a7375
FB
328 mod_timer(&otg_workaround, jiffies + POLL_SECONDS * HZ);
329 WARNING("VBUS error workaround (delay coming)\n");
032ec49f 330 } else if (drvvbus) {
550a7375 331 MUSB_HST_MODE(musb);
d445b6da 332 otg->default_a = 1;
e47d9254 333 musb->xceiv->otg->state = OTG_STATE_A_WAIT_VRISE;
550a7375
FB
334 portstate(musb->port1_status |= USB_PORT_STAT_POWER);
335 del_timer(&otg_workaround);
336 } else {
337 musb->is_active = 0;
338 MUSB_DEV_MODE(musb);
d445b6da 339 otg->default_a = 0;
e47d9254 340 musb->xceiv->otg->state = OTG_STATE_B_IDLE;
550a7375
FB
341 portstate(musb->port1_status &= ~USB_PORT_STAT_POWER);
342 }
343
89368d3d
DB
344 /* NOTE: this must complete poweron within 100 msec
345 * (OTG_TIME_A_WAIT_VRISE) but we don't check for that.
346 */
743411b3 347 davinci_musb_source_power(musb, drvvbus, 0);
5c8a86e1 348 dev_dbg(musb->controller, "VBUS %s (%s)%s, devctl %02x\n",
550a7375 349 drvvbus ? "on" : "off",
e47d9254 350 usb_otg_state_string(musb->xceiv->otg->state),
550a7375
FB
351 err ? " ERROR" : "",
352 devctl);
353 retval = IRQ_HANDLED;
354 }
355
356 if (musb->int_tx || musb->int_rx || musb->int_usb)
357 retval |= musb_interrupt(musb);
358
359 /* irq stays asserted until EOI is written */
360 musb_writel(tibase, DAVINCI_USB_EOI_REG, 0);
361
362 /* poll for ID change */
e47d9254 363 if (musb->xceiv->otg->state == OTG_STATE_B_IDLE)
550a7375
FB
364 mod_timer(&otg_workaround, jiffies + POLL_SECONDS * HZ);
365
366 spin_unlock_irqrestore(&musb->lock, flags);
367
a5073b52 368 return retval;
550a7375
FB
369}
370
743411b3 371static int davinci_musb_set_mode(struct musb *musb, u8 mode)
96a274d1
DB
372{
373 /* EVM can't do this (right?) */
374 return -EIO;
375}
376
743411b3 377static int davinci_musb_init(struct musb *musb)
550a7375
FB
378{
379 void __iomem *tibase = musb->ctrl_base;
380 u32 revision;
25736e0c 381 int ret = -ENODEV;
550a7375 382
662dca54 383 musb->xceiv = usb_get_phy(USB_PHY_TYPE_USB2);
25736e0c
ML
384 if (IS_ERR_OR_NULL(musb->xceiv)) {
385 ret = -EPROBE_DEFER;
c67dd31c 386 goto unregister;
25736e0c 387 }
84e250ff 388
550a7375 389 musb->mregs += DAVINCI_BASE_OFFSET;
550a7375 390
550a7375
FB
391 /* returns zero if e.g. not clocked */
392 revision = musb_readl(tibase, DAVINCI_USB_VERSION_REG);
393 if (revision == 0)
84e250ff 394 goto fail;
550a7375 395
032ec49f 396 setup_timer(&otg_workaround, otg_timer, (unsigned long) musb);
550a7375 397
743411b3 398 davinci_musb_source_power(musb, 0, 1);
550a7375 399
a227fd7d
DB
400 /* dm355 EVM swaps D+/D- for signal integrity, and
401 * is clocked from the main 24 MHz crystal.
402 */
403 if (machine_is_davinci_dm355_evm()) {
404 u32 phy_ctrl = __raw_readl(USB_PHY_CTRL);
405
406 phy_ctrl &= ~(3 << 9);
407 phy_ctrl |= USBPHY_DATAPOL;
408 __raw_writel(phy_ctrl, USB_PHY_CTRL);
409 }
410
d163ef24
DB
411 /* On dm355, the default-A state machine needs DRVVBUS control.
412 * If we won't be a host, there's no need to turn it on.
413 */
414 if (cpu_is_davinci_dm355()) {
415 u32 deepsleep = __raw_readl(DM355_DEEPSLEEP);
416
032ec49f 417 deepsleep &= ~DRVVBUS_FORCE;
d163ef24
DB
418 __raw_writel(deepsleep, DM355_DEEPSLEEP);
419 }
420
550a7375
FB
421 /* reset the controller */
422 musb_writel(tibase, DAVINCI_USB_CTRL_REG, 0x1);
423
424 /* start the on-chip PHY and its PLL */
425 phy_on();
426
427 msleep(5);
428
429 /* NOTE: irqs are in mixed mode, not bypass to pure-musb */
430 pr_debug("DaVinci OTG revision %08x phy %03x control %02x\n",
a227fd7d 431 revision, __raw_readl(USB_PHY_CTRL),
550a7375
FB
432 musb_readb(tibase, DAVINCI_USB_CTRL_REG));
433
743411b3 434 musb->isr = davinci_musb_interrupt;
550a7375 435 return 0;
84e250ff
DB
436
437fail:
721002ec 438 usb_put_phy(musb->xceiv);
c67dd31c 439unregister:
4525beeb 440 usb_phy_generic_unregister();
25736e0c 441 return ret;
550a7375
FB
442}
443
743411b3 444static int davinci_musb_exit(struct musb *musb)
550a7375 445{
032ec49f 446 del_timer_sync(&otg_workaround);
550a7375 447
d163ef24
DB
448 /* force VBUS off */
449 if (cpu_is_davinci_dm355()) {
450 u32 deepsleep = __raw_readl(DM355_DEEPSLEEP);
451
452 deepsleep &= ~DRVVBUS_FORCE;
453 deepsleep |= DRVVBUS_OVERRIDE;
454 __raw_writel(deepsleep, DM355_DEEPSLEEP);
455 }
456
743411b3 457 davinci_musb_source_power(musb, 0 /*off*/, 1);
550a7375
FB
458
459 /* delay, to avoid problems with module reload */
032ec49f 460 if (musb->xceiv->otg->default_a) {
550a7375
FB
461 int maxdelay = 30;
462 u8 devctl, warn = 0;
463
464 /* if there's no peripheral connected, this can take a
465 * long time to fall, especially on EVM with huge C133.
466 */
467 do {
468 devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
469 if (!(devctl & MUSB_DEVCTL_VBUS))
470 break;
471 if ((devctl & MUSB_DEVCTL_VBUS) != warn) {
472 warn = devctl & MUSB_DEVCTL_VBUS;
5c8a86e1 473 dev_dbg(musb->controller, "VBUS %d\n",
550a7375
FB
474 warn >> MUSB_DEVCTL_VBUS_SHIFT);
475 }
476 msleep(1000);
477 maxdelay--;
478 } while (maxdelay > 0);
479
480 /* in OTG mode, another host might be connected */
481 if (devctl & MUSB_DEVCTL_VBUS)
5c8a86e1 482 dev_dbg(musb->controller, "VBUS off timeout (devctl %02x)\n", devctl);
550a7375
FB
483 }
484
485 phy_off();
34f32c97 486
721002ec 487 usb_put_phy(musb->xceiv);
84e250ff 488
550a7375
FB
489 return 0;
490}
743411b3 491
f7ec9437 492static const struct musb_platform_ops davinci_ops = {
f8e9f34f 493 .quirks = MUSB_DMA_CPPI,
743411b3
FB
494 .init = davinci_musb_init,
495 .exit = davinci_musb_exit,
496
7f6283ed
TL
497#ifdef CONFIG_USB_TI_CPPI_DMA
498 .dma_init = cppi_dma_controller_create,
499 .dma_exit = cppi_dma_controller_destroy,
500#endif
743411b3
FB
501 .enable = davinci_musb_enable,
502 .disable = davinci_musb_disable,
503
504 .set_mode = davinci_musb_set_mode,
505
506 .set_vbus = davinci_musb_set_vbus,
507};
73b089b0 508
af384875
RK
509static const struct platform_device_info davinci_dev_info = {
510 .name = "musb-hdrc",
511 .id = PLATFORM_DEVID_AUTO,
512 .dma_mask = DMA_BIT_MASK(32),
513};
73b089b0 514
41ac7b3a 515static int davinci_probe(struct platform_device *pdev)
73b089b0 516{
ea78201e 517 struct resource musb_resources[3];
c1a7d67c 518 struct musb_hdrc_platform_data *pdata = dev_get_platdata(&pdev->dev);
73b089b0 519 struct platform_device *musb;
e110de4d 520 struct davinci_glue *glue;
af384875 521 struct platform_device_info pinfo;
03491761 522 struct clk *clk;
73b089b0
FB
523
524 int ret = -ENOMEM;
525
276f146a 526 glue = devm_kzalloc(&pdev->dev, sizeof(*glue), GFP_KERNEL);
26c07010 527 if (!glue)
e110de4d 528 goto err0;
e110de4d 529
276f146a 530 clk = devm_clk_get(&pdev->dev, "usb");
03491761
FB
531 if (IS_ERR(clk)) {
532 dev_err(&pdev->dev, "failed to get clock\n");
533 ret = PTR_ERR(clk);
276f146a 534 goto err0;
03491761
FB
535 }
536
537 ret = clk_enable(clk);
538 if (ret) {
539 dev_err(&pdev->dev, "failed to enable clock\n");
276f146a 540 goto err0;
03491761
FB
541 }
542
e110de4d 543 glue->dev = &pdev->dev;
03491761 544 glue->clk = clk;
e110de4d 545
f7ec9437
FB
546 pdata->platform_ops = &davinci_ops;
547
e741e637 548 usb_phy_generic_register();
e110de4d 549 platform_set_drvdata(pdev, glue);
73b089b0 550
09fc7d22
FB
551 memset(musb_resources, 0x00, sizeof(*musb_resources) *
552 ARRAY_SIZE(musb_resources));
553
554 musb_resources[0].name = pdev->resource[0].name;
555 musb_resources[0].start = pdev->resource[0].start;
556 musb_resources[0].end = pdev->resource[0].end;
557 musb_resources[0].flags = pdev->resource[0].flags;
558
559 musb_resources[1].name = pdev->resource[1].name;
560 musb_resources[1].start = pdev->resource[1].start;
561 musb_resources[1].end = pdev->resource[1].end;
562 musb_resources[1].flags = pdev->resource[1].flags;
ea78201e
SS
563
564 /*
565 * For DM6467 3 resources are passed. A placeholder for the 3rd
566 * resource is always there, so it's safe to always copy it...
567 */
568 musb_resources[2].name = pdev->resource[2].name;
569 musb_resources[2].start = pdev->resource[2].start;
570 musb_resources[2].end = pdev->resource[2].end;
571 musb_resources[2].flags = pdev->resource[2].flags;
09fc7d22 572
af384875
RK
573 pinfo = davinci_dev_info;
574 pinfo.parent = &pdev->dev;
575 pinfo.res = musb_resources;
576 pinfo.num_res = ARRAY_SIZE(musb_resources);
577 pinfo.data = pdata;
578 pinfo.size_data = sizeof(*pdata);
579
580 glue->musb = musb = platform_device_register_full(&pinfo);
581 if (IS_ERR(musb)) {
582 ret = PTR_ERR(musb);
583 dev_err(&pdev->dev, "failed to register musb device: %d\n", ret);
276f146a 584 goto err1;
73b089b0
FB
585 }
586
587 return 0;
588
276f146a 589err1:
03491761
FB
590 clk_disable(clk);
591
73b089b0
FB
592err0:
593 return ret;
594}
595
fb4e98ab 596static int davinci_remove(struct platform_device *pdev)
73b089b0 597{
e110de4d 598 struct davinci_glue *glue = platform_get_drvdata(pdev);
73b089b0 599
12a71f5b 600 platform_device_unregister(glue->musb);
e741e637 601 usb_phy_generic_unregister();
03491761 602 clk_disable(glue->clk);
73b089b0
FB
603
604 return 0;
605}
606
607static struct platform_driver davinci_driver = {
e9e8c85e 608 .probe = davinci_probe,
7690417d 609 .remove = davinci_remove,
73b089b0
FB
610 .driver = {
611 .name = "musb-davinci",
612 },
613};
614
615MODULE_DESCRIPTION("DaVinci MUSB Glue Layer");
616MODULE_AUTHOR("Felipe Balbi <balbi@ti.com>");
617MODULE_LICENSE("GPL v2");
8d92f6d4 618module_platform_driver(davinci_driver);