1
2
3
4
5
6
7
8
9
10
11
12
13
14#include <linux/clk.h>
15#include <linux/platform_device.h>
16#include <linux/of.h>
17#include <linux/of_platform.h>
18
19
20static struct clk *iclk, *fclk;
21static int clocked;
22
23
24
25static void atmel_start_clock(void)
26{
27 clk_enable(iclk);
28 clk_enable(fclk);
29 clocked = 1;
30}
31
32static void atmel_stop_clock(void)
33{
34 clk_disable(fclk);
35 clk_disable(iclk);
36 clocked = 0;
37}
38
39static void atmel_start_ehci(struct platform_device *pdev)
40{
41 dev_dbg(&pdev->dev, "start\n");
42 atmel_start_clock();
43}
44
45static void atmel_stop_ehci(struct platform_device *pdev)
46{
47 dev_dbg(&pdev->dev, "stop\n");
48 atmel_stop_clock();
49}
50
51
52
53static int ehci_atmel_setup(struct usb_hcd *hcd)
54{
55 struct ehci_hcd *ehci = hcd_to_ehci(hcd);
56 int retval;
57
58
59 ehci->caps = hcd->regs;
60
61 retval = ehci_setup(hcd);
62 if (retval)
63 return retval;
64
65 ehci_port_power(ehci, 0);
66
67 return retval;
68}
69
70static const struct hc_driver ehci_atmel_hc_driver = {
71 .description = hcd_name,
72 .product_desc = "Atmel EHCI UHP HS",
73 .hcd_priv_size = sizeof(struct ehci_hcd),
74
75
76 .irq = ehci_irq,
77 .flags = HCD_MEMORY | HCD_USB2,
78
79
80 .reset = ehci_atmel_setup,
81 .start = ehci_run,
82 .stop = ehci_stop,
83 .shutdown = ehci_shutdown,
84
85
86 .urb_enqueue = ehci_urb_enqueue,
87 .urb_dequeue = ehci_urb_dequeue,
88 .endpoint_disable = ehci_endpoint_disable,
89 .endpoint_reset = ehci_endpoint_reset,
90
91
92 .get_frame_number = ehci_get_frame,
93
94
95 .hub_status_data = ehci_hub_status_data,
96 .hub_control = ehci_hub_control,
97 .bus_suspend = ehci_bus_suspend,
98 .bus_resume = ehci_bus_resume,
99 .relinquish_port = ehci_relinquish_port,
100 .port_handed_over = ehci_port_handed_over,
101
102 .clear_tt_buffer_complete = ehci_clear_tt_buffer_complete,
103};
104
105static u64 at91_ehci_dma_mask = DMA_BIT_MASK(32);
106
107static int __devinit ehci_atmel_drv_probe(struct platform_device *pdev)
108{
109 struct usb_hcd *hcd;
110 const struct hc_driver *driver = &ehci_atmel_hc_driver;
111 struct resource *res;
112 int irq;
113 int retval;
114
115 if (usb_disabled())
116 return -ENODEV;
117
118 pr_debug("Initializing Atmel-SoC USB Host Controller\n");
119
120 irq = platform_get_irq(pdev, 0);
121 if (irq <= 0) {
122 dev_err(&pdev->dev,
123 "Found HC with no IRQ. Check %s setup!\n",
124 dev_name(&pdev->dev));
125 retval = -ENODEV;
126 goto fail_create_hcd;
127 }
128
129
130
131
132
133 if (!pdev->dev.dma_mask)
134 pdev->dev.dma_mask = &at91_ehci_dma_mask;
135
136 hcd = usb_create_hcd(driver, &pdev->dev, dev_name(&pdev->dev));
137 if (!hcd) {
138 retval = -ENOMEM;
139 goto fail_create_hcd;
140 }
141
142 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
143 if (!res) {
144 dev_err(&pdev->dev,
145 "Found HC with no register addr. Check %s setup!\n",
146 dev_name(&pdev->dev));
147 retval = -ENODEV;
148 goto fail_request_resource;
149 }
150 hcd->rsrc_start = res->start;
151 hcd->rsrc_len = resource_size(res);
152
153 hcd->regs = devm_request_and_ioremap(&pdev->dev, res);
154 if (hcd->regs == NULL) {
155 dev_dbg(&pdev->dev, "error mapping memory\n");
156 retval = -EFAULT;
157 goto fail_request_resource;
158 }
159
160 iclk = devm_clk_get(&pdev->dev, "ehci_clk");
161 if (IS_ERR(iclk)) {
162 dev_err(&pdev->dev, "Error getting interface clock\n");
163 retval = -ENOENT;
164 goto fail_request_resource;
165 }
166 fclk = devm_clk_get(&pdev->dev, "uhpck");
167 if (IS_ERR(fclk)) {
168 dev_err(&pdev->dev, "Error getting function clock\n");
169 retval = -ENOENT;
170 goto fail_request_resource;
171 }
172
173 atmel_start_ehci(pdev);
174
175 retval = usb_add_hcd(hcd, irq, IRQF_SHARED);
176 if (retval)
177 goto fail_add_hcd;
178
179 return retval;
180
181fail_add_hcd:
182 atmel_stop_ehci(pdev);
183fail_request_resource:
184 usb_put_hcd(hcd);
185fail_create_hcd:
186 dev_err(&pdev->dev, "init %s fail, %d\n",
187 dev_name(&pdev->dev), retval);
188
189 return retval;
190}
191
192static int __devexit ehci_atmel_drv_remove(struct platform_device *pdev)
193{
194 struct usb_hcd *hcd = platform_get_drvdata(pdev);
195
196 ehci_shutdown(hcd);
197 usb_remove_hcd(hcd);
198 usb_put_hcd(hcd);
199
200 atmel_stop_ehci(pdev);
201 fclk = iclk = NULL;
202
203 return 0;
204}
205
206#ifdef CONFIG_OF
207static const struct of_device_id atmel_ehci_dt_ids[] = {
208 { .compatible = "atmel,at91sam9g45-ehci" },
209 { }
210};
211
212MODULE_DEVICE_TABLE(of, atmel_ehci_dt_ids);
213#endif
214
215static struct platform_driver ehci_atmel_driver = {
216 .probe = ehci_atmel_drv_probe,
217 .remove = __devexit_p(ehci_atmel_drv_remove),
218 .shutdown = usb_hcd_platform_shutdown,
219 .driver = {
220 .name = "atmel-ehci",
221 .of_match_table = of_match_ptr(atmel_ehci_dt_ids),
222 },
223};
224