1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18#include <linux/clk.h>
19#include <linux/dma-mapping.h>
20#include <linux/hrtimer.h>
21#include <linux/io.h>
22#include <linux/kernel.h>
23#include <linux/module.h>
24#include <linux/err.h>
25#include <linux/phy/phy.h>
26#include <linux/platform_device.h>
27#include <linux/reset.h>
28#include <linux/usb/ohci_pdriver.h>
29#include <linux/usb.h>
30#include <linux/usb/hcd.h>
31
32#include "ohci.h"
33
34#define DRIVER_DESC "OHCI generic platform driver"
35#define OHCI_MAX_CLKS 3
36#define hcd_to_ohci_priv(h) ((struct ohci_platform_priv *)hcd_to_ohci(h)->priv)
37
38struct ohci_platform_priv {
39 struct clk *clks[OHCI_MAX_CLKS];
40 struct reset_control *rst;
41 struct phy **phys;
42 int num_phys;
43};
44
45static const char hcd_name[] = "ohci-platform";
46
47static int ohci_platform_power_on(struct platform_device *dev)
48{
49 struct usb_hcd *hcd = platform_get_drvdata(dev);
50 struct ohci_platform_priv *priv = hcd_to_ohci_priv(hcd);
51 int clk, ret, phy_num;
52
53 for (clk = 0; clk < OHCI_MAX_CLKS && priv->clks[clk]; clk++) {
54 ret = clk_prepare_enable(priv->clks[clk]);
55 if (ret)
56 goto err_disable_clks;
57 }
58
59 for (phy_num = 0; phy_num < priv->num_phys; phy_num++) {
60 ret = phy_init(priv->phys[phy_num]);
61 if (ret)
62 goto err_exit_phy;
63 ret = phy_power_on(priv->phys[phy_num]);
64 if (ret) {
65 phy_exit(priv->phys[phy_num]);
66 goto err_exit_phy;
67 }
68 }
69
70 return 0;
71
72err_exit_phy:
73 while (--phy_num >= 0) {
74 phy_power_off(priv->phys[phy_num]);
75 phy_exit(priv->phys[phy_num]);
76 }
77err_disable_clks:
78 while (--clk >= 0)
79 clk_disable_unprepare(priv->clks[clk]);
80
81 return ret;
82}
83
84static void ohci_platform_power_off(struct platform_device *dev)
85{
86 struct usb_hcd *hcd = platform_get_drvdata(dev);
87 struct ohci_platform_priv *priv = hcd_to_ohci_priv(hcd);
88 int clk, phy_num;
89
90 for (phy_num = 0; phy_num < priv->num_phys; phy_num++) {
91 phy_power_off(priv->phys[phy_num]);
92 phy_exit(priv->phys[phy_num]);
93 }
94
95 for (clk = OHCI_MAX_CLKS - 1; clk >= 0; clk--)
96 if (priv->clks[clk])
97 clk_disable_unprepare(priv->clks[clk]);
98}
99
100static struct hc_driver __read_mostly ohci_platform_hc_driver;
101
102static const struct ohci_driver_overrides platform_overrides __initconst = {
103 .product_desc = "Generic Platform OHCI controller",
104 .extra_priv_size = sizeof(struct ohci_platform_priv),
105};
106
107static struct usb_ohci_pdata ohci_platform_defaults = {
108 .power_on = ohci_platform_power_on,
109 .power_suspend = ohci_platform_power_off,
110 .power_off = ohci_platform_power_off,
111};
112
113static int ohci_platform_probe(struct platform_device *dev)
114{
115 struct usb_hcd *hcd;
116 struct resource *res_mem;
117 struct usb_ohci_pdata *pdata = dev_get_platdata(&dev->dev);
118 struct ohci_platform_priv *priv;
119 struct ohci_hcd *ohci;
120 int err, irq, phy_num, clk = 0;
121
122 if (usb_disabled())
123 return -ENODEV;
124
125
126
127
128
129 if (!pdata)
130 pdata = &ohci_platform_defaults;
131
132 err = dma_coerce_mask_and_coherent(&dev->dev, DMA_BIT_MASK(32));
133 if (err)
134 return err;
135
136 irq = platform_get_irq(dev, 0);
137 if (irq < 0) {
138 dev_err(&dev->dev, "no irq provided");
139 return irq;
140 }
141
142 hcd = usb_create_hcd(&ohci_platform_hc_driver, &dev->dev,
143 dev_name(&dev->dev));
144 if (!hcd)
145 return -ENOMEM;
146
147 platform_set_drvdata(dev, hcd);
148 dev->dev.platform_data = pdata;
149 priv = hcd_to_ohci_priv(hcd);
150 ohci = hcd_to_ohci(hcd);
151
152 if (pdata == &ohci_platform_defaults && dev->dev.of_node) {
153 if (of_property_read_bool(dev->dev.of_node, "big-endian-regs"))
154 ohci->flags |= OHCI_QUIRK_BE_MMIO;
155
156 if (of_property_read_bool(dev->dev.of_node, "big-endian-desc"))
157 ohci->flags |= OHCI_QUIRK_BE_DESC;
158
159 if (of_property_read_bool(dev->dev.of_node, "big-endian"))
160 ohci->flags |= OHCI_QUIRK_BE_MMIO | OHCI_QUIRK_BE_DESC;
161
162 if (of_property_read_bool(dev->dev.of_node, "no-big-frame-no"))
163 ohci->flags |= OHCI_QUIRK_FRAME_NO;
164
165 of_property_read_u32(dev->dev.of_node, "num-ports",
166 &ohci->num_ports);
167
168 priv->num_phys = of_count_phandle_with_args(dev->dev.of_node,
169 "phys", "#phy-cells");
170
171 if (priv->num_phys > 0) {
172 priv->phys = devm_kcalloc(&dev->dev, priv->num_phys,
173 sizeof(struct phy *), GFP_KERNEL);
174 if (!priv->phys)
175 return -ENOMEM;
176 } else
177 priv->num_phys = 0;
178
179 for (phy_num = 0; phy_num < priv->num_phys; phy_num++) {
180 priv->phys[phy_num] = devm_of_phy_get_by_index(
181 &dev->dev, dev->dev.of_node, phy_num);
182 if (IS_ERR(priv->phys[phy_num])) {
183 err = PTR_ERR(priv->phys[phy_num]);
184 goto err_put_hcd;
185 }
186 }
187
188 for (clk = 0; clk < OHCI_MAX_CLKS; clk++) {
189 priv->clks[clk] = of_clk_get(dev->dev.of_node, clk);
190 if (IS_ERR(priv->clks[clk])) {
191 err = PTR_ERR(priv->clks[clk]);
192 if (err == -EPROBE_DEFER)
193 goto err_put_clks;
194 priv->clks[clk] = NULL;
195 break;
196 }
197 }
198
199 }
200
201 priv->rst = devm_reset_control_get_optional(&dev->dev, NULL);
202 if (IS_ERR(priv->rst)) {
203 err = PTR_ERR(priv->rst);
204 if (err == -EPROBE_DEFER)
205 goto err_put_clks;
206 priv->rst = NULL;
207 } else {
208 err = reset_control_deassert(priv->rst);
209 if (err)
210 goto err_put_clks;
211 }
212
213 if (pdata->big_endian_desc)
214 ohci->flags |= OHCI_QUIRK_BE_DESC;
215 if (pdata->big_endian_mmio)
216 ohci->flags |= OHCI_QUIRK_BE_MMIO;
217 if (pdata->no_big_frame_no)
218 ohci->flags |= OHCI_QUIRK_FRAME_NO;
219 if (pdata->num_ports)
220 ohci->num_ports = pdata->num_ports;
221
222#ifndef CONFIG_USB_OHCI_BIG_ENDIAN_MMIO
223 if (ohci->flags & OHCI_QUIRK_BE_MMIO) {
224 dev_err(&dev->dev,
225 "Error: CONFIG_USB_OHCI_BIG_ENDIAN_MMIO not set\n");
226 err = -EINVAL;
227 goto err_reset;
228 }
229#endif
230#ifndef CONFIG_USB_OHCI_BIG_ENDIAN_DESC
231 if (ohci->flags & OHCI_QUIRK_BE_DESC) {
232 dev_err(&dev->dev,
233 "Error: CONFIG_USB_OHCI_BIG_ENDIAN_DESC not set\n");
234 err = -EINVAL;
235 goto err_reset;
236 }
237#endif
238
239 if (pdata->power_on) {
240 err = pdata->power_on(dev);
241 if (err < 0)
242 goto err_reset;
243 }
244
245 res_mem = platform_get_resource(dev, IORESOURCE_MEM, 0);
246 hcd->regs = devm_ioremap_resource(&dev->dev, res_mem);
247 if (IS_ERR(hcd->regs)) {
248 err = PTR_ERR(hcd->regs);
249 goto err_power;
250 }
251 hcd->rsrc_start = res_mem->start;
252 hcd->rsrc_len = resource_size(res_mem);
253
254 err = usb_add_hcd(hcd, irq, IRQF_SHARED);
255 if (err)
256 goto err_power;
257
258 device_wakeup_enable(hcd->self.controller);
259
260 platform_set_drvdata(dev, hcd);
261
262 return err;
263
264err_power:
265 if (pdata->power_off)
266 pdata->power_off(dev);
267err_reset:
268 if (priv->rst)
269 reset_control_assert(priv->rst);
270err_put_clks:
271 while (--clk >= 0)
272 clk_put(priv->clks[clk]);
273err_put_hcd:
274 if (pdata == &ohci_platform_defaults)
275 dev->dev.platform_data = NULL;
276
277 usb_put_hcd(hcd);
278
279 return err;
280}
281
282static int ohci_platform_remove(struct platform_device *dev)
283{
284 struct usb_hcd *hcd = platform_get_drvdata(dev);
285 struct usb_ohci_pdata *pdata = dev_get_platdata(&dev->dev);
286 struct ohci_platform_priv *priv = hcd_to_ohci_priv(hcd);
287 int clk;
288
289 usb_remove_hcd(hcd);
290
291 if (pdata->power_off)
292 pdata->power_off(dev);
293
294 if (priv->rst)
295 reset_control_assert(priv->rst);
296
297 for (clk = 0; clk < OHCI_MAX_CLKS && priv->clks[clk]; clk++)
298 clk_put(priv->clks[clk]);
299
300 usb_put_hcd(hcd);
301
302 if (pdata == &ohci_platform_defaults)
303 dev->dev.platform_data = NULL;
304
305 return 0;
306}
307
308#ifdef CONFIG_PM_SLEEP
309static int ohci_platform_suspend(struct device *dev)
310{
311 struct usb_hcd *hcd = dev_get_drvdata(dev);
312 struct usb_ohci_pdata *pdata = dev->platform_data;
313 struct platform_device *pdev =
314 container_of(dev, struct platform_device, dev);
315 bool do_wakeup = device_may_wakeup(dev);
316 int ret;
317
318 ret = ohci_suspend(hcd, do_wakeup);
319 if (ret)
320 return ret;
321
322 if (pdata->power_suspend)
323 pdata->power_suspend(pdev);
324
325 return ret;
326}
327
328static int ohci_platform_resume(struct device *dev)
329{
330 struct usb_hcd *hcd = dev_get_drvdata(dev);
331 struct usb_ohci_pdata *pdata = dev_get_platdata(dev);
332 struct platform_device *pdev =
333 container_of(dev, struct platform_device, dev);
334
335 if (pdata->power_on) {
336 int err = pdata->power_on(pdev);
337 if (err < 0)
338 return err;
339 }
340
341 ohci_resume(hcd, false);
342 return 0;
343}
344#endif
345
346static const struct of_device_id ohci_platform_ids[] = {
347 { .compatible = "generic-ohci", },
348 { .compatible = "cavium,octeon-6335-ohci", },
349 { }
350};
351MODULE_DEVICE_TABLE(of, ohci_platform_ids);
352
353static const struct platform_device_id ohci_platform_table[] = {
354 { "ohci-platform", 0 },
355 { }
356};
357MODULE_DEVICE_TABLE(platform, ohci_platform_table);
358
359static SIMPLE_DEV_PM_OPS(ohci_platform_pm_ops, ohci_platform_suspend,
360 ohci_platform_resume);
361
362static struct platform_driver ohci_platform_driver = {
363 .id_table = ohci_platform_table,
364 .probe = ohci_platform_probe,
365 .remove = ohci_platform_remove,
366 .shutdown = usb_hcd_platform_shutdown,
367 .driver = {
368 .name = "ohci-platform",
369 .pm = &ohci_platform_pm_ops,
370 .of_match_table = ohci_platform_ids,
371 }
372};
373
374static int __init ohci_platform_init(void)
375{
376 if (usb_disabled())
377 return -ENODEV;
378
379 pr_info("%s: " DRIVER_DESC "\n", hcd_name);
380
381 ohci_init_driver(&ohci_platform_hc_driver, &platform_overrides);
382 return platform_driver_register(&ohci_platform_driver);
383}
384module_init(ohci_platform_init);
385
386static void __exit ohci_platform_cleanup(void)
387{
388 platform_driver_unregister(&ohci_platform_driver);
389}
390module_exit(ohci_platform_cleanup);
391
392MODULE_DESCRIPTION(DRIVER_DESC);
393MODULE_AUTHOR("Hauke Mehrtens");
394MODULE_AUTHOR("Alan Stern");
395MODULE_LICENSE("GPL");
396
