1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26#include <linux/kernel.h>
27#include <linux/types.h>
28#include <linux/delay.h>
29#include <linux/pm.h>
30#include <linux/err.h>
31#include <linux/platform_device.h>
32#include <linux/fsl_devices.h>
33
34#include "ehci-fsl.h"
35
36
37
38
39
40
41
42
43
44
45
46
47
48static int usb_hcd_fsl_probe(const struct hc_driver *driver,
49 struct platform_device *pdev)
50{
51 struct fsl_usb2_platform_data *pdata;
52 struct usb_hcd *hcd;
53 struct resource *res;
54 int irq;
55 int retval;
56
57 pr_debug("initializing FSL-SOC USB Controller\n");
58
59
60 pdata = (struct fsl_usb2_platform_data *)pdev->dev.platform_data;
61 if (!pdata) {
62 dev_err(&pdev->dev,
63 "No platform data for %s.\n", dev_name(&pdev->dev));
64 return -ENODEV;
65 }
66
67
68
69
70
71 if (!((pdata->operating_mode == FSL_USB2_DR_HOST) ||
72 (pdata->operating_mode == FSL_USB2_MPH_HOST) ||
73 (pdata->operating_mode == FSL_USB2_DR_OTG))) {
74 dev_err(&pdev->dev,
75 "Non Host Mode configured for %s. Wrong driver linked.\n",
76 dev_name(&pdev->dev));
77 return -ENODEV;
78 }
79
80 res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
81 if (!res) {
82 dev_err(&pdev->dev,
83 "Found HC with no IRQ. Check %s setup!\n",
84 dev_name(&pdev->dev));
85 return -ENODEV;
86 }
87 irq = res->start;
88
89 hcd = usb_create_hcd(driver, &pdev->dev, dev_name(&pdev->dev));
90 if (!hcd) {
91 retval = -ENOMEM;
92 goto err1;
93 }
94
95 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
96 if (!res) {
97 dev_err(&pdev->dev,
98 "Found HC with no register addr. Check %s setup!\n",
99 dev_name(&pdev->dev));
100 retval = -ENODEV;
101 goto err2;
102 }
103 hcd->rsrc_start = res->start;
104 hcd->rsrc_len = resource_size(res);
105 if (!request_mem_region(hcd->rsrc_start, hcd->rsrc_len,
106 driver->description)) {
107 dev_dbg(&pdev->dev, "controller already in use\n");
108 retval = -EBUSY;
109 goto err2;
110 }
111 hcd->regs = ioremap(hcd->rsrc_start, hcd->rsrc_len);
112
113 if (hcd->regs == NULL) {
114 dev_dbg(&pdev->dev, "error mapping memory\n");
115 retval = -EFAULT;
116 goto err3;
117 }
118
119 pdata->regs = hcd->regs;
120
121 if (pdata->power_budget)
122 hcd->power_budget = pdata->power_budget;
123
124
125
126
127 if (pdata->init && pdata->init(pdev)) {
128 retval = -ENODEV;
129 goto err4;
130 }
131
132
133 if (pdata->have_sysif_regs)
134 setbits32(hcd->regs + FSL_SOC_USB_CTRL, 0x4);
135
136
137
138 retval = usb_add_hcd(hcd, irq, IRQF_SHARED);
139 if (retval != 0)
140 goto err4;
141
142#ifdef CONFIG_USB_OTG
143 if (pdata->operating_mode == FSL_USB2_DR_OTG) {
144 struct ehci_hcd *ehci = hcd_to_ehci(hcd);
145
146 hcd->phy = usb_get_phy(USB_PHY_TYPE_USB2);
147 dev_dbg(&pdev->dev, "hcd=0x%p ehci=0x%p, phy=0x%p\n",
148 hcd, ehci, hcd->phy);
149
150 if (!IS_ERR_OR_NULL(hcd->phy)) {
151 retval = otg_set_host(hcd->phy->otg,
152 &ehci_to_hcd(ehci)->self);
153 if (retval) {
154 usb_put_phy(hcd->phy);
155 goto err4;
156 }
157 } else {
158 dev_err(&pdev->dev, "can't find phy\n");
159 retval = -ENODEV;
160 goto err4;
161 }
162 }
163#endif
164 return retval;
165
166 err4:
167 iounmap(hcd->regs);
168 err3:
169 release_mem_region(hcd->rsrc_start, hcd->rsrc_len);
170 err2:
171 usb_put_hcd(hcd);
172 err1:
173 dev_err(&pdev->dev, "init %s fail, %d\n", dev_name(&pdev->dev), retval);
174 if (pdata->exit)
175 pdata->exit(pdev);
176 return retval;
177}
178
179
180
181
182
183
184
185
186
187
188
189
190static void usb_hcd_fsl_remove(struct usb_hcd *hcd,
191 struct platform_device *pdev)
192{
193 struct fsl_usb2_platform_data *pdata = pdev->dev.platform_data;
194
195 if (!IS_ERR_OR_NULL(hcd->phy)) {
196 otg_set_host(hcd->phy->otg, NULL);
197 usb_put_phy(hcd->phy);
198 }
199
200 usb_remove_hcd(hcd);
201
202
203
204
205
206 if (pdata->exit)
207 pdata->exit(pdev);
208 iounmap(hcd->regs);
209 release_mem_region(hcd->rsrc_start, hcd->rsrc_len);
210 usb_put_hcd(hcd);
211}
212
213static int ehci_fsl_setup_phy(struct usb_hcd *hcd,
214 enum fsl_usb2_phy_modes phy_mode,
215 unsigned int port_offset)
216{
217 u32 portsc;
218 struct ehci_hcd *ehci = hcd_to_ehci(hcd);
219 void __iomem *non_ehci = hcd->regs;
220 struct device *dev = hcd->self.controller;
221 struct fsl_usb2_platform_data *pdata = dev->platform_data;
222
223 if (pdata->controller_ver < 0) {
224 dev_warn(hcd->self.controller, "Could not get controller version\n");
225 return -ENODEV;
226 }
227
228 portsc = ehci_readl(ehci, &ehci->regs->port_status[port_offset]);
229 portsc &= ~(PORT_PTS_MSK | PORT_PTS_PTW);
230
231 switch (phy_mode) {
232 case FSL_USB2_PHY_ULPI:
233 if (pdata->have_sysif_regs && pdata->controller_ver) {
234
235 setbits32(non_ehci + FSL_SOC_USB_CTRL,
236 ULPI_PHY_CLK_SEL);
237
238
239
240
241
242 clrsetbits_be32(non_ehci + FSL_SOC_USB_CTRL,
243 UTMI_PHY_EN, USB_CTRL_USB_EN);
244 }
245 portsc |= PORT_PTS_ULPI;
246 break;
247 case FSL_USB2_PHY_SERIAL:
248 portsc |= PORT_PTS_SERIAL;
249 break;
250 case FSL_USB2_PHY_UTMI_WIDE:
251 portsc |= PORT_PTS_PTW;
252
253 case FSL_USB2_PHY_UTMI:
254 if (pdata->have_sysif_regs && pdata->controller_ver) {
255
256 setbits32(non_ehci + FSL_SOC_USB_CTRL, UTMI_PHY_EN);
257 mdelay(FSL_UTMI_PHY_DLY);
258
259 }
260
261 if (pdata->have_sysif_regs)
262 setbits32(non_ehci + FSL_SOC_USB_CTRL,
263 CTRL_UTMI_PHY_EN);
264 portsc |= PORT_PTS_UTMI;
265 break;
266 case FSL_USB2_PHY_NONE:
267 break;
268 }
269
270 if (pdata->have_sysif_regs && pdata->controller_ver &&
271 (phy_mode == FSL_USB2_PHY_ULPI)) {
272
273 if (!spin_event_timeout(in_be32(non_ehci + FSL_SOC_USB_CTRL) &
274 PHY_CLK_VALID, FSL_USB_PHY_CLK_TIMEOUT, 0)) {
275 printk(KERN_WARNING "fsl-ehci: USB PHY clock invalid\n");
276 return -EINVAL;
277 }
278 }
279
280 ehci_writel(ehci, portsc, &ehci->regs->port_status[port_offset]);
281
282 if (phy_mode != FSL_USB2_PHY_ULPI && pdata->have_sysif_regs)
283 setbits32(non_ehci + FSL_SOC_USB_CTRL, USB_CTRL_USB_EN);
284
285 return 0;
286}
287
288static int ehci_fsl_usb_setup(struct ehci_hcd *ehci)
289{
290 struct usb_hcd *hcd = ehci_to_hcd(ehci);
291 struct fsl_usb2_platform_data *pdata;
292 void __iomem *non_ehci = hcd->regs;
293
294 pdata = hcd->self.controller->platform_data;
295
296 if (pdata->have_sysif_regs) {
297
298
299
300
301
302
303
304 out_be32(non_ehci + FSL_SOC_USB_SNOOP1, 0x0 | SNOOP_SIZE_2GB);
305
306 out_be32(non_ehci + FSL_SOC_USB_SNOOP2, 0x80000000 | SNOOP_SIZE_2GB);
307 }
308
309 if ((pdata->operating_mode == FSL_USB2_DR_HOST) ||
310 (pdata->operating_mode == FSL_USB2_DR_OTG))
311 if (ehci_fsl_setup_phy(hcd, pdata->phy_mode, 0))
312 return -EINVAL;
313
314 if (pdata->operating_mode == FSL_USB2_MPH_HOST) {
315 unsigned int chip, rev, svr;
316
317 svr = mfspr(SPRN_SVR);
318 chip = svr >> 16;
319 rev = (svr >> 4) & 0xf;
320
321
322 if ((rev == 1) && (chip >= 0x8050) && (chip <= 0x8055))
323 ehci->has_fsl_port_bug = 1;
324
325 if (pdata->port_enables & FSL_USB2_PORT0_ENABLED)
326 if (ehci_fsl_setup_phy(hcd, pdata->phy_mode, 0))
327 return -EINVAL;
328
329 if (pdata->port_enables & FSL_USB2_PORT1_ENABLED)
330 if (ehci_fsl_setup_phy(hcd, pdata->phy_mode, 1))
331 return -EINVAL;
332 }
333
334 if (pdata->have_sysif_regs) {
335#ifdef CONFIG_FSL_SOC_BOOKE
336 out_be32(non_ehci + FSL_SOC_USB_PRICTRL, 0x00000008);
337 out_be32(non_ehci + FSL_SOC_USB_AGECNTTHRSH, 0x00000080);
338#else
339 out_be32(non_ehci + FSL_SOC_USB_PRICTRL, 0x0000000c);
340 out_be32(non_ehci + FSL_SOC_USB_AGECNTTHRSH, 0x00000040);
341#endif
342 out_be32(non_ehci + FSL_SOC_USB_SICTRL, 0x00000001);
343 }
344
345 return 0;
346}
347
348
349static int ehci_fsl_reinit(struct ehci_hcd *ehci)
350{
351 if (ehci_fsl_usb_setup(ehci))
352 return -EINVAL;
353
354 return 0;
355}
356
357
358static int ehci_fsl_setup(struct usb_hcd *hcd)
359{
360 struct ehci_hcd *ehci = hcd_to_ehci(hcd);
361 int retval;
362 struct fsl_usb2_platform_data *pdata;
363 struct device *dev;
364
365 dev = hcd->self.controller;
366 pdata = hcd->self.controller->platform_data;
367 ehci->big_endian_desc = pdata->big_endian_desc;
368 ehci->big_endian_mmio = pdata->big_endian_mmio;
369
370
371 ehci->caps = hcd->regs + 0x100;
372
373 hcd->has_tt = 1;
374
375 retval = ehci_setup(hcd);
376 if (retval)
377 return retval;
378
379 if (of_device_is_compatible(dev->parent->of_node,
380 "fsl,mpc5121-usb2-dr")) {
381
382
383
384
385 ehci_writel(ehci, SBUSCFG_INCR8,
386 hcd->regs + FSL_SOC_USB_SBUSCFG);
387 }
388
389 retval = ehci_fsl_reinit(ehci);
390 return retval;
391}
392
393struct ehci_fsl {
394 struct ehci_hcd ehci;
395
396#ifdef CONFIG_PM
397
398 u32 usb_ctrl;
399#endif
400};
401
402#ifdef CONFIG_PM
403
404#ifdef CONFIG_PPC_MPC512x
405static int ehci_fsl_mpc512x_drv_suspend(struct device *dev)
406{
407 struct usb_hcd *hcd = dev_get_drvdata(dev);
408 struct ehci_hcd *ehci = hcd_to_ehci(hcd);
409 struct fsl_usb2_platform_data *pdata = dev->platform_data;
410 u32 tmp;
411
412#ifdef DEBUG
413 u32 mode = ehci_readl(ehci, hcd->regs + FSL_SOC_USB_USBMODE);
414 mode &= USBMODE_CM_MASK;
415 tmp = ehci_readl(ehci, hcd->regs + 0x140);
416
417 dev_dbg(dev, "suspend=%d already_suspended=%d "
418 "mode=%d usbcmd %08x\n", pdata->suspended,
419 pdata->already_suspended, mode, tmp);
420#endif
421
422
423
424
425
426
427 if (pdata->suspended) {
428 dev_dbg(dev, "already suspended, leaving early\n");
429 pdata->already_suspended = 1;
430 return 0;
431 }
432
433 dev_dbg(dev, "suspending...\n");
434
435 ehci->rh_state = EHCI_RH_SUSPENDED;
436 dev->power.power_state = PMSG_SUSPEND;
437
438
439 clear_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags);
440
441
442 tmp = ehci_readl(ehci, &ehci->regs->command);
443 tmp &= ~CMD_RUN;
444 ehci_writel(ehci, tmp, &ehci->regs->command);
445
446
447 pdata->pm_command = ehci_readl(ehci, &ehci->regs->command);
448 pdata->pm_command &= ~CMD_RUN;
449 pdata->pm_status = ehci_readl(ehci, &ehci->regs->status);
450 pdata->pm_intr_enable = ehci_readl(ehci, &ehci->regs->intr_enable);
451 pdata->pm_frame_index = ehci_readl(ehci, &ehci->regs->frame_index);
452 pdata->pm_segment = ehci_readl(ehci, &ehci->regs->segment);
453 pdata->pm_frame_list = ehci_readl(ehci, &ehci->regs->frame_list);
454 pdata->pm_async_next = ehci_readl(ehci, &ehci->regs->async_next);
455 pdata->pm_configured_flag =
456 ehci_readl(ehci, &ehci->regs->configured_flag);
457 pdata->pm_portsc = ehci_readl(ehci, &ehci->regs->port_status[0]);
458 pdata->pm_usbgenctrl = ehci_readl(ehci,
459 hcd->regs + FSL_SOC_USB_USBGENCTRL);
460
461
462 pdata->pm_portsc &= cpu_to_hc32(ehci, ~PORT_RWC_BITS);
463
464 pdata->suspended = 1;
465
466
467 tmp = ehci_readl(ehci, &ehci->regs->port_status[0]);
468 tmp &= ~PORT_POWER;
469 ehci_writel(ehci, tmp, &ehci->regs->port_status[0]);
470
471 return 0;
472}
473
474static int ehci_fsl_mpc512x_drv_resume(struct device *dev)
475{
476 struct usb_hcd *hcd = dev_get_drvdata(dev);
477 struct ehci_hcd *ehci = hcd_to_ehci(hcd);
478 struct fsl_usb2_platform_data *pdata = dev->platform_data;
479 u32 tmp;
480
481 dev_dbg(dev, "suspend=%d already_suspended=%d\n",
482 pdata->suspended, pdata->already_suspended);
483
484
485
486
487
488 if (pdata->already_suspended) {
489 dev_dbg(dev, "already suspended, leaving early\n");
490 pdata->already_suspended = 0;
491 return 0;
492 }
493
494 if (!pdata->suspended) {
495 dev_dbg(dev, "not suspended, leaving early\n");
496 return 0;
497 }
498
499 pdata->suspended = 0;
500
501 dev_dbg(dev, "resuming...\n");
502
503
504 tmp = USBMODE_CM_HOST | (pdata->es ? USBMODE_ES : 0);
505 ehci_writel(ehci, tmp, hcd->regs + FSL_SOC_USB_USBMODE);
506
507 ehci_writel(ehci, pdata->pm_usbgenctrl,
508 hcd->regs + FSL_SOC_USB_USBGENCTRL);
509 ehci_writel(ehci, ISIPHYCTRL_PXE | ISIPHYCTRL_PHYE,
510 hcd->regs + FSL_SOC_USB_ISIPHYCTRL);
511
512 ehci_writel(ehci, SBUSCFG_INCR8, hcd->regs + FSL_SOC_USB_SBUSCFG);
513
514
515 ehci_writel(ehci, pdata->pm_command, &ehci->regs->command);
516 ehci_writel(ehci, pdata->pm_intr_enable, &ehci->regs->intr_enable);
517 ehci_writel(ehci, pdata->pm_frame_index, &ehci->regs->frame_index);
518 ehci_writel(ehci, pdata->pm_segment, &ehci->regs->segment);
519 ehci_writel(ehci, pdata->pm_frame_list, &ehci->regs->frame_list);
520 ehci_writel(ehci, pdata->pm_async_next, &ehci->regs->async_next);
521 ehci_writel(ehci, pdata->pm_configured_flag,
522 &ehci->regs->configured_flag);
523 ehci_writel(ehci, pdata->pm_portsc, &ehci->regs->port_status[0]);
524
525 set_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags);
526 ehci->rh_state = EHCI_RH_RUNNING;
527 dev->power.power_state = PMSG_ON;
528
529 tmp = ehci_readl(ehci, &ehci->regs->command);
530 tmp |= CMD_RUN;
531 ehci_writel(ehci, tmp, &ehci->regs->command);
532
533 usb_hcd_resume_root_hub(hcd);
534
535 return 0;
536}
537#else
538static inline int ehci_fsl_mpc512x_drv_suspend(struct device *dev)
539{
540 return 0;
541}
542
543static inline int ehci_fsl_mpc512x_drv_resume(struct device *dev)
544{
545 return 0;
546}
547#endif
548
549static struct ehci_fsl *hcd_to_ehci_fsl(struct usb_hcd *hcd)
550{
551 struct ehci_hcd *ehci = hcd_to_ehci(hcd);
552
553 return container_of(ehci, struct ehci_fsl, ehci);
554}
555
556static int ehci_fsl_drv_suspend(struct device *dev)
557{
558 struct usb_hcd *hcd = dev_get_drvdata(dev);
559 struct ehci_fsl *ehci_fsl = hcd_to_ehci_fsl(hcd);
560 void __iomem *non_ehci = hcd->regs;
561
562 if (of_device_is_compatible(dev->parent->of_node,
563 "fsl,mpc5121-usb2-dr")) {
564 return ehci_fsl_mpc512x_drv_suspend(dev);
565 }
566
567 ehci_prepare_ports_for_controller_suspend(hcd_to_ehci(hcd),
568 device_may_wakeup(dev));
569 if (!fsl_deep_sleep())
570 return 0;
571
572 ehci_fsl->usb_ctrl = in_be32(non_ehci + FSL_SOC_USB_CTRL);
573 return 0;
574}
575
576static int ehci_fsl_drv_resume(struct device *dev)
577{
578 struct usb_hcd *hcd = dev_get_drvdata(dev);
579 struct ehci_fsl *ehci_fsl = hcd_to_ehci_fsl(hcd);
580 struct ehci_hcd *ehci = hcd_to_ehci(hcd);
581 void __iomem *non_ehci = hcd->regs;
582
583 if (of_device_is_compatible(dev->parent->of_node,
584 "fsl,mpc5121-usb2-dr")) {
585 return ehci_fsl_mpc512x_drv_resume(dev);
586 }
587
588 ehci_prepare_ports_for_controller_resume(ehci);
589 if (!fsl_deep_sleep())
590 return 0;
591
592 usb_root_hub_lost_power(hcd->self.root_hub);
593
594
595 out_be32(non_ehci + FSL_SOC_USB_CTRL, ehci_fsl->usb_ctrl);
596
597 ehci_reset(ehci);
598 ehci_fsl_reinit(ehci);
599
600 return 0;
601}
602
603static int ehci_fsl_drv_restore(struct device *dev)
604{
605 struct usb_hcd *hcd = dev_get_drvdata(dev);
606
607 usb_root_hub_lost_power(hcd->self.root_hub);
608 return 0;
609}
610
611static struct dev_pm_ops ehci_fsl_pm_ops = {
612 .suspend = ehci_fsl_drv_suspend,
613 .resume = ehci_fsl_drv_resume,
614 .restore = ehci_fsl_drv_restore,
615};
616
617#define EHCI_FSL_PM_OPS (&ehci_fsl_pm_ops)
618#else
619#define EHCI_FSL_PM_OPS NULL
620#endif
621
622#ifdef CONFIG_USB_OTG
623static int ehci_start_port_reset(struct usb_hcd *hcd, unsigned port)
624{
625 struct ehci_hcd *ehci = hcd_to_ehci(hcd);
626 u32 status;
627
628 if (!port)
629 return -EINVAL;
630
631 port--;
632
633
634 status = readl(&ehci->regs->port_status[port]);
635 if (!(status & PORT_CONNECT))
636 return -ENODEV;
637
638
639 if (ehci_is_TDI(ehci)) {
640 writel(PORT_RESET |
641 (status & ~(PORT_CSC | PORT_PEC | PORT_OCC)),
642 &ehci->regs->port_status[port]);
643 } else {
644 writel(PORT_RESET, &ehci->regs->port_status[port]);
645 }
646
647 return 0;
648}
649#else
650#define ehci_start_port_reset NULL
651#endif
652
653
654static const struct hc_driver ehci_fsl_hc_driver = {
655 .description = hcd_name,
656 .product_desc = "Freescale On-Chip EHCI Host Controller",
657 .hcd_priv_size = sizeof(struct ehci_fsl),
658
659
660
661
662 .irq = ehci_irq,
663 .flags = HCD_USB2 | HCD_MEMORY,
664
665
666
667
668 .reset = ehci_fsl_setup,
669 .start = ehci_run,
670 .stop = ehci_stop,
671 .shutdown = ehci_shutdown,
672
673
674
675
676 .urb_enqueue = ehci_urb_enqueue,
677 .urb_dequeue = ehci_urb_dequeue,
678 .endpoint_disable = ehci_endpoint_disable,
679 .endpoint_reset = ehci_endpoint_reset,
680
681
682
683
684 .get_frame_number = ehci_get_frame,
685
686
687
688
689 .hub_status_data = ehci_hub_status_data,
690 .hub_control = ehci_hub_control,
691 .bus_suspend = ehci_bus_suspend,
692 .bus_resume = ehci_bus_resume,
693 .start_port_reset = ehci_start_port_reset,
694 .relinquish_port = ehci_relinquish_port,
695 .port_handed_over = ehci_port_handed_over,
696
697 .clear_tt_buffer_complete = ehci_clear_tt_buffer_complete,
698};
699
700static int ehci_fsl_drv_probe(struct platform_device *pdev)
701{
702 if (usb_disabled())
703 return -ENODEV;
704
705
706 return usb_hcd_fsl_probe(&ehci_fsl_hc_driver, pdev);
707}
708
709static int ehci_fsl_drv_remove(struct platform_device *pdev)
710{
711 struct usb_hcd *hcd = platform_get_drvdata(pdev);
712
713
714 usb_hcd_fsl_remove(hcd, pdev);
715 return 0;
716}
717
718MODULE_ALIAS("platform:fsl-ehci");
719
720static struct platform_driver ehci_fsl_driver = {
721 .probe = ehci_fsl_drv_probe,
722 .remove = ehci_fsl_drv_remove,
723 .shutdown = usb_hcd_platform_shutdown,
724 .driver = {
725 .name = "fsl-ehci",
726 .pm = EHCI_FSL_PM_OPS,
727 },
728};
729