1
2
3
4
5
6
7
8
9
10
11
12
13
14#include <linux/clk.h>
15#include <linux/dma-mapping.h>
16#include <linux/io.h>
17#include <linux/kernel.h>
18#include <linux/module.h>
19#include <linux/of.h>
20#include <linux/of_platform.h>
21#include <linux/platform_device.h>
22#include <linux/usb.h>
23#include <linux/usb/hcd.h>
24
25#include "ehci.h"
26
27#define DRIVER_DESC "EHCI Atmel driver"
28
29static const char hcd_name[] = "ehci-atmel";
30static struct hc_driver __read_mostly ehci_atmel_hc_driver;
31
32
33static struct clk *iclk, *fclk, *uclk;
34static int clocked;
35
36
37
38static void atmel_start_clock(void)
39{
40 if (IS_ENABLED(CONFIG_COMMON_CLK)) {
41 clk_set_rate(uclk, 48000000);
42 clk_prepare_enable(uclk);
43 }
44 clk_prepare_enable(iclk);
45 clk_prepare_enable(fclk);
46 clocked = 1;
47}
48
49static void atmel_stop_clock(void)
50{
51 clk_disable_unprepare(fclk);
52 clk_disable_unprepare(iclk);
53 if (IS_ENABLED(CONFIG_COMMON_CLK))
54 clk_disable_unprepare(uclk);
55 clocked = 0;
56}
57
58static void atmel_start_ehci(struct platform_device *pdev)
59{
60 dev_dbg(&pdev->dev, "start\n");
61 atmel_start_clock();
62}
63
64static void atmel_stop_ehci(struct platform_device *pdev)
65{
66 dev_dbg(&pdev->dev, "stop\n");
67 atmel_stop_clock();
68}
69
70
71
72static int ehci_atmel_drv_probe(struct platform_device *pdev)
73{
74 struct usb_hcd *hcd;
75 const struct hc_driver *driver = &ehci_atmel_hc_driver;
76 struct resource *res;
77 struct ehci_hcd *ehci;
78 int irq;
79 int retval;
80
81 if (usb_disabled())
82 return -ENODEV;
83
84 pr_debug("Initializing Atmel-SoC USB Host Controller\n");
85
86 irq = platform_get_irq(pdev, 0);
87 if (irq <= 0) {
88 dev_err(&pdev->dev,
89 "Found HC with no IRQ. Check %s setup!\n",
90 dev_name(&pdev->dev));
91 retval = -ENODEV;
92 goto fail_create_hcd;
93 }
94
95
96
97
98
99 if (!pdev->dev.dma_mask)
100 pdev->dev.dma_mask = &pdev->dev.coherent_dma_mask;
101 if (!pdev->dev.coherent_dma_mask)
102 pdev->dev.coherent_dma_mask = DMA_BIT_MASK(32);
103
104 hcd = usb_create_hcd(driver, &pdev->dev, dev_name(&pdev->dev));
105 if (!hcd) {
106 retval = -ENOMEM;
107 goto fail_create_hcd;
108 }
109
110 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
111 if (!res) {
112 dev_err(&pdev->dev,
113 "Found HC with no register addr. Check %s setup!\n",
114 dev_name(&pdev->dev));
115 retval = -ENODEV;
116 goto fail_request_resource;
117 }
118 hcd->rsrc_start = res->start;
119 hcd->rsrc_len = resource_size(res);
120
121 hcd->regs = devm_ioremap_resource(&pdev->dev, res);
122 if (IS_ERR(hcd->regs)) {
123 retval = PTR_ERR(hcd->regs);
124 goto fail_request_resource;
125 }
126
127 iclk = devm_clk_get(&pdev->dev, "ehci_clk");
128 if (IS_ERR(iclk)) {
129 dev_err(&pdev->dev, "Error getting interface clock\n");
130 retval = -ENOENT;
131 goto fail_request_resource;
132 }
133 fclk = devm_clk_get(&pdev->dev, "uhpck");
134 if (IS_ERR(fclk)) {
135 dev_err(&pdev->dev, "Error getting function clock\n");
136 retval = -ENOENT;
137 goto fail_request_resource;
138 }
139 if (IS_ENABLED(CONFIG_COMMON_CLK)) {
140 uclk = devm_clk_get(&pdev->dev, "usb_clk");
141 if (IS_ERR(uclk)) {
142 dev_err(&pdev->dev, "failed to get uclk\n");
143 retval = PTR_ERR(uclk);
144 goto fail_request_resource;
145 }
146 }
147
148 ehci = hcd_to_ehci(hcd);
149
150 ehci->caps = hcd->regs;
151
152 atmel_start_ehci(pdev);
153
154 retval = usb_add_hcd(hcd, irq, IRQF_SHARED);
155 if (retval)
156 goto fail_add_hcd;
157
158 return retval;
159
160fail_add_hcd:
161 atmel_stop_ehci(pdev);
162fail_request_resource:
163 usb_put_hcd(hcd);
164fail_create_hcd:
165 dev_err(&pdev->dev, "init %s fail, %d\n",
166 dev_name(&pdev->dev), retval);
167
168 return retval;
169}
170
171static int ehci_atmel_drv_remove(struct platform_device *pdev)
172{
173 struct usb_hcd *hcd = platform_get_drvdata(pdev);
174
175 usb_remove_hcd(hcd);
176 usb_put_hcd(hcd);
177
178 atmel_stop_ehci(pdev);
179 fclk = iclk = NULL;
180
181 return 0;
182}
183
184#ifdef CONFIG_OF
185static const struct of_device_id atmel_ehci_dt_ids[] = {
186 { .compatible = "atmel,at91sam9g45-ehci" },
187 { }
188};
189
190MODULE_DEVICE_TABLE(of, atmel_ehci_dt_ids);
191#endif
192
193static struct platform_driver ehci_atmel_driver = {
194 .probe = ehci_atmel_drv_probe,
195 .remove = ehci_atmel_drv_remove,
196 .shutdown = usb_hcd_platform_shutdown,
197 .driver = {
198 .name = "atmel-ehci",
199 .of_match_table = of_match_ptr(atmel_ehci_dt_ids),
200 },
201};
202
203static int __init ehci_atmel_init(void)
204{
205 if (usb_disabled())
206 return -ENODEV;
207
208 pr_info("%s: " DRIVER_DESC "\n", hcd_name);
209 ehci_init_driver(&ehci_atmel_hc_driver, NULL);
210 return platform_driver_register(&ehci_atmel_driver);
211}
212module_init(ehci_atmel_init);
213
214static void __exit ehci_atmel_cleanup(void)
215{
216 platform_driver_unregister(&ehci_atmel_driver);
217}
218module_exit(ehci_atmel_cleanup);
219
220MODULE_DESCRIPTION(DRIVER_DESC);
221MODULE_ALIAS("platform:atmel-ehci");
222MODULE_AUTHOR("Nicolas Ferre");
223MODULE_LICENSE("GPL");
224