1
2
3
4
5
6
7
8
9
10
11#include <linux/kernel.h>
12#include <linux/module.h>
13#include <linux/platform_device.h>
14#include <linux/mbus.h>
15#include <plat/ehci-orion.h>
16
17#define rdl(off) __raw_readl(hcd->regs + (off))
18#define wrl(off, val) __raw_writel((val), hcd->regs + (off))
19
20#define USB_CMD 0x140
21#define USB_MODE 0x1a8
22#define USB_CAUSE 0x310
23#define USB_MASK 0x314
24#define USB_WINDOW_CTRL(i) (0x320 + ((i) << 4))
25#define USB_WINDOW_BASE(i) (0x324 + ((i) << 4))
26#define USB_IPG 0x360
27#define USB_PHY_PWR_CTRL 0x400
28#define USB_PHY_TX_CTRL 0x420
29#define USB_PHY_RX_CTRL 0x430
30#define USB_PHY_IVREF_CTRL 0x440
31#define USB_PHY_TST_GRP_CTRL 0x450
32
33
34
35
36static void orion_usb_setup(struct usb_hcd *hcd)
37{
38
39
40
41 wrl(USB_CAUSE, 0);
42 wrl(USB_MASK, 0);
43
44
45
46
47 wrl(USB_CMD, rdl(USB_CMD) | 0x2);
48 while (rdl(USB_CMD) & 0x2);
49
50
51
52
53
54 wrl(USB_IPG, (rdl(USB_IPG) & ~0x7f00) | 0xc00);
55
56
57
58
59
60 wrl(USB_PHY_PWR_CTRL, (rdl(USB_PHY_PWR_CTRL) & ~0xc0)| 0x40);
61
62
63
64
65
66 wrl(USB_PHY_TX_CTRL, (rdl(USB_PHY_TX_CTRL) & ~0x78) | 0x202040);
67
68
69
70
71
72
73 wrl(USB_PHY_RX_CTRL, (rdl(USB_PHY_RX_CTRL) & ~0xc2003f0) | 0xc0000010);
74
75
76
77
78
79 wrl(USB_PHY_IVREF_CTRL, (rdl(USB_PHY_IVREF_CTRL) & ~0x80003 ) | 0x32);
80
81
82
83
84
85 wrl(USB_PHY_TST_GRP_CTRL, rdl(USB_PHY_TST_GRP_CTRL) & ~0x8000);
86
87
88
89
90 wrl(USB_CMD, rdl(USB_CMD) & ~0x1);
91 wrl(USB_CMD, rdl(USB_CMD) | 0x2);
92 while (rdl(USB_CMD) & 0x2);
93
94
95
96
97
98
99 wrl(USB_MODE, 0x13);
100}
101
102static int ehci_orion_setup(struct usb_hcd *hcd)
103{
104 struct ehci_hcd *ehci = hcd_to_ehci(hcd);
105 int retval;
106
107 retval = ehci_halt(ehci);
108 if (retval)
109 return retval;
110
111
112
113
114 retval = ehci_init(hcd);
115 if (retval)
116 return retval;
117
118 hcd->has_tt = 1;
119
120 ehci_reset(ehci);
121 ehci_port_power(ehci, 0);
122
123 return retval;
124}
125
126static const struct hc_driver ehci_orion_hc_driver = {
127 .description = hcd_name,
128 .product_desc = "Marvell Orion EHCI",
129 .hcd_priv_size = sizeof(struct ehci_hcd),
130
131
132
133
134 .irq = ehci_irq,
135 .flags = HCD_MEMORY | HCD_USB2,
136
137
138
139
140 .reset = ehci_orion_setup,
141 .start = ehci_run,
142 .stop = ehci_stop,
143 .shutdown = ehci_shutdown,
144
145
146
147
148 .urb_enqueue = ehci_urb_enqueue,
149 .urb_dequeue = ehci_urb_dequeue,
150 .endpoint_disable = ehci_endpoint_disable,
151
152
153
154
155 .get_frame_number = ehci_get_frame,
156
157
158
159
160 .hub_status_data = ehci_hub_status_data,
161 .hub_control = ehci_hub_control,
162 .bus_suspend = ehci_bus_suspend,
163 .bus_resume = ehci_bus_resume,
164 .relinquish_port = ehci_relinquish_port,
165 .port_handed_over = ehci_port_handed_over,
166};
167
168static void __init
169ehci_orion_conf_mbus_windows(struct usb_hcd *hcd,
170 struct mbus_dram_target_info *dram)
171{
172 int i;
173
174 for (i = 0; i < 4; i++) {
175 wrl(USB_WINDOW_CTRL(i), 0);
176 wrl(USB_WINDOW_BASE(i), 0);
177 }
178
179 for (i = 0; i < dram->num_cs; i++) {
180 struct mbus_dram_window *cs = dram->cs + i;
181
182 wrl(USB_WINDOW_CTRL(i), ((cs->size - 1) & 0xffff0000) |
183 (cs->mbus_attr << 8) |
184 (dram->mbus_dram_target_id << 4) | 1);
185 wrl(USB_WINDOW_BASE(i), cs->base);
186 }
187}
188
189static int __init ehci_orion_drv_probe(struct platform_device *pdev)
190{
191 struct orion_ehci_data *pd = pdev->dev.platform_data;
192 struct resource *res;
193 struct usb_hcd *hcd;
194 struct ehci_hcd *ehci;
195 void __iomem *regs;
196 int irq, err;
197
198 if (usb_disabled())
199 return -ENODEV;
200
201 pr_debug("Initializing Orion-SoC USB Host Controller\n");
202
203 irq = platform_get_irq(pdev, 0);
204 if (irq <= 0) {
205 dev_err(&pdev->dev,
206 "Found HC with no IRQ. Check %s setup!\n",
207 dev_name(&pdev->dev));
208 err = -ENODEV;
209 goto err1;
210 }
211
212 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
213 if (!res) {
214 dev_err(&pdev->dev,
215 "Found HC with no register addr. Check %s setup!\n",
216 dev_name(&pdev->dev));
217 err = -ENODEV;
218 goto err1;
219 }
220
221 if (!request_mem_region(res->start, res->end - res->start + 1,
222 ehci_orion_hc_driver.description)) {
223 dev_dbg(&pdev->dev, "controller already in use\n");
224 err = -EBUSY;
225 goto err1;
226 }
227
228 regs = ioremap(res->start, res->end - res->start + 1);
229 if (regs == NULL) {
230 dev_dbg(&pdev->dev, "error mapping memory\n");
231 err = -EFAULT;
232 goto err2;
233 }
234
235 hcd = usb_create_hcd(&ehci_orion_hc_driver,
236 &pdev->dev, dev_name(&pdev->dev));
237 if (!hcd) {
238 err = -ENOMEM;
239 goto err3;
240 }
241
242 hcd->rsrc_start = res->start;
243 hcd->rsrc_len = res->end - res->start + 1;
244 hcd->regs = regs;
245
246 ehci = hcd_to_ehci(hcd);
247 ehci->caps = hcd->regs + 0x100;
248 ehci->regs = hcd->regs + 0x100 +
249 HC_LENGTH(ehci_readl(ehci, &ehci->caps->hc_capbase));
250 ehci->hcs_params = ehci_readl(ehci, &ehci->caps->hcs_params);
251 hcd->has_tt = 1;
252 ehci->sbrn = 0x20;
253
254
255
256
257 if (pd != NULL && pd->dram != NULL)
258 ehci_orion_conf_mbus_windows(hcd, pd->dram);
259
260
261
262
263 orion_usb_setup(hcd);
264
265 err = usb_add_hcd(hcd, irq, IRQF_SHARED | IRQF_DISABLED);
266 if (err)
267 goto err4;
268
269 return 0;
270
271err4:
272 usb_put_hcd(hcd);
273err3:
274 iounmap(regs);
275err2:
276 release_mem_region(res->start, res->end - res->start + 1);
277err1:
278 dev_err(&pdev->dev, "init %s fail, %d\n",
279 dev_name(&pdev->dev), err);
280
281 return err;
282}
283
284static int __exit ehci_orion_drv_remove(struct platform_device *pdev)
285{
286 struct usb_hcd *hcd = platform_get_drvdata(pdev);
287
288 usb_remove_hcd(hcd);
289 iounmap(hcd->regs);
290 release_mem_region(hcd->rsrc_start, hcd->rsrc_len);
291 usb_put_hcd(hcd);
292
293 return 0;
294}
295
296MODULE_ALIAS("platform:orion-ehci");
297
298static struct platform_driver ehci_orion_driver = {
299 .probe = ehci_orion_drv_probe,
300 .remove = __exit_p(ehci_orion_drv_remove),
301 .shutdown = usb_hcd_platform_shutdown,
302 .driver.name = "orion-ehci",
303};
304