treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / usb / musb / ux500.c
blob73538d1d05247841d75d0308a3cb8c97fac3166b
1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * Copyright (C) 2010 ST-Ericsson AB
4 * Mian Yousaf Kaukab <mian.yousaf.kaukab@stericsson.com>
6 * Based on omap2430.c
7 */
9 #include <linux/module.h>
10 #include <linux/kernel.h>
11 #include <linux/clk.h>
12 #include <linux/err.h>
13 #include <linux/io.h>
14 #include <linux/of.h>
15 #include <linux/platform_device.h>
16 #include <linux/usb/musb-ux500.h>
18 #include "musb_core.h"
20 static const struct musb_hdrc_config ux500_musb_hdrc_config = {
21 .multipoint = true,
22 .dyn_fifo = true,
23 .num_eps = 16,
24 .ram_bits = 16,
27 struct ux500_glue {
28 struct device *dev;
29 struct platform_device *musb;
30 struct clk *clk;
32 #define glue_to_musb(g) platform_get_drvdata(g->musb)
34 static void ux500_musb_set_vbus(struct musb *musb, int is_on)
36 u8 devctl;
37 unsigned long timeout = jiffies + msecs_to_jiffies(1000);
38 /* HDRC controls CPEN, but beware current surges during device
39 * connect. They can trigger transient overcurrent conditions
40 * that must be ignored.
43 devctl = musb_readb(musb->mregs, MUSB_DEVCTL);
45 if (is_on) {
46 if (musb->xceiv->otg->state == OTG_STATE_A_IDLE) {
47 /* start the session */
48 devctl |= MUSB_DEVCTL_SESSION;
49 musb_writeb(musb->mregs, MUSB_DEVCTL, devctl);
51 * Wait for the musb to set as A device to enable the
52 * VBUS
54 while (musb_readb(musb->mregs, MUSB_DEVCTL) & 0x80) {
56 if (time_after(jiffies, timeout)) {
57 dev_err(musb->controller,
58 "configured as A device timeout");
59 break;
63 } else {
64 musb->is_active = 1;
65 musb->xceiv->otg->state = OTG_STATE_A_WAIT_VRISE;
66 devctl |= MUSB_DEVCTL_SESSION;
67 MUSB_HST_MODE(musb);
69 } else {
70 musb->is_active = 0;
72 /* NOTE: we're skipping A_WAIT_VFALL -> A_IDLE and jumping
73 * right to B_IDLE...
75 devctl &= ~MUSB_DEVCTL_SESSION;
76 MUSB_DEV_MODE(musb);
78 musb_writeb(musb->mregs, MUSB_DEVCTL, devctl);
81 * Devctl values will be updated after vbus goes below
82 * session_valid. The time taken depends on the capacitance
83 * on VBUS line. The max discharge time can be upto 1 sec
84 * as per the spec. Typically on our platform, it is 200ms
86 if (!is_on)
87 mdelay(200);
89 dev_dbg(musb->controller, "VBUS %s, devctl %02x\n",
90 usb_otg_state_string(musb->xceiv->otg->state),
91 musb_readb(musb->mregs, MUSB_DEVCTL));
94 static int musb_otg_notifications(struct notifier_block *nb,
95 unsigned long event, void *unused)
97 struct musb *musb = container_of(nb, struct musb, nb);
99 dev_dbg(musb->controller, "musb_otg_notifications %ld %s\n",
100 event, usb_otg_state_string(musb->xceiv->otg->state));
102 switch (event) {
103 case UX500_MUSB_ID:
104 dev_dbg(musb->controller, "ID GND\n");
105 ux500_musb_set_vbus(musb, 1);
106 break;
107 case UX500_MUSB_VBUS:
108 dev_dbg(musb->controller, "VBUS Connect\n");
109 break;
110 case UX500_MUSB_NONE:
111 dev_dbg(musb->controller, "VBUS Disconnect\n");
112 if (is_host_active(musb))
113 ux500_musb_set_vbus(musb, 0);
114 else
115 musb->xceiv->otg->state = OTG_STATE_B_IDLE;
116 break;
117 default:
118 dev_dbg(musb->controller, "ID float\n");
119 return NOTIFY_DONE;
121 return NOTIFY_OK;
124 static irqreturn_t ux500_musb_interrupt(int irq, void *__hci)
126 unsigned long flags;
127 irqreturn_t retval = IRQ_NONE;
128 struct musb *musb = __hci;
130 spin_lock_irqsave(&musb->lock, flags);
132 musb->int_usb = musb_readb(musb->mregs, MUSB_INTRUSB);
133 musb->int_tx = musb_readw(musb->mregs, MUSB_INTRTX);
134 musb->int_rx = musb_readw(musb->mregs, MUSB_INTRRX);
136 if (musb->int_usb || musb->int_tx || musb->int_rx)
137 retval = musb_interrupt(musb);
139 spin_unlock_irqrestore(&musb->lock, flags);
141 return retval;
144 static int ux500_musb_init(struct musb *musb)
146 int status;
148 musb->xceiv = usb_get_phy(USB_PHY_TYPE_USB2);
149 if (IS_ERR_OR_NULL(musb->xceiv)) {
150 pr_err("HS USB OTG: no transceiver configured\n");
151 return -EPROBE_DEFER;
154 musb->nb.notifier_call = musb_otg_notifications;
155 status = usb_register_notifier(musb->xceiv, &musb->nb);
156 if (status < 0) {
157 dev_dbg(musb->controller, "notification register failed\n");
158 return status;
161 musb->isr = ux500_musb_interrupt;
163 return 0;
166 static int ux500_musb_exit(struct musb *musb)
168 usb_unregister_notifier(musb->xceiv, &musb->nb);
170 usb_put_phy(musb->xceiv);
172 return 0;
175 static const struct musb_platform_ops ux500_ops = {
176 .quirks = MUSB_DMA_UX500 | MUSB_INDEXED_EP,
177 #ifdef CONFIG_USB_UX500_DMA
178 .dma_init = ux500_dma_controller_create,
179 .dma_exit = ux500_dma_controller_destroy,
180 #endif
181 .init = ux500_musb_init,
182 .exit = ux500_musb_exit,
183 .fifo_mode = 5,
185 .set_vbus = ux500_musb_set_vbus,
188 static struct musb_hdrc_platform_data *
189 ux500_of_probe(struct platform_device *pdev, struct device_node *np)
191 struct musb_hdrc_platform_data *pdata;
192 const char *mode;
193 int strlen;
195 pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
196 if (!pdata)
197 return NULL;
199 mode = of_get_property(np, "dr_mode", &strlen);
200 if (!mode) {
201 dev_err(&pdev->dev, "No 'dr_mode' property found\n");
202 return NULL;
205 if (strlen > 0) {
206 if (!strcmp(mode, "host"))
207 pdata->mode = MUSB_HOST;
208 if (!strcmp(mode, "otg"))
209 pdata->mode = MUSB_OTG;
210 if (!strcmp(mode, "peripheral"))
211 pdata->mode = MUSB_PERIPHERAL;
214 return pdata;
217 static int ux500_probe(struct platform_device *pdev)
219 struct resource musb_resources[2];
220 struct musb_hdrc_platform_data *pdata = dev_get_platdata(&pdev->dev);
221 struct device_node *np = pdev->dev.of_node;
222 struct platform_device *musb;
223 struct ux500_glue *glue;
224 struct clk *clk;
225 int ret = -ENOMEM;
227 if (!pdata) {
228 if (np) {
229 pdata = ux500_of_probe(pdev, np);
230 if (!pdata)
231 goto err0;
233 pdev->dev.platform_data = pdata;
234 } else {
235 dev_err(&pdev->dev, "no pdata or device tree found\n");
236 goto err0;
240 glue = devm_kzalloc(&pdev->dev, sizeof(*glue), GFP_KERNEL);
241 if (!glue)
242 goto err0;
244 musb = platform_device_alloc("musb-hdrc", PLATFORM_DEVID_AUTO);
245 if (!musb) {
246 dev_err(&pdev->dev, "failed to allocate musb device\n");
247 goto err0;
250 clk = devm_clk_get(&pdev->dev, NULL);
251 if (IS_ERR(clk)) {
252 dev_err(&pdev->dev, "failed to get clock\n");
253 ret = PTR_ERR(clk);
254 goto err1;
257 ret = clk_prepare_enable(clk);
258 if (ret) {
259 dev_err(&pdev->dev, "failed to enable clock\n");
260 goto err1;
263 musb->dev.parent = &pdev->dev;
264 musb->dev.dma_mask = &pdev->dev.coherent_dma_mask;
265 musb->dev.coherent_dma_mask = pdev->dev.coherent_dma_mask;
267 glue->dev = &pdev->dev;
268 glue->musb = musb;
269 glue->clk = clk;
271 pdata->platform_ops = &ux500_ops;
272 pdata->config = &ux500_musb_hdrc_config;
274 platform_set_drvdata(pdev, glue);
276 memset(musb_resources, 0x00, sizeof(*musb_resources) *
277 ARRAY_SIZE(musb_resources));
279 musb_resources[0].name = pdev->resource[0].name;
280 musb_resources[0].start = pdev->resource[0].start;
281 musb_resources[0].end = pdev->resource[0].end;
282 musb_resources[0].flags = pdev->resource[0].flags;
284 musb_resources[1].name = pdev->resource[1].name;
285 musb_resources[1].start = pdev->resource[1].start;
286 musb_resources[1].end = pdev->resource[1].end;
287 musb_resources[1].flags = pdev->resource[1].flags;
289 ret = platform_device_add_resources(musb, musb_resources,
290 ARRAY_SIZE(musb_resources));
291 if (ret) {
292 dev_err(&pdev->dev, "failed to add resources\n");
293 goto err2;
296 ret = platform_device_add_data(musb, pdata, sizeof(*pdata));
297 if (ret) {
298 dev_err(&pdev->dev, "failed to add platform_data\n");
299 goto err2;
302 ret = platform_device_add(musb);
303 if (ret) {
304 dev_err(&pdev->dev, "failed to register musb device\n");
305 goto err2;
308 return 0;
310 err2:
311 clk_disable_unprepare(clk);
313 err1:
314 platform_device_put(musb);
316 err0:
317 return ret;
320 static int ux500_remove(struct platform_device *pdev)
322 struct ux500_glue *glue = platform_get_drvdata(pdev);
324 platform_device_unregister(glue->musb);
325 clk_disable_unprepare(glue->clk);
327 return 0;
330 #ifdef CONFIG_PM_SLEEP
331 static int ux500_suspend(struct device *dev)
333 struct ux500_glue *glue = dev_get_drvdata(dev);
334 struct musb *musb = glue_to_musb(glue);
336 if (musb)
337 usb_phy_set_suspend(musb->xceiv, 1);
339 clk_disable_unprepare(glue->clk);
341 return 0;
344 static int ux500_resume(struct device *dev)
346 struct ux500_glue *glue = dev_get_drvdata(dev);
347 struct musb *musb = glue_to_musb(glue);
348 int ret;
350 ret = clk_prepare_enable(glue->clk);
351 if (ret) {
352 dev_err(dev, "failed to enable clock\n");
353 return ret;
356 if (musb)
357 usb_phy_set_suspend(musb->xceiv, 0);
359 return 0;
361 #endif
363 static SIMPLE_DEV_PM_OPS(ux500_pm_ops, ux500_suspend, ux500_resume);
365 static const struct of_device_id ux500_match[] = {
366 { .compatible = "stericsson,db8500-musb", },
370 MODULE_DEVICE_TABLE(of, ux500_match);
372 static struct platform_driver ux500_driver = {
373 .probe = ux500_probe,
374 .remove = ux500_remove,
375 .driver = {
376 .name = "musb-ux500",
377 .pm = &ux500_pm_ops,
378 .of_match_table = ux500_match,
382 MODULE_DESCRIPTION("UX500 MUSB Glue Layer");
383 MODULE_AUTHOR("Mian Yousaf Kaukab <mian.yousaf.kaukab@stericsson.com>");
384 MODULE_LICENSE("GPL v2");
385 module_platform_driver(ux500_driver);