1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22#include <linux/module.h>
23#include <linux/kernel.h>
24#include <linux/clk.h>
25#include <linux/err.h>
26#include <linux/io.h>
27#include <linux/of.h>
28#include <linux/platform_device.h>
29#include <linux/usb/musb-ux500.h>
30
31#include "musb_core.h"
32
33static struct musb_hdrc_config ux500_musb_hdrc_config = {
34 .multipoint = true,
35 .dyn_fifo = true,
36 .num_eps = 16,
37 .ram_bits = 16,
38};
39
40struct ux500_glue {
41 struct device *dev;
42 struct platform_device *musb;
43 struct clk *clk;
44};
45#define glue_to_musb(g) platform_get_drvdata(g->musb)
46
47static void ux500_musb_set_vbus(struct musb *musb, int is_on)
48{
49 u8 devctl;
50 unsigned long timeout = jiffies + msecs_to_jiffies(1000);
51
52
53
54
55
56 devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
57
58 if (is_on) {
59 if (musb->xceiv->state == OTG_STATE_A_IDLE) {
60
61 devctl |= MUSB_DEVCTL_SESSION;
62 musb_writeb(musb->mregs, MUSB_DEVCTL, devctl);
63
64
65
66
67 while (musb_readb(musb->mregs, MUSB_DEVCTL) & 0x80) {
68
69 if (time_after(jiffies, timeout)) {
70 dev_err(musb->controller,
71 "configured as A device timeout");
72 break;
73 }
74 }
75
76 } else {
77 musb->is_active = 1;
78 musb->xceiv->otg->default_a = 1;
79 musb->xceiv->state = OTG_STATE_A_WAIT_VRISE;
80 devctl |= MUSB_DEVCTL_SESSION;
81 MUSB_HST_MODE(musb);
82 }
83 } else {
84 musb->is_active = 0;
85
86
87
88
89 musb->xceiv->otg->default_a = 0;
90 devctl &= ~MUSB_DEVCTL_SESSION;
91 MUSB_DEV_MODE(musb);
92 }
93 musb_writeb(musb->mregs, MUSB_DEVCTL, devctl);
94
95
96
97
98
99
100
101 if (!is_on)
102 mdelay(200);
103
104 dev_dbg(musb->controller, "VBUS %s, devctl %02x\n",
105 usb_otg_state_string(musb->xceiv->state),
106 musb_readb(musb->mregs, MUSB_DEVCTL));
107}
108
109static int musb_otg_notifications(struct notifier_block *nb,
110 unsigned long event, void *unused)
111{
112 struct musb *musb = container_of(nb, struct musb, nb);
113
114 dev_dbg(musb->controller, "musb_otg_notifications %ld %s\n",
115 event, usb_otg_state_string(musb->xceiv->state));
116
117 switch (event) {
118 case UX500_MUSB_ID:
119 dev_dbg(musb->controller, "ID GND\n");
120 ux500_musb_set_vbus(musb, 1);
121 break;
122 case UX500_MUSB_VBUS:
123 dev_dbg(musb->controller, "VBUS Connect\n");
124 break;
125 case UX500_MUSB_NONE:
126 dev_dbg(musb->controller, "VBUS Disconnect\n");
127 if (is_host_active(musb))
128 ux500_musb_set_vbus(musb, 0);
129 else
130 musb->xceiv->state = OTG_STATE_B_IDLE;
131 break;
132 default:
133 dev_dbg(musb->controller, "ID float\n");
134 return NOTIFY_DONE;
135 }
136 return NOTIFY_OK;
137}
138
139static irqreturn_t ux500_musb_interrupt(int irq, void *__hci)
140{
141 unsigned long flags;
142 irqreturn_t retval = IRQ_NONE;
143 struct musb *musb = __hci;
144
145 spin_lock_irqsave(&musb->lock, flags);
146
147 musb->int_usb = musb_readb(musb->mregs, MUSB_INTRUSB);
148 musb->int_tx = musb_readw(musb->mregs, MUSB_INTRTX);
149 musb->int_rx = musb_readw(musb->mregs, MUSB_INTRRX);
150
151 if (musb->int_usb || musb->int_tx || musb->int_rx)
152 retval = musb_interrupt(musb);
153
154 spin_unlock_irqrestore(&musb->lock, flags);
155
156 return retval;
157}
158
159static int ux500_musb_init(struct musb *musb)
160{
161 int status;
162
163 musb->xceiv = usb_get_phy(USB_PHY_TYPE_USB2);
164 if (IS_ERR_OR_NULL(musb->xceiv)) {
165 pr_err("HS USB OTG: no transceiver configured\n");
166 return -EPROBE_DEFER;
167 }
168
169 musb->nb.notifier_call = musb_otg_notifications;
170 status = usb_register_notifier(musb->xceiv, &musb->nb);
171 if (status < 0) {
172 dev_dbg(musb->controller, "notification register failed\n");
173 return status;
174 }
175
176 musb->isr = ux500_musb_interrupt;
177
178 return 0;
179}
180
181static int ux500_musb_exit(struct musb *musb)
182{
183 usb_unregister_notifier(musb->xceiv, &musb->nb);
184
185 usb_put_phy(musb->xceiv);
186
187 return 0;
188}
189
190static const struct musb_platform_ops ux500_ops = {
191 .init = ux500_musb_init,
192 .exit = ux500_musb_exit,
193
194 .set_vbus = ux500_musb_set_vbus,
195};
196
197static struct musb_hdrc_platform_data *
198ux500_of_probe(struct platform_device *pdev, struct device_node *np)
199{
200 struct musb_hdrc_platform_data *pdata;
201 const char *mode;
202 int strlen;
203
204 pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
205 if (!pdata)
206 return NULL;
207
208 mode = of_get_property(np, "dr_mode", &strlen);
209 if (!mode) {
210 dev_err(&pdev->dev, "No 'dr_mode' property found\n");
211 return NULL;
212 }
213
214 if (strlen > 0) {
215 if (!strcmp(mode, "host"))
216 pdata->mode = MUSB_HOST;
217 if (!strcmp(mode, "otg"))
218 pdata->mode = MUSB_OTG;
219 if (!strcmp(mode, "peripheral"))
220 pdata->mode = MUSB_PERIPHERAL;
221 }
222
223 return pdata;
224}
225
226static int ux500_probe(struct platform_device *pdev)
227{
228 struct resource musb_resources[2];
229 struct musb_hdrc_platform_data *pdata = dev_get_platdata(&pdev->dev);
230 struct device_node *np = pdev->dev.of_node;
231 struct platform_device *musb;
232 struct ux500_glue *glue;
233 struct clk *clk;
234 int ret = -ENOMEM;
235
236 if (!pdata) {
237 if (np) {
238 pdata = ux500_of_probe(pdev, np);
239 if (!pdata)
240 goto err0;
241
242 pdev->dev.platform_data = pdata;
243 } else {
244 dev_err(&pdev->dev, "no pdata or device tree found\n");
245 goto err0;
246 }
247 }
248
249 glue = kzalloc(sizeof(*glue), GFP_KERNEL);
250 if (!glue) {
251 dev_err(&pdev->dev, "failed to allocate glue context\n");
252 goto err0;
253 }
254
255 musb = platform_device_alloc("musb-hdrc", PLATFORM_DEVID_AUTO);
256 if (!musb) {
257 dev_err(&pdev->dev, "failed to allocate musb device\n");
258 goto err1;
259 }
260
261 clk = clk_get(&pdev->dev, NULL);
262 if (IS_ERR(clk)) {
263 dev_err(&pdev->dev, "failed to get clock\n");
264 ret = PTR_ERR(clk);
265 goto err3;
266 }
267
268 ret = clk_prepare_enable(clk);
269 if (ret) {
270 dev_err(&pdev->dev, "failed to enable clock\n");
271 goto err4;
272 }
273
274 musb->dev.parent = &pdev->dev;
275 musb->dev.dma_mask = &pdev->dev.coherent_dma_mask;
276 musb->dev.coherent_dma_mask = pdev->dev.coherent_dma_mask;
277 musb->dev.of_node = pdev->dev.of_node;
278
279 glue->dev = &pdev->dev;
280 glue->musb = musb;
281 glue->clk = clk;
282
283 pdata->platform_ops = &ux500_ops;
284 pdata->config = &ux500_musb_hdrc_config;
285
286 platform_set_drvdata(pdev, glue);
287
288 memset(musb_resources, 0x00, sizeof(*musb_resources) *
289 ARRAY_SIZE(musb_resources));
290
291 musb_resources[0].name = pdev->resource[0].name;
292 musb_resources[0].start = pdev->resource[0].start;
293 musb_resources[0].end = pdev->resource[0].end;
294 musb_resources[0].flags = pdev->resource[0].flags;
295
296 musb_resources[1].name = pdev->resource[1].name;
297 musb_resources[1].start = pdev->resource[1].start;
298 musb_resources[1].end = pdev->resource[1].end;
299 musb_resources[1].flags = pdev->resource[1].flags;
300
301 ret = platform_device_add_resources(musb, musb_resources,
302 ARRAY_SIZE(musb_resources));
303 if (ret) {
304 dev_err(&pdev->dev, "failed to add resources\n");
305 goto err5;
306 }
307
308 ret = platform_device_add_data(musb, pdata, sizeof(*pdata));
309 if (ret) {
310 dev_err(&pdev->dev, "failed to add platform_data\n");
311 goto err5;
312 }
313
314 ret = platform_device_add(musb);
315 if (ret) {
316 dev_err(&pdev->dev, "failed to register musb device\n");
317 goto err5;
318 }
319
320 return 0;
321
322err5:
323 clk_disable_unprepare(clk);
324
325err4:
326 clk_put(clk);
327
328err3:
329 platform_device_put(musb);
330
331err1:
332 kfree(glue);
333
334err0:
335 return ret;
336}
337
338static int ux500_remove(struct platform_device *pdev)
339{
340 struct ux500_glue *glue = platform_get_drvdata(pdev);
341
342 platform_device_unregister(glue->musb);
343 clk_disable_unprepare(glue->clk);
344 clk_put(glue->clk);
345 kfree(glue);
346
347 return 0;
348}
349
350#ifdef CONFIG_PM
351static int ux500_suspend(struct device *dev)
352{
353 struct ux500_glue *glue = dev_get_drvdata(dev);
354 struct musb *musb = glue_to_musb(glue);
355
356 usb_phy_set_suspend(musb->xceiv, 1);
357 clk_disable_unprepare(glue->clk);
358
359 return 0;
360}
361
362static int ux500_resume(struct device *dev)
363{
364 struct ux500_glue *glue = dev_get_drvdata(dev);
365 struct musb *musb = glue_to_musb(glue);
366 int ret;
367
368 ret = clk_prepare_enable(glue->clk);
369 if (ret) {
370 dev_err(dev, "failed to enable clock\n");
371 return ret;
372 }
373
374 usb_phy_set_suspend(musb->xceiv, 0);
375
376 return 0;
377}
378#endif
379
380static SIMPLE_DEV_PM_OPS(ux500_pm_ops, ux500_suspend, ux500_resume);
381
382static const struct of_device_id ux500_match[] = {
383 { .compatible = "stericsson,db8500-musb", },
384 {}
385};
386
387static struct platform_driver ux500_driver = {
388 .probe = ux500_probe,
389 .remove = ux500_remove,
390 .driver = {
391 .name = "musb-ux500",
392 .pm = &ux500_pm_ops,
393 .of_match_table = ux500_match,
394 },
395};
396
397MODULE_DESCRIPTION("UX500 MUSB Glue Layer");
398MODULE_AUTHOR("Mian Yousaf Kaukab <mian.yousaf.kaukab@stericsson.com>");
399MODULE_LICENSE("GPL v2");
400module_platform_driver(ux500_driver);
401
