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/usb_phy_generic.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->otg->state));
218
219 spin_lock_irqsave(&musb->lock, flags);
220 switch (musb->xceiv->otg->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->otg->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->otg->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) && 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->otg->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->otg->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->otg->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->otg->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->otg->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 musb->xceiv = usb_get_phy(USB_PHY_TYPE_USB2);
385 if (IS_ERR_OR_NULL(musb->xceiv)) {
386 ret = -EPROBE_DEFER;
387 goto unregister;
388 }
389
390 musb->mregs += DAVINCI_BASE_OFFSET;
391
392
393 revision = musb_readl(tibase, DAVINCI_USB_VERSION_REG);
394 if (revision == 0)
395 goto fail;
396
397 setup_timer(&otg_workaround, otg_timer, (unsigned long) musb);
398
399 davinci_musb_source_power(musb, 0, 1);
400
401
402
403
404 if (machine_is_davinci_dm355_evm()) {
405 u32 phy_ctrl = __raw_readl(USB_PHY_CTRL);
406
407 phy_ctrl &= ~(3 << 9);
408 phy_ctrl |= USBPHY_DATAPOL;
409 __raw_writel(phy_ctrl, USB_PHY_CTRL);
410 }
411
412
413
414
415 if (cpu_is_davinci_dm355()) {
416 u32 deepsleep = __raw_readl(DM355_DEEPSLEEP);
417
418 deepsleep &= ~DRVVBUS_FORCE;
419 __raw_writel(deepsleep, DM355_DEEPSLEEP);
420 }
421
422
423 musb_writel(tibase, DAVINCI_USB_CTRL_REG, 0x1);
424
425
426 phy_on();
427
428 msleep(5);
429
430
431 pr_debug("DaVinci OTG revision %08x phy %03x control %02x\n",
432 revision, __raw_readl(USB_PHY_CTRL),
433 musb_readb(tibase, DAVINCI_USB_CTRL_REG));
434
435 musb->isr = davinci_musb_interrupt;
436 return 0;
437
438fail:
439 usb_put_phy(musb->xceiv);
440unregister:
441 usb_phy_generic_unregister();
442 return ret;
443}
444
445static int davinci_musb_exit(struct musb *musb)
446{
447 del_timer_sync(&otg_workaround);
448
449
450 if (cpu_is_davinci_dm355()) {
451 u32 deepsleep = __raw_readl(DM355_DEEPSLEEP);
452
453 deepsleep &= ~DRVVBUS_FORCE;
454 deepsleep |= DRVVBUS_OVERRIDE;
455 __raw_writel(deepsleep, DM355_DEEPSLEEP);
456 }
457
458 davinci_musb_source_power(musb, 0 , 1);
459
460
461 if (musb->xceiv->otg->default_a) {
462 int maxdelay = 30;
463 u8 devctl, warn = 0;
464
465
466
467
468 do {
469 devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
470 if (!(devctl & MUSB_DEVCTL_VBUS))
471 break;
472 if ((devctl & MUSB_DEVCTL_VBUS) != warn) {
473 warn = devctl & MUSB_DEVCTL_VBUS;
474 dev_dbg(musb->controller, "VBUS %d\n",
475 warn >> MUSB_DEVCTL_VBUS_SHIFT);
476 }
477 msleep(1000);
478 maxdelay--;
479 } while (maxdelay > 0);
480
481
482 if (devctl & MUSB_DEVCTL_VBUS)
483 dev_dbg(musb->controller, "VBUS off timeout (devctl %02x)\n", devctl);
484 }
485
486 phy_off();
487
488 usb_put_phy(musb->xceiv);
489
490 return 0;
491}
492
493static const struct musb_platform_ops davinci_ops = {
494 .quirks = MUSB_DMA_CPPI,
495 .init = davinci_musb_init,
496 .exit = davinci_musb_exit,
497
498#ifdef CONFIG_USB_TI_CPPI_DMA
499 .dma_init = cppi_dma_controller_create,
500 .dma_exit = cppi_dma_controller_destroy,
501#endif
502 .enable = davinci_musb_enable,
503 .disable = davinci_musb_disable,
504
505 .set_mode = davinci_musb_set_mode,
506
507 .set_vbus = davinci_musb_set_vbus,
508};
509
510static const struct platform_device_info davinci_dev_info = {
511 .name = "musb-hdrc",
512 .id = PLATFORM_DEVID_AUTO,
513 .dma_mask = DMA_BIT_MASK(32),
514};
515
516static int davinci_probe(struct platform_device *pdev)
517{
518 struct resource musb_resources[3];
519 struct musb_hdrc_platform_data *pdata = dev_get_platdata(&pdev->dev);
520 struct platform_device *musb;
521 struct davinci_glue *glue;
522 struct platform_device_info pinfo;
523 struct clk *clk;
524
525 int ret = -ENOMEM;
526
527 glue = devm_kzalloc(&pdev->dev, sizeof(*glue), GFP_KERNEL);
528 if (!glue)
529 goto err0;
530
531 clk = devm_clk_get(&pdev->dev, "usb");
532 if (IS_ERR(clk)) {
533 dev_err(&pdev->dev, "failed to get clock\n");
534 ret = PTR_ERR(clk);
535 goto err0;
536 }
537
538 ret = clk_enable(clk);
539 if (ret) {
540 dev_err(&pdev->dev, "failed to enable clock\n");
541 goto err0;
542 }
543
544 glue->dev = &pdev->dev;
545 glue->clk = clk;
546
547 pdata->platform_ops = &davinci_ops;
548
549 usb_phy_generic_register();
550 platform_set_drvdata(pdev, glue);
551
552 memset(musb_resources, 0x00, sizeof(*musb_resources) *
553 ARRAY_SIZE(musb_resources));
554
555 musb_resources[0].name = pdev->resource[0].name;
556 musb_resources[0].start = pdev->resource[0].start;
557 musb_resources[0].end = pdev->resource[0].end;
558 musb_resources[0].flags = pdev->resource[0].flags;
559
560 musb_resources[1].name = pdev->resource[1].name;
561 musb_resources[1].start = pdev->resource[1].start;
562 musb_resources[1].end = pdev->resource[1].end;
563 musb_resources[1].flags = pdev->resource[1].flags;
564
565
566
567
568
569 musb_resources[2].name = pdev->resource[2].name;
570 musb_resources[2].start = pdev->resource[2].start;
571 musb_resources[2].end = pdev->resource[2].end;
572 musb_resources[2].flags = pdev->resource[2].flags;
573
574 pinfo = davinci_dev_info;
575 pinfo.parent = &pdev->dev;
576 pinfo.res = musb_resources;
577 pinfo.num_res = ARRAY_SIZE(musb_resources);
578 pinfo.data = pdata;
579 pinfo.size_data = sizeof(*pdata);
580
581 glue->musb = musb = platform_device_register_full(&pinfo);
582 if (IS_ERR(musb)) {
583 ret = PTR_ERR(musb);
584 dev_err(&pdev->dev, "failed to register musb device: %d\n", ret);
585 goto err1;
586 }
587
588 return 0;
589
590err1:
591 clk_disable(clk);
592
593err0:
594 return ret;
595}
596
597static int davinci_remove(struct platform_device *pdev)
598{
599 struct davinci_glue *glue = platform_get_drvdata(pdev);
600
601 platform_device_unregister(glue->musb);
602 usb_phy_generic_unregister();
603 clk_disable(glue->clk);
604
605 return 0;
606}
607
608static struct platform_driver davinci_driver = {
609 .probe = davinci_probe,
610 .remove = davinci_remove,
611 .driver = {
612 .name = "musb-davinci",
613 },
614};
615
616MODULE_DESCRIPTION("DaVinci MUSB Glue Layer");
617MODULE_AUTHOR("Felipe Balbi <balbi@ti.com>");
618MODULE_LICENSE("GPL v2");
619module_platform_driver(davinci_driver);
620