1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24#include <linux/module.h>
25#include <linux/kernel.h>
26#include <linux/sched.h>
27#include <linux/list.h>
28#include <linux/delay.h>
29#include <linux/clk.h>
30#include <linux/err.h>
31#include <linux/io.h>
32#include <linux/gpio.h>
33#include <linux/platform_device.h>
34#include <linux/dma-mapping.h>
35#include <linux/usb/nop-usb-xceiv.h>
36
37#include <mach/cputype.h>
38#include <mach/hardware.h>
39
40#include <asm/mach-types.h>
41
42#include "musb_core.h"
43
44#ifdef CONFIG_MACH_DAVINCI_EVM
45#define GPIO_nVBUS_DRV 160
46#endif
47
48#include "davinci.h"
49#include "cppi_dma.h"
50
51
52#define USB_PHY_CTRL IO_ADDRESS(USBPHY_CTL_PADDR)
53#define DM355_DEEPSLEEP IO_ADDRESS(DM355_DEEPSLEEP_PADDR)
54
55struct davinci_glue {
56 struct device *dev;
57 struct platform_device *musb;
58 struct clk *clk;
59};
60
61
62
63
64
65
66
67static inline void phy_on(void)
68{
69 u32 phy_ctrl = __raw_readl(USB_PHY_CTRL);
70
71
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
77 while ((__raw_readl(USB_PHY_CTRL) & USBPHY_PHYCLKGD) == 0)
78 cpu_relax();
79}
80
81static inline void phy_off(void)
82{
83 u32 phy_ctrl = __raw_readl(USB_PHY_CTRL);
84
85
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);
89}
90
91static int dma_off = 1;
92
93static void davinci_musb_enable(struct musb *musb)
94{
95 u32 tmp, old, val;
96
97
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
118 musb_writel(musb->ctrl_base, DAVINCI_USB_INT_SET_REG,
119 DAVINCI_INTR_DRVVBUS << DAVINCI_USB_USBINT_SHIFT);
120}
121
122
123
124
125static void davinci_musb_disable(struct musb *musb)
126{
127
128
129
130
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);
136 musb_writeb(musb->mregs, MUSB_DEVCTL, 0);
137 musb_writel(musb->ctrl_base, DAVINCI_USB_EOI_REG, 0);
138
139 if (is_dma_capable() && !dma_off)
140 WARNING("dma still active\n");
141}
142
143
144#define portstate(stmt) stmt
145
146
147
148
149
150
151
152
153
154
155#ifdef CONFIG_MACH_DAVINCI_EVM
156
157static int vbus_state = -1;
158
159
160
161
162
163static void evm_deferred_drvvbus(struct work_struct *ignored)
164{
165 gpio_set_value_cansleep(GPIO_nVBUS_DRV, vbus_state);
166 vbus_state = !vbus_state;
167}
168
169#endif
170
171static void davinci_musb_source_power(struct musb *musb, int is_on, int immediate)
172{
173#ifdef CONFIG_MACH_DAVINCI_EVM
174 if (is_on)
175 is_on = 1;
176
177 if (vbus_state == is_on)
178 return;
179 vbus_state = !is_on;
180
181 if (machine_is_davinci_evm()) {
182 static DECLARE_WORK(evm_vbus_work, evm_deferred_drvvbus);
183
184 if (immediate)
185 gpio_set_value_cansleep(GPIO_nVBUS_DRV, vbus_state);
186 else
187 schedule_work(&evm_vbus_work);
188 }
189 if (immediate)
190 vbus_state = is_on;
191#endif
192}
193
194static void davinci_musb_set_vbus(struct musb *musb, int is_on)
195{
196 WARN_ON(is_on && is_peripheral_active(musb));
197 davinci_musb_source_power(musb, is_on, 0);
198}
199
200
201#define POLL_SECONDS 2
202
203static struct timer_list otg_workaround;
204
205static void otg_timer(unsigned long _musb)
206{
207 struct musb *musb = (void *)_musb;
208 void __iomem *mregs = musb->mregs;
209 u8 devctl;
210 unsigned long flags;
211
212
213
214
215 devctl = musb_readb(mregs, MUSB_DEVCTL);
216 dev_dbg(musb->controller, "poll devctl %02x (%s)\n", devctl,
217 usb_otg_state_string(musb->xceiv->state));
218
219 spin_lock_irqsave(&musb->lock, flags);
220 switch (musb->xceiv->state) {
221 case OTG_STATE_A_WAIT_VFALL:
222
223
224
225
226
227 if (devctl & MUSB_DEVCTL_VBUS) {
228 mod_timer(&otg_workaround, jiffies + POLL_SECONDS * HZ);
229 break;
230 }
231 musb->xceiv->state = OTG_STATE_A_WAIT_VRISE;
232 musb_writel(musb->ctrl_base, DAVINCI_USB_INT_SET_REG,
233 MUSB_INTR_VBUSERROR << DAVINCI_USB_USBINT_SHIFT);
234 break;
235 case OTG_STATE_B_IDLE:
236
237
238
239
240
241
242
243
244
245
246
247
248 musb_writeb(mregs, MUSB_DEVCTL,
249 devctl | MUSB_DEVCTL_SESSION);
250 devctl = musb_readb(mregs, MUSB_DEVCTL);
251 if (devctl & MUSB_DEVCTL_BDEVICE)
252 mod_timer(&otg_workaround, jiffies + POLL_SECONDS * HZ);
253 else
254 musb->xceiv->state = OTG_STATE_A_IDLE;
255 break;
256 default:
257 break;
258 }
259 spin_unlock_irqrestore(&musb->lock, flags);
260}
261
262static irqreturn_t davinci_musb_interrupt(int irq, void *__hci)
263{
264 unsigned long flags;
265 irqreturn_t retval = IRQ_NONE;
266 struct musb *musb = __hci;
267 struct usb_otg *otg = musb->xceiv->otg;
268 void __iomem *tibase = musb->ctrl_base;
269 struct cppi *cppi;
270 u32 tmp;
271
272 spin_lock_irqsave(&musb->lock, flags);
273
274
275
276
277
278
279
280
281
282
283
284
285
286 cppi = container_of(musb->dma_controller, struct cppi, controller);
287 if (is_cppi_enabled() && musb->dma_controller && !cppi->irq)
288 retval = cppi_interrupt(irq, __hci);
289
290
291 tmp = musb_readl(tibase, DAVINCI_USB_INT_SRC_MASKED_REG);
292 musb_writel(tibase, DAVINCI_USB_INT_SRC_CLR_REG, tmp);
293 dev_dbg(musb->controller, "IRQ %08x\n", tmp);
294
295 musb->int_rx = (tmp & DAVINCI_USB_RXINT_MASK)
296 >> DAVINCI_USB_RXINT_SHIFT;
297 musb->int_tx = (tmp & DAVINCI_USB_TXINT_MASK)
298 >> DAVINCI_USB_TXINT_SHIFT;
299 musb->int_usb = (tmp & DAVINCI_USB_USBINT_MASK)
300 >> DAVINCI_USB_USBINT_SHIFT;
301
302
303
304
305
306
307
308
309 if (tmp & (DAVINCI_INTR_DRVVBUS << DAVINCI_USB_USBINT_SHIFT)) {
310 int drvvbus = musb_readl(tibase, DAVINCI_USB_STAT_REG);
311 void __iomem *mregs = musb->mregs;
312 u8 devctl = musb_readb(mregs, MUSB_DEVCTL);
313 int err = musb->int_usb & MUSB_INTR_VBUSERROR;
314
315 err = musb->int_usb & MUSB_INTR_VBUSERROR;
316 if (err) {
317
318
319
320
321
322
323
324
325
326
327 musb->int_usb &= ~MUSB_INTR_VBUSERROR;
328 musb->xceiv->state = OTG_STATE_A_WAIT_VFALL;
329 mod_timer(&otg_workaround, jiffies + POLL_SECONDS * HZ);
330 WARNING("VBUS error workaround (delay coming)\n");
331 } else if (drvvbus) {
332 MUSB_HST_MODE(musb);
333 otg->default_a = 1;
334 musb->xceiv->state = OTG_STATE_A_WAIT_VRISE;
335 portstate(musb->port1_status |= USB_PORT_STAT_POWER);
336 del_timer(&otg_workaround);
337 } else {
338 musb->is_active = 0;
339 MUSB_DEV_MODE(musb);
340 otg->default_a = 0;
341 musb->xceiv->state = OTG_STATE_B_IDLE;
342 portstate(musb->port1_status &= ~USB_PORT_STAT_POWER);
343 }
344
345
346
347
348 davinci_musb_source_power(musb, drvvbus, 0);
349 dev_dbg(musb->controller, "VBUS %s (%s)%s, devctl %02x\n",
350 drvvbus ? "on" : "off",
351 usb_otg_state_string(musb->xceiv->state),
352 err ? " ERROR" : "",
353 devctl);
354 retval = IRQ_HANDLED;
355 }
356
357 if (musb->int_tx || musb->int_rx || musb->int_usb)
358 retval |= musb_interrupt(musb);
359
360
361 musb_writel(tibase, DAVINCI_USB_EOI_REG, 0);
362
363
364 if (musb->xceiv->state == OTG_STATE_B_IDLE)
365 mod_timer(&otg_workaround, jiffies + POLL_SECONDS * HZ);
366
367 spin_unlock_irqrestore(&musb->lock, flags);
368
369 return retval;
370}
371
372static int davinci_musb_set_mode(struct musb *musb, u8 mode)
373{
374
375 return -EIO;
376}
377
378static int davinci_musb_init(struct musb *musb)
379{
380 void __iomem *tibase = musb->ctrl_base;
381 u32 revision;
382 int ret = -ENODEV;
383
384 usb_nop_xceiv_register();
385 musb->xceiv = usb_get_phy(USB_PHY_TYPE_USB2);
386 if (IS_ERR_OR_NULL(musb->xceiv)) {
387 ret = -EPROBE_DEFER;
388 goto unregister;
389 }
390
391 musb->mregs += DAVINCI_BASE_OFFSET;
392
393
394 revision = musb_readl(tibase, DAVINCI_USB_VERSION_REG);
395 if (revision == 0)
396 goto fail;
397
398 setup_timer(&otg_workaround, otg_timer, (unsigned long) musb);
399
400 davinci_musb_source_power(musb, 0, 1);
401
402
403
404
405 if (machine_is_davinci_dm355_evm()) {
406 u32 phy_ctrl = __raw_readl(USB_PHY_CTRL);
407
408 phy_ctrl &= ~(3 << 9);
409 phy_ctrl |= USBPHY_DATAPOL;
410 __raw_writel(phy_ctrl, USB_PHY_CTRL);
411 }
412
413
414
415
416 if (cpu_is_davinci_dm355()) {
417 u32 deepsleep = __raw_readl(DM355_DEEPSLEEP);
418
419 deepsleep &= ~DRVVBUS_FORCE;
420 __raw_writel(deepsleep, DM355_DEEPSLEEP);
421 }
422
423
424 musb_writel(tibase, DAVINCI_USB_CTRL_REG, 0x1);
425
426
427 phy_on();
428
429 msleep(5);
430
431
432 pr_debug("DaVinci OTG revision %08x phy %03x control %02x\n",
433 revision, __raw_readl(USB_PHY_CTRL),
434 musb_readb(tibase, DAVINCI_USB_CTRL_REG));
435
436 musb->isr = davinci_musb_interrupt;
437 return 0;
438
439fail:
440 usb_put_phy(musb->xceiv);
441unregister:
442 usb_nop_xceiv_unregister();
443 return ret;
444}
445
446static int davinci_musb_exit(struct musb *musb)
447{
448 del_timer_sync(&otg_workaround);
449
450
451 if (cpu_is_davinci_dm355()) {
452 u32 deepsleep = __raw_readl(DM355_DEEPSLEEP);
453
454 deepsleep &= ~DRVVBUS_FORCE;
455 deepsleep |= DRVVBUS_OVERRIDE;
456 __raw_writel(deepsleep, DM355_DEEPSLEEP);
457 }
458
459 davinci_musb_source_power(musb, 0 , 1);
460
461
462 if (musb->xceiv->otg->default_a) {
463 int maxdelay = 30;
464 u8 devctl, warn = 0;
465
466
467
468
469 do {
470 devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
471 if (!(devctl & MUSB_DEVCTL_VBUS))
472 break;
473 if ((devctl & MUSB_DEVCTL_VBUS) != warn) {
474 warn = devctl & MUSB_DEVCTL_VBUS;
475 dev_dbg(musb->controller, "VBUS %d\n",
476 warn >> MUSB_DEVCTL_VBUS_SHIFT);
477 }
478 msleep(1000);
479 maxdelay--;
480 } while (maxdelay > 0);
481
482
483 if (devctl & MUSB_DEVCTL_VBUS)
484 dev_dbg(musb->controller, "VBUS off timeout (devctl %02x)\n", devctl);
485 }
486
487 phy_off();
488
489 usb_put_phy(musb->xceiv);
490 usb_nop_xceiv_unregister();
491
492 return 0;
493}
494
495static const struct musb_platform_ops davinci_ops = {
496 .init = davinci_musb_init,
497 .exit = davinci_musb_exit,
498
499 .enable = davinci_musb_enable,
500 .disable = davinci_musb_disable,
501
502 .set_mode = davinci_musb_set_mode,
503
504 .set_vbus = davinci_musb_set_vbus,
505};
506
507static u64 davinci_dmamask = DMA_BIT_MASK(32);
508
509static int davinci_probe(struct platform_device *pdev)
510{
511 struct musb_hdrc_platform_data *pdata = pdev->dev.platform_data;
512 struct platform_device *musb;
513 struct davinci_glue *glue;
514 struct clk *clk;
515
516 int ret = -ENOMEM;
517
518 glue = kzalloc(sizeof(*glue), GFP_KERNEL);
519 if (!glue) {
520 dev_err(&pdev->dev, "failed to allocate glue context\n");
521 goto err0;
522 }
523
524 musb = platform_device_alloc("musb-hdrc", PLATFORM_DEVID_AUTO);
525 if (!musb) {
526 dev_err(&pdev->dev, "failed to allocate musb device\n");
527 goto err1;
528 }
529
530 clk = clk_get(&pdev->dev, "usb");
531 if (IS_ERR(clk)) {
532 dev_err(&pdev->dev, "failed to get clock\n");
533 ret = PTR_ERR(clk);
534 goto err3;
535 }
536
537 ret = clk_enable(clk);
538 if (ret) {
539 dev_err(&pdev->dev, "failed to enable clock\n");
540 goto err4;
541 }
542
543 musb->dev.parent = &pdev->dev;
544 musb->dev.dma_mask = &davinci_dmamask;
545 musb->dev.coherent_dma_mask = davinci_dmamask;
546
547 glue->dev = &pdev->dev;
548 glue->musb = musb;
549 glue->clk = clk;
550
551 pdata->platform_ops = &davinci_ops;
552
553 platform_set_drvdata(pdev, glue);
554
555 ret = platform_device_add_resources(musb, pdev->resource,
556 pdev->num_resources);
557 if (ret) {
558 dev_err(&pdev->dev, "failed to add resources\n");
559 goto err5;
560 }
561
562 ret = platform_device_add_data(musb, pdata, sizeof(*pdata));
563 if (ret) {
564 dev_err(&pdev->dev, "failed to add platform_data\n");
565 goto err5;
566 }
567
568 ret = platform_device_add(musb);
569 if (ret) {
570 dev_err(&pdev->dev, "failed to register musb device\n");
571 goto err5;
572 }
573
574 return 0;
575
576err5:
577 clk_disable(clk);
578
579err4:
580 clk_put(clk);
581
582err3:
583 platform_device_put(musb);
584
585err1:
586 kfree(glue);
587
588err0:
589 return ret;
590}
591
592static int davinci_remove(struct platform_device *pdev)
593{
594 struct davinci_glue *glue = platform_get_drvdata(pdev);
595
596 platform_device_unregister(glue->musb);
597 clk_disable(glue->clk);
598 clk_put(glue->clk);
599 kfree(glue);
600
601 return 0;
602}
603
604static struct platform_driver davinci_driver = {
605 .probe = davinci_probe,
606 .remove = davinci_remove,
607 .driver = {
608 .name = "musb-davinci",
609 },
610};
611
612MODULE_DESCRIPTION("DaVinci MUSB Glue Layer");
613MODULE_AUTHOR("Felipe Balbi <balbi@ti.com>");
614MODULE_LICENSE("GPL v2");
615module_platform_driver(davinci_driver);
616