Loading...
1// SPDX-License-Identifier: GPL-2.0
2/* Copyright (c) 2018, The Linux Foundation. All rights reserved.
3 *
4 * Inspired by dwc3-of-simple.c
5 */
6
7#include <linux/acpi.h>
8#include <linux/io.h>
9#include <linux/of.h>
10#include <linux/clk.h>
11#include <linux/irq.h>
12#include <linux/clk-provider.h>
13#include <linux/module.h>
14#include <linux/kernel.h>
15#include <linux/extcon.h>
16#include <linux/of_platform.h>
17#include <linux/platform_device.h>
18#include <linux/phy/phy.h>
19#include <linux/usb/of.h>
20#include <linux/reset.h>
21#include <linux/iopoll.h>
22
23#include "core.h"
24
25/* USB QSCRATCH Hardware registers */
26#define QSCRATCH_HS_PHY_CTRL 0x10
27#define UTMI_OTG_VBUS_VALID BIT(20)
28#define SW_SESSVLD_SEL BIT(28)
29
30#define QSCRATCH_SS_PHY_CTRL 0x30
31#define LANE0_PWR_PRESENT BIT(24)
32
33#define QSCRATCH_GENERAL_CFG 0x08
34#define PIPE_UTMI_CLK_SEL BIT(0)
35#define PIPE3_PHYSTATUS_SW BIT(3)
36#define PIPE_UTMI_CLK_DIS BIT(8)
37
38#define PWR_EVNT_IRQ_STAT_REG 0x58
39#define PWR_EVNT_LPM_IN_L2_MASK BIT(4)
40#define PWR_EVNT_LPM_OUT_L2_MASK BIT(5)
41
42#define SDM845_QSCRATCH_BASE_OFFSET 0xf8800
43#define SDM845_QSCRATCH_SIZE 0x400
44#define SDM845_DWC3_CORE_SIZE 0xcd00
45
46struct dwc3_acpi_pdata {
47 u32 qscratch_base_offset;
48 u32 qscratch_base_size;
49 u32 dwc3_core_base_size;
50 int hs_phy_irq_index;
51 int dp_hs_phy_irq_index;
52 int dm_hs_phy_irq_index;
53 int ss_phy_irq_index;
54};
55
56struct dwc3_qcom {
57 struct device *dev;
58 void __iomem *qscratch_base;
59 struct platform_device *dwc3;
60 struct clk **clks;
61 int num_clocks;
62 struct reset_control *resets;
63
64 int hs_phy_irq;
65 int dp_hs_phy_irq;
66 int dm_hs_phy_irq;
67 int ss_phy_irq;
68
69 struct extcon_dev *edev;
70 struct extcon_dev *host_edev;
71 struct notifier_block vbus_nb;
72 struct notifier_block host_nb;
73
74 const struct dwc3_acpi_pdata *acpi_pdata;
75
76 enum usb_dr_mode mode;
77 bool is_suspended;
78 bool pm_suspended;
79};
80
81static inline void dwc3_qcom_setbits(void __iomem *base, u32 offset, u32 val)
82{
83 u32 reg;
84
85 reg = readl(base + offset);
86 reg |= val;
87 writel(reg, base + offset);
88
89 /* ensure that above write is through */
90 readl(base + offset);
91}
92
93static inline void dwc3_qcom_clrbits(void __iomem *base, u32 offset, u32 val)
94{
95 u32 reg;
96
97 reg = readl(base + offset);
98 reg &= ~val;
99 writel(reg, base + offset);
100
101 /* ensure that above write is through */
102 readl(base + offset);
103}
104
105static void dwc3_qcom_vbus_overrride_enable(struct dwc3_qcom *qcom, bool enable)
106{
107 if (enable) {
108 dwc3_qcom_setbits(qcom->qscratch_base, QSCRATCH_SS_PHY_CTRL,
109 LANE0_PWR_PRESENT);
110 dwc3_qcom_setbits(qcom->qscratch_base, QSCRATCH_HS_PHY_CTRL,
111 UTMI_OTG_VBUS_VALID | SW_SESSVLD_SEL);
112 } else {
113 dwc3_qcom_clrbits(qcom->qscratch_base, QSCRATCH_SS_PHY_CTRL,
114 LANE0_PWR_PRESENT);
115 dwc3_qcom_clrbits(qcom->qscratch_base, QSCRATCH_HS_PHY_CTRL,
116 UTMI_OTG_VBUS_VALID | SW_SESSVLD_SEL);
117 }
118}
119
120static int dwc3_qcom_vbus_notifier(struct notifier_block *nb,
121 unsigned long event, void *ptr)
122{
123 struct dwc3_qcom *qcom = container_of(nb, struct dwc3_qcom, vbus_nb);
124
125 /* enable vbus override for device mode */
126 dwc3_qcom_vbus_overrride_enable(qcom, event);
127 qcom->mode = event ? USB_DR_MODE_PERIPHERAL : USB_DR_MODE_HOST;
128
129 return NOTIFY_DONE;
130}
131
132static int dwc3_qcom_host_notifier(struct notifier_block *nb,
133 unsigned long event, void *ptr)
134{
135 struct dwc3_qcom *qcom = container_of(nb, struct dwc3_qcom, host_nb);
136
137 /* disable vbus override in host mode */
138 dwc3_qcom_vbus_overrride_enable(qcom, !event);
139 qcom->mode = event ? USB_DR_MODE_HOST : USB_DR_MODE_PERIPHERAL;
140
141 return NOTIFY_DONE;
142}
143
144static int dwc3_qcom_register_extcon(struct dwc3_qcom *qcom)
145{
146 struct device *dev = qcom->dev;
147 struct extcon_dev *host_edev;
148 int ret;
149
150 if (!of_property_read_bool(dev->of_node, "extcon"))
151 return 0;
152
153 qcom->edev = extcon_get_edev_by_phandle(dev, 0);
154 if (IS_ERR(qcom->edev))
155 return PTR_ERR(qcom->edev);
156
157 qcom->vbus_nb.notifier_call = dwc3_qcom_vbus_notifier;
158
159 qcom->host_edev = extcon_get_edev_by_phandle(dev, 1);
160 if (IS_ERR(qcom->host_edev))
161 qcom->host_edev = NULL;
162
163 ret = devm_extcon_register_notifier(dev, qcom->edev, EXTCON_USB,
164 &qcom->vbus_nb);
165 if (ret < 0) {
166 dev_err(dev, "VBUS notifier register failed\n");
167 return ret;
168 }
169
170 if (qcom->host_edev)
171 host_edev = qcom->host_edev;
172 else
173 host_edev = qcom->edev;
174
175 qcom->host_nb.notifier_call = dwc3_qcom_host_notifier;
176 ret = devm_extcon_register_notifier(dev, host_edev, EXTCON_USB_HOST,
177 &qcom->host_nb);
178 if (ret < 0) {
179 dev_err(dev, "Host notifier register failed\n");
180 return ret;
181 }
182
183 /* Update initial VBUS override based on extcon state */
184 if (extcon_get_state(qcom->edev, EXTCON_USB) ||
185 !extcon_get_state(host_edev, EXTCON_USB_HOST))
186 dwc3_qcom_vbus_notifier(&qcom->vbus_nb, true, qcom->edev);
187 else
188 dwc3_qcom_vbus_notifier(&qcom->vbus_nb, false, qcom->edev);
189
190 return 0;
191}
192
193static void dwc3_qcom_disable_interrupts(struct dwc3_qcom *qcom)
194{
195 if (qcom->hs_phy_irq) {
196 disable_irq_wake(qcom->hs_phy_irq);
197 disable_irq_nosync(qcom->hs_phy_irq);
198 }
199
200 if (qcom->dp_hs_phy_irq) {
201 disable_irq_wake(qcom->dp_hs_phy_irq);
202 disable_irq_nosync(qcom->dp_hs_phy_irq);
203 }
204
205 if (qcom->dm_hs_phy_irq) {
206 disable_irq_wake(qcom->dm_hs_phy_irq);
207 disable_irq_nosync(qcom->dm_hs_phy_irq);
208 }
209
210 if (qcom->ss_phy_irq) {
211 disable_irq_wake(qcom->ss_phy_irq);
212 disable_irq_nosync(qcom->ss_phy_irq);
213 }
214}
215
216static void dwc3_qcom_enable_interrupts(struct dwc3_qcom *qcom)
217{
218 if (qcom->hs_phy_irq) {
219 enable_irq(qcom->hs_phy_irq);
220 enable_irq_wake(qcom->hs_phy_irq);
221 }
222
223 if (qcom->dp_hs_phy_irq) {
224 enable_irq(qcom->dp_hs_phy_irq);
225 enable_irq_wake(qcom->dp_hs_phy_irq);
226 }
227
228 if (qcom->dm_hs_phy_irq) {
229 enable_irq(qcom->dm_hs_phy_irq);
230 enable_irq_wake(qcom->dm_hs_phy_irq);
231 }
232
233 if (qcom->ss_phy_irq) {
234 enable_irq(qcom->ss_phy_irq);
235 enable_irq_wake(qcom->ss_phy_irq);
236 }
237}
238
239static int dwc3_qcom_suspend(struct dwc3_qcom *qcom)
240{
241 u32 val;
242 int i;
243
244 if (qcom->is_suspended)
245 return 0;
246
247 val = readl(qcom->qscratch_base + PWR_EVNT_IRQ_STAT_REG);
248 if (!(val & PWR_EVNT_LPM_IN_L2_MASK))
249 dev_err(qcom->dev, "HS-PHY not in L2\n");
250
251 for (i = qcom->num_clocks - 1; i >= 0; i--)
252 clk_disable_unprepare(qcom->clks[i]);
253
254 qcom->is_suspended = true;
255 dwc3_qcom_enable_interrupts(qcom);
256
257 return 0;
258}
259
260static int dwc3_qcom_resume(struct dwc3_qcom *qcom)
261{
262 int ret;
263 int i;
264
265 if (!qcom->is_suspended)
266 return 0;
267
268 dwc3_qcom_disable_interrupts(qcom);
269
270 for (i = 0; i < qcom->num_clocks; i++) {
271 ret = clk_prepare_enable(qcom->clks[i]);
272 if (ret < 0) {
273 while (--i >= 0)
274 clk_disable_unprepare(qcom->clks[i]);
275 return ret;
276 }
277 }
278
279 /* Clear existing events from PHY related to L2 in/out */
280 dwc3_qcom_setbits(qcom->qscratch_base, PWR_EVNT_IRQ_STAT_REG,
281 PWR_EVNT_LPM_IN_L2_MASK | PWR_EVNT_LPM_OUT_L2_MASK);
282
283 qcom->is_suspended = false;
284
285 return 0;
286}
287
288static irqreturn_t qcom_dwc3_resume_irq(int irq, void *data)
289{
290 struct dwc3_qcom *qcom = data;
291 struct dwc3 *dwc = platform_get_drvdata(qcom->dwc3);
292
293 /* If pm_suspended then let pm_resume take care of resuming h/w */
294 if (qcom->pm_suspended)
295 return IRQ_HANDLED;
296
297 if (dwc->xhci)
298 pm_runtime_resume(&dwc->xhci->dev);
299
300 return IRQ_HANDLED;
301}
302
303static void dwc3_qcom_select_utmi_clk(struct dwc3_qcom *qcom)
304{
305 /* Configure dwc3 to use UTMI clock as PIPE clock not present */
306 dwc3_qcom_setbits(qcom->qscratch_base, QSCRATCH_GENERAL_CFG,
307 PIPE_UTMI_CLK_DIS);
308
309 usleep_range(100, 1000);
310
311 dwc3_qcom_setbits(qcom->qscratch_base, QSCRATCH_GENERAL_CFG,
312 PIPE_UTMI_CLK_SEL | PIPE3_PHYSTATUS_SW);
313
314 usleep_range(100, 1000);
315
316 dwc3_qcom_clrbits(qcom->qscratch_base, QSCRATCH_GENERAL_CFG,
317 PIPE_UTMI_CLK_DIS);
318}
319
320static int dwc3_qcom_get_irq(struct platform_device *pdev,
321 const char *name, int num)
322{
323 struct device_node *np = pdev->dev.of_node;
324 int ret;
325
326 if (np)
327 ret = platform_get_irq_byname(pdev, name);
328 else
329 ret = platform_get_irq(pdev, num);
330
331 return ret;
332}
333
334static int dwc3_qcom_setup_irq(struct platform_device *pdev)
335{
336 struct dwc3_qcom *qcom = platform_get_drvdata(pdev);
337 const struct dwc3_acpi_pdata *pdata = qcom->acpi_pdata;
338 int irq, ret;
339 irq = dwc3_qcom_get_irq(pdev, "hs_phy_irq",
340 pdata ? pdata->hs_phy_irq_index : -1);
341 if (irq > 0) {
342 /* Keep wakeup interrupts disabled until suspend */
343 irq_set_status_flags(irq, IRQ_NOAUTOEN);
344 ret = devm_request_threaded_irq(qcom->dev, irq, NULL,
345 qcom_dwc3_resume_irq,
346 IRQF_TRIGGER_HIGH | IRQF_ONESHOT,
347 "qcom_dwc3 HS", qcom);
348 if (ret) {
349 dev_err(qcom->dev, "hs_phy_irq failed: %d\n", ret);
350 return ret;
351 }
352 qcom->hs_phy_irq = irq;
353 }
354
355 irq = dwc3_qcom_get_irq(pdev, "dp_hs_phy_irq",
356 pdata ? pdata->dp_hs_phy_irq_index : -1);
357 if (irq > 0) {
358 irq_set_status_flags(irq, IRQ_NOAUTOEN);
359 ret = devm_request_threaded_irq(qcom->dev, irq, NULL,
360 qcom_dwc3_resume_irq,
361 IRQF_TRIGGER_HIGH | IRQF_ONESHOT,
362 "qcom_dwc3 DP_HS", qcom);
363 if (ret) {
364 dev_err(qcom->dev, "dp_hs_phy_irq failed: %d\n", ret);
365 return ret;
366 }
367 qcom->dp_hs_phy_irq = irq;
368 }
369
370 irq = dwc3_qcom_get_irq(pdev, "dm_hs_phy_irq",
371 pdata ? pdata->dm_hs_phy_irq_index : -1);
372 if (irq > 0) {
373 irq_set_status_flags(irq, IRQ_NOAUTOEN);
374 ret = devm_request_threaded_irq(qcom->dev, irq, NULL,
375 qcom_dwc3_resume_irq,
376 IRQF_TRIGGER_HIGH | IRQF_ONESHOT,
377 "qcom_dwc3 DM_HS", qcom);
378 if (ret) {
379 dev_err(qcom->dev, "dm_hs_phy_irq failed: %d\n", ret);
380 return ret;
381 }
382 qcom->dm_hs_phy_irq = irq;
383 }
384
385 irq = dwc3_qcom_get_irq(pdev, "ss_phy_irq",
386 pdata ? pdata->ss_phy_irq_index : -1);
387 if (irq > 0) {
388 irq_set_status_flags(irq, IRQ_NOAUTOEN);
389 ret = devm_request_threaded_irq(qcom->dev, irq, NULL,
390 qcom_dwc3_resume_irq,
391 IRQF_TRIGGER_HIGH | IRQF_ONESHOT,
392 "qcom_dwc3 SS", qcom);
393 if (ret) {
394 dev_err(qcom->dev, "ss_phy_irq failed: %d\n", ret);
395 return ret;
396 }
397 qcom->ss_phy_irq = irq;
398 }
399
400 return 0;
401}
402
403static int dwc3_qcom_clk_init(struct dwc3_qcom *qcom, int count)
404{
405 struct device *dev = qcom->dev;
406 struct device_node *np = dev->of_node;
407 int i;
408
409 if (!np || !count)
410 return 0;
411
412 if (count < 0)
413 return count;
414
415 qcom->num_clocks = count;
416
417 qcom->clks = devm_kcalloc(dev, qcom->num_clocks,
418 sizeof(struct clk *), GFP_KERNEL);
419 if (!qcom->clks)
420 return -ENOMEM;
421
422 for (i = 0; i < qcom->num_clocks; i++) {
423 struct clk *clk;
424 int ret;
425
426 clk = of_clk_get(np, i);
427 if (IS_ERR(clk)) {
428 while (--i >= 0)
429 clk_put(qcom->clks[i]);
430 return PTR_ERR(clk);
431 }
432
433 ret = clk_prepare_enable(clk);
434 if (ret < 0) {
435 while (--i >= 0) {
436 clk_disable_unprepare(qcom->clks[i]);
437 clk_put(qcom->clks[i]);
438 }
439 clk_put(clk);
440
441 return ret;
442 }
443
444 qcom->clks[i] = clk;
445 }
446
447 return 0;
448}
449
450static const struct property_entry dwc3_qcom_acpi_properties[] = {
451 PROPERTY_ENTRY_STRING("dr_mode", "host"),
452 {}
453};
454
455static int dwc3_qcom_acpi_register_core(struct platform_device *pdev)
456{
457 struct dwc3_qcom *qcom = platform_get_drvdata(pdev);
458 struct device *dev = &pdev->dev;
459 struct resource *res, *child_res = NULL;
460 int irq;
461 int ret;
462
463 qcom->dwc3 = platform_device_alloc("dwc3", PLATFORM_DEVID_AUTO);
464 if (!qcom->dwc3)
465 return -ENOMEM;
466
467 qcom->dwc3->dev.parent = dev;
468 qcom->dwc3->dev.type = dev->type;
469 qcom->dwc3->dev.dma_mask = dev->dma_mask;
470 qcom->dwc3->dev.dma_parms = dev->dma_parms;
471 qcom->dwc3->dev.coherent_dma_mask = dev->coherent_dma_mask;
472
473 child_res = kcalloc(2, sizeof(*child_res), GFP_KERNEL);
474 if (!child_res)
475 return -ENOMEM;
476
477 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
478 if (!res) {
479 dev_err(&pdev->dev, "failed to get memory resource\n");
480 ret = -ENODEV;
481 goto out;
482 }
483
484 child_res[0].flags = res->flags;
485 child_res[0].start = res->start;
486 child_res[0].end = child_res[0].start +
487 qcom->acpi_pdata->dwc3_core_base_size;
488
489 irq = platform_get_irq(pdev, 0);
490 child_res[1].flags = IORESOURCE_IRQ;
491 child_res[1].start = child_res[1].end = irq;
492
493 ret = platform_device_add_resources(qcom->dwc3, child_res, 2);
494 if (ret) {
495 dev_err(&pdev->dev, "failed to add resources\n");
496 goto out;
497 }
498
499 ret = platform_device_add_properties(qcom->dwc3,
500 dwc3_qcom_acpi_properties);
501 if (ret < 0) {
502 dev_err(&pdev->dev, "failed to add properties\n");
503 goto out;
504 }
505
506 ret = platform_device_add(qcom->dwc3);
507 if (ret)
508 dev_err(&pdev->dev, "failed to add device\n");
509
510out:
511 kfree(child_res);
512 return ret;
513}
514
515static int dwc3_qcom_of_register_core(struct platform_device *pdev)
516{
517 struct dwc3_qcom *qcom = platform_get_drvdata(pdev);
518 struct device_node *np = pdev->dev.of_node, *dwc3_np;
519 struct device *dev = &pdev->dev;
520 int ret;
521
522 dwc3_np = of_get_child_by_name(np, "dwc3");
523 if (!dwc3_np) {
524 dev_err(dev, "failed to find dwc3 core child\n");
525 return -ENODEV;
526 }
527
528 ret = of_platform_populate(np, NULL, NULL, dev);
529 if (ret) {
530 dev_err(dev, "failed to register dwc3 core - %d\n", ret);
531 return ret;
532 }
533
534 qcom->dwc3 = of_find_device_by_node(dwc3_np);
535 if (!qcom->dwc3) {
536 dev_err(dev, "failed to get dwc3 platform device\n");
537 return -ENODEV;
538 }
539
540 return 0;
541}
542
543static const struct dwc3_acpi_pdata sdm845_acpi_pdata = {
544 .qscratch_base_offset = SDM845_QSCRATCH_BASE_OFFSET,
545 .qscratch_base_size = SDM845_QSCRATCH_SIZE,
546 .dwc3_core_base_size = SDM845_DWC3_CORE_SIZE,
547 .hs_phy_irq_index = 1,
548 .dp_hs_phy_irq_index = 4,
549 .dm_hs_phy_irq_index = 3,
550 .ss_phy_irq_index = 2
551};
552
553static int dwc3_qcom_probe(struct platform_device *pdev)
554{
555 struct device_node *np = pdev->dev.of_node;
556 struct device *dev = &pdev->dev;
557 struct dwc3_qcom *qcom;
558 struct resource *res, *parent_res = NULL;
559 int ret, i;
560 bool ignore_pipe_clk;
561
562 qcom = devm_kzalloc(&pdev->dev, sizeof(*qcom), GFP_KERNEL);
563 if (!qcom)
564 return -ENOMEM;
565
566 platform_set_drvdata(pdev, qcom);
567 qcom->dev = &pdev->dev;
568
569 if (has_acpi_companion(dev)) {
570 qcom->acpi_pdata = acpi_device_get_match_data(dev);
571 if (!qcom->acpi_pdata) {
572 dev_err(&pdev->dev, "no supporting ACPI device data\n");
573 return -EINVAL;
574 }
575 }
576
577 qcom->resets = devm_reset_control_array_get_optional_exclusive(dev);
578 if (IS_ERR(qcom->resets)) {
579 ret = PTR_ERR(qcom->resets);
580 dev_err(&pdev->dev, "failed to get resets, err=%d\n", ret);
581 return ret;
582 }
583
584 ret = reset_control_assert(qcom->resets);
585 if (ret) {
586 dev_err(&pdev->dev, "failed to assert resets, err=%d\n", ret);
587 return ret;
588 }
589
590 usleep_range(10, 1000);
591
592 ret = reset_control_deassert(qcom->resets);
593 if (ret) {
594 dev_err(&pdev->dev, "failed to deassert resets, err=%d\n", ret);
595 goto reset_assert;
596 }
597
598 ret = dwc3_qcom_clk_init(qcom, of_clk_get_parent_count(np));
599 if (ret) {
600 dev_err(dev, "failed to get clocks\n");
601 goto reset_assert;
602 }
603
604 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
605
606 if (np) {
607 parent_res = res;
608 } else {
609 parent_res = kmemdup(res, sizeof(struct resource), GFP_KERNEL);
610 if (!parent_res)
611 return -ENOMEM;
612
613 parent_res->start = res->start +
614 qcom->acpi_pdata->qscratch_base_offset;
615 parent_res->end = parent_res->start +
616 qcom->acpi_pdata->qscratch_base_size;
617 }
618
619 qcom->qscratch_base = devm_ioremap_resource(dev, parent_res);
620 if (IS_ERR(qcom->qscratch_base)) {
621 dev_err(dev, "failed to map qscratch, err=%d\n", ret);
622 ret = PTR_ERR(qcom->qscratch_base);
623 goto clk_disable;
624 }
625
626 ret = dwc3_qcom_setup_irq(pdev);
627 if (ret) {
628 dev_err(dev, "failed to setup IRQs, err=%d\n", ret);
629 goto clk_disable;
630 }
631
632 /*
633 * Disable pipe_clk requirement if specified. Used when dwc3
634 * operates without SSPHY and only HS/FS/LS modes are supported.
635 */
636 ignore_pipe_clk = device_property_read_bool(dev,
637 "qcom,select-utmi-as-pipe-clk");
638 if (ignore_pipe_clk)
639 dwc3_qcom_select_utmi_clk(qcom);
640
641 if (np)
642 ret = dwc3_qcom_of_register_core(pdev);
643 else
644 ret = dwc3_qcom_acpi_register_core(pdev);
645
646 if (ret) {
647 dev_err(dev, "failed to register DWC3 Core, err=%d\n", ret);
648 goto depopulate;
649 }
650
651 qcom->mode = usb_get_dr_mode(&qcom->dwc3->dev);
652
653 /* enable vbus override for device mode */
654 if (qcom->mode == USB_DR_MODE_PERIPHERAL)
655 dwc3_qcom_vbus_overrride_enable(qcom, true);
656
657 /* register extcon to override sw_vbus on Vbus change later */
658 ret = dwc3_qcom_register_extcon(qcom);
659 if (ret)
660 goto depopulate;
661
662 device_init_wakeup(&pdev->dev, 1);
663 qcom->is_suspended = false;
664 pm_runtime_set_active(dev);
665 pm_runtime_enable(dev);
666 pm_runtime_forbid(dev);
667
668 return 0;
669
670depopulate:
671 if (np)
672 of_platform_depopulate(&pdev->dev);
673 else
674 platform_device_put(pdev);
675clk_disable:
676 for (i = qcom->num_clocks - 1; i >= 0; i--) {
677 clk_disable_unprepare(qcom->clks[i]);
678 clk_put(qcom->clks[i]);
679 }
680reset_assert:
681 reset_control_assert(qcom->resets);
682
683 return ret;
684}
685
686static int dwc3_qcom_remove(struct platform_device *pdev)
687{
688 struct dwc3_qcom *qcom = platform_get_drvdata(pdev);
689 struct device *dev = &pdev->dev;
690 int i;
691
692 of_platform_depopulate(dev);
693
694 for (i = qcom->num_clocks - 1; i >= 0; i--) {
695 clk_disable_unprepare(qcom->clks[i]);
696 clk_put(qcom->clks[i]);
697 }
698 qcom->num_clocks = 0;
699
700 reset_control_assert(qcom->resets);
701
702 pm_runtime_allow(dev);
703 pm_runtime_disable(dev);
704
705 return 0;
706}
707
708static int __maybe_unused dwc3_qcom_pm_suspend(struct device *dev)
709{
710 struct dwc3_qcom *qcom = dev_get_drvdata(dev);
711 int ret = 0;
712
713 ret = dwc3_qcom_suspend(qcom);
714 if (!ret)
715 qcom->pm_suspended = true;
716
717 return ret;
718}
719
720static int __maybe_unused dwc3_qcom_pm_resume(struct device *dev)
721{
722 struct dwc3_qcom *qcom = dev_get_drvdata(dev);
723 int ret;
724
725 ret = dwc3_qcom_resume(qcom);
726 if (!ret)
727 qcom->pm_suspended = false;
728
729 return ret;
730}
731
732static int __maybe_unused dwc3_qcom_runtime_suspend(struct device *dev)
733{
734 struct dwc3_qcom *qcom = dev_get_drvdata(dev);
735
736 return dwc3_qcom_suspend(qcom);
737}
738
739static int __maybe_unused dwc3_qcom_runtime_resume(struct device *dev)
740{
741 struct dwc3_qcom *qcom = dev_get_drvdata(dev);
742
743 return dwc3_qcom_resume(qcom);
744}
745
746static const struct dev_pm_ops dwc3_qcom_dev_pm_ops = {
747 SET_SYSTEM_SLEEP_PM_OPS(dwc3_qcom_pm_suspend, dwc3_qcom_pm_resume)
748 SET_RUNTIME_PM_OPS(dwc3_qcom_runtime_suspend, dwc3_qcom_runtime_resume,
749 NULL)
750};
751
752static const struct of_device_id dwc3_qcom_of_match[] = {
753 { .compatible = "qcom,dwc3" },
754 { .compatible = "qcom,msm8996-dwc3" },
755 { .compatible = "qcom,msm8998-dwc3" },
756 { .compatible = "qcom,sdm845-dwc3" },
757 { }
758};
759MODULE_DEVICE_TABLE(of, dwc3_qcom_of_match);
760
761static const struct acpi_device_id dwc3_qcom_acpi_match[] = {
762 { "QCOM2430", (unsigned long)&sdm845_acpi_pdata },
763 { },
764};
765MODULE_DEVICE_TABLE(acpi, dwc3_qcom_acpi_match);
766
767static struct platform_driver dwc3_qcom_driver = {
768 .probe = dwc3_qcom_probe,
769 .remove = dwc3_qcom_remove,
770 .driver = {
771 .name = "dwc3-qcom",
772 .pm = &dwc3_qcom_dev_pm_ops,
773 .of_match_table = dwc3_qcom_of_match,
774 .acpi_match_table = ACPI_PTR(dwc3_qcom_acpi_match),
775 },
776};
777
778module_platform_driver(dwc3_qcom_driver);
779
780MODULE_LICENSE("GPL v2");
781MODULE_DESCRIPTION("DesignWare DWC3 QCOM Glue Driver");
1// SPDX-License-Identifier: GPL-2.0
2/* Copyright (c) 2018, The Linux Foundation. All rights reserved.
3 *
4 * Inspired by dwc3-of-simple.c
5 */
6
7#include <linux/io.h>
8#include <linux/of.h>
9#include <linux/clk.h>
10#include <linux/irq.h>
11#include <linux/of_clk.h>
12#include <linux/module.h>
13#include <linux/kernel.h>
14#include <linux/extcon.h>
15#include <linux/interconnect.h>
16#include <linux/of_platform.h>
17#include <linux/platform_device.h>
18#include <linux/phy/phy.h>
19#include <linux/usb/of.h>
20#include <linux/reset.h>
21#include <linux/iopoll.h>
22#include <linux/usb/hcd.h>
23#include <linux/usb.h>
24#include "core.h"
25
26/* USB QSCRATCH Hardware registers */
27#define QSCRATCH_HS_PHY_CTRL 0x10
28#define UTMI_OTG_VBUS_VALID BIT(20)
29#define SW_SESSVLD_SEL BIT(28)
30
31#define QSCRATCH_SS_PHY_CTRL 0x30
32#define LANE0_PWR_PRESENT BIT(24)
33
34#define QSCRATCH_GENERAL_CFG 0x08
35#define PIPE_UTMI_CLK_SEL BIT(0)
36#define PIPE3_PHYSTATUS_SW BIT(3)
37#define PIPE_UTMI_CLK_DIS BIT(8)
38
39#define PWR_EVNT_IRQ_STAT_REG 0x58
40#define PWR_EVNT_LPM_IN_L2_MASK BIT(4)
41#define PWR_EVNT_LPM_OUT_L2_MASK BIT(5)
42
43#define SDM845_QSCRATCH_BASE_OFFSET 0xf8800
44#define SDM845_QSCRATCH_SIZE 0x400
45#define SDM845_DWC3_CORE_SIZE 0xcd00
46
47/* Interconnect path bandwidths in MBps */
48#define USB_MEMORY_AVG_HS_BW MBps_to_icc(240)
49#define USB_MEMORY_PEAK_HS_BW MBps_to_icc(700)
50#define USB_MEMORY_AVG_SS_BW MBps_to_icc(1000)
51#define USB_MEMORY_PEAK_SS_BW MBps_to_icc(2500)
52#define APPS_USB_AVG_BW 0
53#define APPS_USB_PEAK_BW MBps_to_icc(40)
54
55struct dwc3_qcom {
56 struct device *dev;
57 void __iomem *qscratch_base;
58 struct platform_device *dwc3;
59 struct clk **clks;
60 int num_clocks;
61 struct reset_control *resets;
62
63 int qusb2_phy_irq;
64 int dp_hs_phy_irq;
65 int dm_hs_phy_irq;
66 int ss_phy_irq;
67 enum usb_device_speed usb2_speed;
68
69 struct extcon_dev *edev;
70 struct extcon_dev *host_edev;
71 struct notifier_block vbus_nb;
72 struct notifier_block host_nb;
73
74 enum usb_dr_mode mode;
75 bool is_suspended;
76 bool pm_suspended;
77 struct icc_path *icc_path_ddr;
78 struct icc_path *icc_path_apps;
79};
80
81static inline void dwc3_qcom_setbits(void __iomem *base, u32 offset, u32 val)
82{
83 u32 reg;
84
85 reg = readl(base + offset);
86 reg |= val;
87 writel(reg, base + offset);
88
89 /* ensure that above write is through */
90 readl(base + offset);
91}
92
93static inline void dwc3_qcom_clrbits(void __iomem *base, u32 offset, u32 val)
94{
95 u32 reg;
96
97 reg = readl(base + offset);
98 reg &= ~val;
99 writel(reg, base + offset);
100
101 /* ensure that above write is through */
102 readl(base + offset);
103}
104
105static void dwc3_qcom_vbus_override_enable(struct dwc3_qcom *qcom, bool enable)
106{
107 if (enable) {
108 dwc3_qcom_setbits(qcom->qscratch_base, QSCRATCH_SS_PHY_CTRL,
109 LANE0_PWR_PRESENT);
110 dwc3_qcom_setbits(qcom->qscratch_base, QSCRATCH_HS_PHY_CTRL,
111 UTMI_OTG_VBUS_VALID | SW_SESSVLD_SEL);
112 } else {
113 dwc3_qcom_clrbits(qcom->qscratch_base, QSCRATCH_SS_PHY_CTRL,
114 LANE0_PWR_PRESENT);
115 dwc3_qcom_clrbits(qcom->qscratch_base, QSCRATCH_HS_PHY_CTRL,
116 UTMI_OTG_VBUS_VALID | SW_SESSVLD_SEL);
117 }
118}
119
120static int dwc3_qcom_vbus_notifier(struct notifier_block *nb,
121 unsigned long event, void *ptr)
122{
123 struct dwc3_qcom *qcom = container_of(nb, struct dwc3_qcom, vbus_nb);
124
125 /* enable vbus override for device mode */
126 dwc3_qcom_vbus_override_enable(qcom, event);
127 qcom->mode = event ? USB_DR_MODE_PERIPHERAL : USB_DR_MODE_HOST;
128
129 return NOTIFY_DONE;
130}
131
132static int dwc3_qcom_host_notifier(struct notifier_block *nb,
133 unsigned long event, void *ptr)
134{
135 struct dwc3_qcom *qcom = container_of(nb, struct dwc3_qcom, host_nb);
136
137 /* disable vbus override in host mode */
138 dwc3_qcom_vbus_override_enable(qcom, !event);
139 qcom->mode = event ? USB_DR_MODE_HOST : USB_DR_MODE_PERIPHERAL;
140
141 return NOTIFY_DONE;
142}
143
144static int dwc3_qcom_register_extcon(struct dwc3_qcom *qcom)
145{
146 struct device *dev = qcom->dev;
147 struct extcon_dev *host_edev;
148 int ret;
149
150 if (!of_property_read_bool(dev->of_node, "extcon"))
151 return 0;
152
153 qcom->edev = extcon_get_edev_by_phandle(dev, 0);
154 if (IS_ERR(qcom->edev))
155 return dev_err_probe(dev, PTR_ERR(qcom->edev),
156 "Failed to get extcon\n");
157
158 qcom->vbus_nb.notifier_call = dwc3_qcom_vbus_notifier;
159
160 qcom->host_edev = extcon_get_edev_by_phandle(dev, 1);
161 if (IS_ERR(qcom->host_edev))
162 qcom->host_edev = NULL;
163
164 ret = devm_extcon_register_notifier(dev, qcom->edev, EXTCON_USB,
165 &qcom->vbus_nb);
166 if (ret < 0) {
167 dev_err(dev, "VBUS notifier register failed\n");
168 return ret;
169 }
170
171 if (qcom->host_edev)
172 host_edev = qcom->host_edev;
173 else
174 host_edev = qcom->edev;
175
176 qcom->host_nb.notifier_call = dwc3_qcom_host_notifier;
177 ret = devm_extcon_register_notifier(dev, host_edev, EXTCON_USB_HOST,
178 &qcom->host_nb);
179 if (ret < 0) {
180 dev_err(dev, "Host notifier register failed\n");
181 return ret;
182 }
183
184 /* Update initial VBUS override based on extcon state */
185 if (extcon_get_state(qcom->edev, EXTCON_USB) ||
186 !extcon_get_state(host_edev, EXTCON_USB_HOST))
187 dwc3_qcom_vbus_notifier(&qcom->vbus_nb, true, qcom->edev);
188 else
189 dwc3_qcom_vbus_notifier(&qcom->vbus_nb, false, qcom->edev);
190
191 return 0;
192}
193
194static int dwc3_qcom_interconnect_enable(struct dwc3_qcom *qcom)
195{
196 int ret;
197
198 ret = icc_enable(qcom->icc_path_ddr);
199 if (ret)
200 return ret;
201
202 ret = icc_enable(qcom->icc_path_apps);
203 if (ret)
204 icc_disable(qcom->icc_path_ddr);
205
206 return ret;
207}
208
209static int dwc3_qcom_interconnect_disable(struct dwc3_qcom *qcom)
210{
211 int ret;
212
213 ret = icc_disable(qcom->icc_path_ddr);
214 if (ret)
215 return ret;
216
217 ret = icc_disable(qcom->icc_path_apps);
218 if (ret)
219 icc_enable(qcom->icc_path_ddr);
220
221 return ret;
222}
223
224/**
225 * dwc3_qcom_interconnect_init() - Get interconnect path handles
226 * and set bandwidth.
227 * @qcom: Pointer to the concerned usb core.
228 *
229 */
230static int dwc3_qcom_interconnect_init(struct dwc3_qcom *qcom)
231{
232 enum usb_device_speed max_speed;
233 struct device *dev = qcom->dev;
234 int ret;
235
236 qcom->icc_path_ddr = of_icc_get(dev, "usb-ddr");
237 if (IS_ERR(qcom->icc_path_ddr)) {
238 return dev_err_probe(dev, PTR_ERR(qcom->icc_path_ddr),
239 "failed to get usb-ddr path\n");
240 }
241
242 qcom->icc_path_apps = of_icc_get(dev, "apps-usb");
243 if (IS_ERR(qcom->icc_path_apps)) {
244 ret = dev_err_probe(dev, PTR_ERR(qcom->icc_path_apps),
245 "failed to get apps-usb path\n");
246 goto put_path_ddr;
247 }
248
249 max_speed = usb_get_maximum_speed(&qcom->dwc3->dev);
250 if (max_speed >= USB_SPEED_SUPER || max_speed == USB_SPEED_UNKNOWN) {
251 ret = icc_set_bw(qcom->icc_path_ddr,
252 USB_MEMORY_AVG_SS_BW, USB_MEMORY_PEAK_SS_BW);
253 } else {
254 ret = icc_set_bw(qcom->icc_path_ddr,
255 USB_MEMORY_AVG_HS_BW, USB_MEMORY_PEAK_HS_BW);
256 }
257 if (ret) {
258 dev_err(dev, "failed to set bandwidth for usb-ddr path: %d\n", ret);
259 goto put_path_apps;
260 }
261
262 ret = icc_set_bw(qcom->icc_path_apps, APPS_USB_AVG_BW, APPS_USB_PEAK_BW);
263 if (ret) {
264 dev_err(dev, "failed to set bandwidth for apps-usb path: %d\n", ret);
265 goto put_path_apps;
266 }
267
268 return 0;
269
270put_path_apps:
271 icc_put(qcom->icc_path_apps);
272put_path_ddr:
273 icc_put(qcom->icc_path_ddr);
274 return ret;
275}
276
277/**
278 * dwc3_qcom_interconnect_exit() - Release interconnect path handles
279 * @qcom: Pointer to the concerned usb core.
280 *
281 * This function is used to release interconnect path handle.
282 */
283static void dwc3_qcom_interconnect_exit(struct dwc3_qcom *qcom)
284{
285 icc_put(qcom->icc_path_ddr);
286 icc_put(qcom->icc_path_apps);
287}
288
289/* Only usable in contexts where the role can not change. */
290static bool dwc3_qcom_is_host(struct dwc3_qcom *qcom)
291{
292 struct dwc3 *dwc;
293
294 /*
295 * FIXME: Fix this layering violation.
296 */
297 dwc = platform_get_drvdata(qcom->dwc3);
298
299 /* Core driver may not have probed yet. */
300 if (!dwc)
301 return false;
302
303 return dwc->xhci;
304}
305
306static enum usb_device_speed dwc3_qcom_read_usb2_speed(struct dwc3_qcom *qcom)
307{
308 struct dwc3 *dwc = platform_get_drvdata(qcom->dwc3);
309 struct usb_device *udev;
310 struct usb_hcd __maybe_unused *hcd;
311
312 /*
313 * FIXME: Fix this layering violation.
314 */
315 hcd = platform_get_drvdata(dwc->xhci);
316
317 /*
318 * It is possible to query the speed of all children of
319 * USB2.0 root hub via usb_hub_for_each_child(). DWC3 code
320 * currently supports only 1 port per controller. So
321 * this is sufficient.
322 */
323#ifdef CONFIG_USB
324 udev = usb_hub_find_child(hcd->self.root_hub, 1);
325#else
326 udev = NULL;
327#endif
328 if (!udev)
329 return USB_SPEED_UNKNOWN;
330
331 return udev->speed;
332}
333
334static void dwc3_qcom_enable_wakeup_irq(int irq, unsigned int polarity)
335{
336 if (!irq)
337 return;
338
339 if (polarity)
340 irq_set_irq_type(irq, polarity);
341
342 enable_irq(irq);
343 enable_irq_wake(irq);
344}
345
346static void dwc3_qcom_disable_wakeup_irq(int irq)
347{
348 if (!irq)
349 return;
350
351 disable_irq_wake(irq);
352 disable_irq_nosync(irq);
353}
354
355static void dwc3_qcom_disable_interrupts(struct dwc3_qcom *qcom)
356{
357 dwc3_qcom_disable_wakeup_irq(qcom->qusb2_phy_irq);
358
359 if (qcom->usb2_speed == USB_SPEED_LOW) {
360 dwc3_qcom_disable_wakeup_irq(qcom->dm_hs_phy_irq);
361 } else if ((qcom->usb2_speed == USB_SPEED_HIGH) ||
362 (qcom->usb2_speed == USB_SPEED_FULL)) {
363 dwc3_qcom_disable_wakeup_irq(qcom->dp_hs_phy_irq);
364 } else {
365 dwc3_qcom_disable_wakeup_irq(qcom->dp_hs_phy_irq);
366 dwc3_qcom_disable_wakeup_irq(qcom->dm_hs_phy_irq);
367 }
368
369 dwc3_qcom_disable_wakeup_irq(qcom->ss_phy_irq);
370}
371
372static void dwc3_qcom_enable_interrupts(struct dwc3_qcom *qcom)
373{
374 dwc3_qcom_enable_wakeup_irq(qcom->qusb2_phy_irq, 0);
375
376 /*
377 * Configure DP/DM line interrupts based on the USB2 device attached to
378 * the root hub port. When HS/FS device is connected, configure the DP line
379 * as falling edge to detect both disconnect and remote wakeup scenarios. When
380 * LS device is connected, configure DM line as falling edge to detect both
381 * disconnect and remote wakeup. When no device is connected, configure both
382 * DP and DM lines as rising edge to detect HS/HS/LS device connect scenario.
383 */
384
385 if (qcom->usb2_speed == USB_SPEED_LOW) {
386 dwc3_qcom_enable_wakeup_irq(qcom->dm_hs_phy_irq,
387 IRQ_TYPE_EDGE_FALLING);
388 } else if ((qcom->usb2_speed == USB_SPEED_HIGH) ||
389 (qcom->usb2_speed == USB_SPEED_FULL)) {
390 dwc3_qcom_enable_wakeup_irq(qcom->dp_hs_phy_irq,
391 IRQ_TYPE_EDGE_FALLING);
392 } else {
393 dwc3_qcom_enable_wakeup_irq(qcom->dp_hs_phy_irq,
394 IRQ_TYPE_EDGE_RISING);
395 dwc3_qcom_enable_wakeup_irq(qcom->dm_hs_phy_irq,
396 IRQ_TYPE_EDGE_RISING);
397 }
398
399 dwc3_qcom_enable_wakeup_irq(qcom->ss_phy_irq, 0);
400}
401
402static int dwc3_qcom_suspend(struct dwc3_qcom *qcom, bool wakeup)
403{
404 u32 val;
405 int i, ret;
406
407 if (qcom->is_suspended)
408 return 0;
409
410 val = readl(qcom->qscratch_base + PWR_EVNT_IRQ_STAT_REG);
411 if (!(val & PWR_EVNT_LPM_IN_L2_MASK))
412 dev_err(qcom->dev, "HS-PHY not in L2\n");
413
414 for (i = qcom->num_clocks - 1; i >= 0; i--)
415 clk_disable_unprepare(qcom->clks[i]);
416
417 ret = dwc3_qcom_interconnect_disable(qcom);
418 if (ret)
419 dev_warn(qcom->dev, "failed to disable interconnect: %d\n", ret);
420
421 /*
422 * The role is stable during suspend as role switching is done from a
423 * freezable workqueue.
424 */
425 if (dwc3_qcom_is_host(qcom) && wakeup) {
426 qcom->usb2_speed = dwc3_qcom_read_usb2_speed(qcom);
427 dwc3_qcom_enable_interrupts(qcom);
428 }
429
430 qcom->is_suspended = true;
431
432 return 0;
433}
434
435static int dwc3_qcom_resume(struct dwc3_qcom *qcom, bool wakeup)
436{
437 int ret;
438 int i;
439
440 if (!qcom->is_suspended)
441 return 0;
442
443 if (dwc3_qcom_is_host(qcom) && wakeup)
444 dwc3_qcom_disable_interrupts(qcom);
445
446 for (i = 0; i < qcom->num_clocks; i++) {
447 ret = clk_prepare_enable(qcom->clks[i]);
448 if (ret < 0) {
449 while (--i >= 0)
450 clk_disable_unprepare(qcom->clks[i]);
451 return ret;
452 }
453 }
454
455 ret = dwc3_qcom_interconnect_enable(qcom);
456 if (ret)
457 dev_warn(qcom->dev, "failed to enable interconnect: %d\n", ret);
458
459 /* Clear existing events from PHY related to L2 in/out */
460 dwc3_qcom_setbits(qcom->qscratch_base, PWR_EVNT_IRQ_STAT_REG,
461 PWR_EVNT_LPM_IN_L2_MASK | PWR_EVNT_LPM_OUT_L2_MASK);
462
463 qcom->is_suspended = false;
464
465 return 0;
466}
467
468static irqreturn_t qcom_dwc3_resume_irq(int irq, void *data)
469{
470 struct dwc3_qcom *qcom = data;
471 struct dwc3 *dwc = platform_get_drvdata(qcom->dwc3);
472
473 /* If pm_suspended then let pm_resume take care of resuming h/w */
474 if (qcom->pm_suspended)
475 return IRQ_HANDLED;
476
477 /*
478 * This is safe as role switching is done from a freezable workqueue
479 * and the wakeup interrupts are disabled as part of resume.
480 */
481 if (dwc3_qcom_is_host(qcom))
482 pm_runtime_resume(&dwc->xhci->dev);
483
484 return IRQ_HANDLED;
485}
486
487static void dwc3_qcom_select_utmi_clk(struct dwc3_qcom *qcom)
488{
489 /* Configure dwc3 to use UTMI clock as PIPE clock not present */
490 dwc3_qcom_setbits(qcom->qscratch_base, QSCRATCH_GENERAL_CFG,
491 PIPE_UTMI_CLK_DIS);
492
493 usleep_range(100, 1000);
494
495 dwc3_qcom_setbits(qcom->qscratch_base, QSCRATCH_GENERAL_CFG,
496 PIPE_UTMI_CLK_SEL | PIPE3_PHYSTATUS_SW);
497
498 usleep_range(100, 1000);
499
500 dwc3_qcom_clrbits(qcom->qscratch_base, QSCRATCH_GENERAL_CFG,
501 PIPE_UTMI_CLK_DIS);
502}
503
504static int dwc3_qcom_setup_irq(struct platform_device *pdev)
505{
506 struct dwc3_qcom *qcom = platform_get_drvdata(pdev);
507 int irq;
508 int ret;
509
510 irq = platform_get_irq_byname_optional(pdev, "qusb2_phy");
511 if (irq > 0) {
512 /* Keep wakeup interrupts disabled until suspend */
513 ret = devm_request_threaded_irq(qcom->dev, irq, NULL,
514 qcom_dwc3_resume_irq,
515 IRQF_ONESHOT | IRQF_NO_AUTOEN,
516 "qcom_dwc3 QUSB2", qcom);
517 if (ret) {
518 dev_err(qcom->dev, "qusb2_phy_irq failed: %d\n", ret);
519 return ret;
520 }
521 qcom->qusb2_phy_irq = irq;
522 }
523
524 irq = platform_get_irq_byname_optional(pdev, "dp_hs_phy_irq");
525 if (irq > 0) {
526 ret = devm_request_threaded_irq(qcom->dev, irq, NULL,
527 qcom_dwc3_resume_irq,
528 IRQF_ONESHOT | IRQF_NO_AUTOEN,
529 "qcom_dwc3 DP_HS", qcom);
530 if (ret) {
531 dev_err(qcom->dev, "dp_hs_phy_irq failed: %d\n", ret);
532 return ret;
533 }
534 qcom->dp_hs_phy_irq = irq;
535 }
536
537 irq = platform_get_irq_byname_optional(pdev, "dm_hs_phy_irq");
538 if (irq > 0) {
539 ret = devm_request_threaded_irq(qcom->dev, irq, NULL,
540 qcom_dwc3_resume_irq,
541 IRQF_ONESHOT | IRQF_NO_AUTOEN,
542 "qcom_dwc3 DM_HS", qcom);
543 if (ret) {
544 dev_err(qcom->dev, "dm_hs_phy_irq failed: %d\n", ret);
545 return ret;
546 }
547 qcom->dm_hs_phy_irq = irq;
548 }
549
550 irq = platform_get_irq_byname_optional(pdev, "ss_phy_irq");
551 if (irq > 0) {
552 ret = devm_request_threaded_irq(qcom->dev, irq, NULL,
553 qcom_dwc3_resume_irq,
554 IRQF_ONESHOT | IRQF_NO_AUTOEN,
555 "qcom_dwc3 SS", qcom);
556 if (ret) {
557 dev_err(qcom->dev, "ss_phy_irq failed: %d\n", ret);
558 return ret;
559 }
560 qcom->ss_phy_irq = irq;
561 }
562
563 return 0;
564}
565
566static int dwc3_qcom_clk_init(struct dwc3_qcom *qcom, int count)
567{
568 struct device *dev = qcom->dev;
569 struct device_node *np = dev->of_node;
570 int i;
571
572 if (!np || !count)
573 return 0;
574
575 if (count < 0)
576 return count;
577
578 qcom->num_clocks = count;
579
580 qcom->clks = devm_kcalloc(dev, qcom->num_clocks,
581 sizeof(struct clk *), GFP_KERNEL);
582 if (!qcom->clks)
583 return -ENOMEM;
584
585 for (i = 0; i < qcom->num_clocks; i++) {
586 struct clk *clk;
587 int ret;
588
589 clk = of_clk_get(np, i);
590 if (IS_ERR(clk)) {
591 while (--i >= 0)
592 clk_put(qcom->clks[i]);
593 return PTR_ERR(clk);
594 }
595
596 ret = clk_prepare_enable(clk);
597 if (ret < 0) {
598 while (--i >= 0) {
599 clk_disable_unprepare(qcom->clks[i]);
600 clk_put(qcom->clks[i]);
601 }
602 clk_put(clk);
603
604 return ret;
605 }
606
607 qcom->clks[i] = clk;
608 }
609
610 return 0;
611}
612
613static int dwc3_qcom_of_register_core(struct platform_device *pdev)
614{
615 struct dwc3_qcom *qcom = platform_get_drvdata(pdev);
616 struct device_node *np = pdev->dev.of_node, *dwc3_np;
617 struct device *dev = &pdev->dev;
618 int ret;
619
620 dwc3_np = of_get_compatible_child(np, "snps,dwc3");
621 if (!dwc3_np) {
622 dev_err(dev, "failed to find dwc3 core child\n");
623 return -ENODEV;
624 }
625
626 ret = of_platform_populate(np, NULL, NULL, dev);
627 if (ret) {
628 dev_err(dev, "failed to register dwc3 core - %d\n", ret);
629 goto node_put;
630 }
631
632 qcom->dwc3 = of_find_device_by_node(dwc3_np);
633 if (!qcom->dwc3) {
634 ret = -ENODEV;
635 dev_err(dev, "failed to get dwc3 platform device\n");
636 of_platform_depopulate(dev);
637 }
638
639node_put:
640 of_node_put(dwc3_np);
641
642 return ret;
643}
644
645static int dwc3_qcom_probe(struct platform_device *pdev)
646{
647 struct device_node *np = pdev->dev.of_node;
648 struct device *dev = &pdev->dev;
649 struct dwc3_qcom *qcom;
650 struct resource *res;
651 int ret, i;
652 bool ignore_pipe_clk;
653 bool wakeup_source;
654
655 qcom = devm_kzalloc(&pdev->dev, sizeof(*qcom), GFP_KERNEL);
656 if (!qcom)
657 return -ENOMEM;
658
659 platform_set_drvdata(pdev, qcom);
660 qcom->dev = &pdev->dev;
661
662 qcom->resets = devm_reset_control_array_get_optional_exclusive(dev);
663 if (IS_ERR(qcom->resets)) {
664 return dev_err_probe(&pdev->dev, PTR_ERR(qcom->resets),
665 "failed to get resets\n");
666 }
667
668 ret = reset_control_assert(qcom->resets);
669 if (ret) {
670 dev_err(&pdev->dev, "failed to assert resets, err=%d\n", ret);
671 return ret;
672 }
673
674 usleep_range(10, 1000);
675
676 ret = reset_control_deassert(qcom->resets);
677 if (ret) {
678 dev_err(&pdev->dev, "failed to deassert resets, err=%d\n", ret);
679 goto reset_assert;
680 }
681
682 ret = dwc3_qcom_clk_init(qcom, of_clk_get_parent_count(np));
683 if (ret) {
684 dev_err_probe(dev, ret, "failed to get clocks\n");
685 goto reset_assert;
686 }
687
688 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
689
690 qcom->qscratch_base = devm_ioremap_resource(dev, res);
691 if (IS_ERR(qcom->qscratch_base)) {
692 ret = PTR_ERR(qcom->qscratch_base);
693 goto clk_disable;
694 }
695
696 ret = dwc3_qcom_setup_irq(pdev);
697 if (ret) {
698 dev_err(dev, "failed to setup IRQs, err=%d\n", ret);
699 goto clk_disable;
700 }
701
702 /*
703 * Disable pipe_clk requirement if specified. Used when dwc3
704 * operates without SSPHY and only HS/FS/LS modes are supported.
705 */
706 ignore_pipe_clk = device_property_read_bool(dev,
707 "qcom,select-utmi-as-pipe-clk");
708 if (ignore_pipe_clk)
709 dwc3_qcom_select_utmi_clk(qcom);
710
711 ret = dwc3_qcom_of_register_core(pdev);
712 if (ret) {
713 dev_err(dev, "failed to register DWC3 Core, err=%d\n", ret);
714 goto clk_disable;
715 }
716
717 ret = dwc3_qcom_interconnect_init(qcom);
718 if (ret)
719 goto depopulate;
720
721 qcom->mode = usb_get_dr_mode(&qcom->dwc3->dev);
722
723 /* enable vbus override for device mode */
724 if (qcom->mode != USB_DR_MODE_HOST)
725 dwc3_qcom_vbus_override_enable(qcom, true);
726
727 /* register extcon to override sw_vbus on Vbus change later */
728 ret = dwc3_qcom_register_extcon(qcom);
729 if (ret)
730 goto interconnect_exit;
731
732 wakeup_source = of_property_read_bool(dev->of_node, "wakeup-source");
733 device_init_wakeup(&pdev->dev, wakeup_source);
734 device_init_wakeup(&qcom->dwc3->dev, wakeup_source);
735
736 qcom->is_suspended = false;
737 pm_runtime_set_active(dev);
738 pm_runtime_enable(dev);
739 pm_runtime_forbid(dev);
740
741 return 0;
742
743interconnect_exit:
744 dwc3_qcom_interconnect_exit(qcom);
745depopulate:
746 of_platform_depopulate(&pdev->dev);
747 platform_device_put(qcom->dwc3);
748clk_disable:
749 for (i = qcom->num_clocks - 1; i >= 0; i--) {
750 clk_disable_unprepare(qcom->clks[i]);
751 clk_put(qcom->clks[i]);
752 }
753reset_assert:
754 reset_control_assert(qcom->resets);
755
756 return ret;
757}
758
759static void dwc3_qcom_remove(struct platform_device *pdev)
760{
761 struct dwc3_qcom *qcom = platform_get_drvdata(pdev);
762 struct device *dev = &pdev->dev;
763 int i;
764
765 of_platform_depopulate(&pdev->dev);
766 platform_device_put(qcom->dwc3);
767
768 for (i = qcom->num_clocks - 1; i >= 0; i--) {
769 clk_disable_unprepare(qcom->clks[i]);
770 clk_put(qcom->clks[i]);
771 }
772 qcom->num_clocks = 0;
773
774 dwc3_qcom_interconnect_exit(qcom);
775 reset_control_assert(qcom->resets);
776
777 pm_runtime_allow(dev);
778 pm_runtime_disable(dev);
779}
780
781static int __maybe_unused dwc3_qcom_pm_suspend(struct device *dev)
782{
783 struct dwc3_qcom *qcom = dev_get_drvdata(dev);
784 bool wakeup = device_may_wakeup(dev);
785 int ret;
786
787 ret = dwc3_qcom_suspend(qcom, wakeup);
788 if (ret)
789 return ret;
790
791 qcom->pm_suspended = true;
792
793 return 0;
794}
795
796static int __maybe_unused dwc3_qcom_pm_resume(struct device *dev)
797{
798 struct dwc3_qcom *qcom = dev_get_drvdata(dev);
799 bool wakeup = device_may_wakeup(dev);
800 int ret;
801
802 ret = dwc3_qcom_resume(qcom, wakeup);
803 if (ret)
804 return ret;
805
806 qcom->pm_suspended = false;
807
808 return 0;
809}
810
811static int __maybe_unused dwc3_qcom_runtime_suspend(struct device *dev)
812{
813 struct dwc3_qcom *qcom = dev_get_drvdata(dev);
814
815 return dwc3_qcom_suspend(qcom, true);
816}
817
818static int __maybe_unused dwc3_qcom_runtime_resume(struct device *dev)
819{
820 struct dwc3_qcom *qcom = dev_get_drvdata(dev);
821
822 return dwc3_qcom_resume(qcom, true);
823}
824
825static const struct dev_pm_ops dwc3_qcom_dev_pm_ops = {
826 SET_SYSTEM_SLEEP_PM_OPS(dwc3_qcom_pm_suspend, dwc3_qcom_pm_resume)
827 SET_RUNTIME_PM_OPS(dwc3_qcom_runtime_suspend, dwc3_qcom_runtime_resume,
828 NULL)
829};
830
831static const struct of_device_id dwc3_qcom_of_match[] = {
832 { .compatible = "qcom,dwc3" },
833 { }
834};
835MODULE_DEVICE_TABLE(of, dwc3_qcom_of_match);
836
837static struct platform_driver dwc3_qcom_driver = {
838 .probe = dwc3_qcom_probe,
839 .remove_new = dwc3_qcom_remove,
840 .driver = {
841 .name = "dwc3-qcom",
842 .pm = &dwc3_qcom_dev_pm_ops,
843 .of_match_table = dwc3_qcom_of_match,
844 },
845};
846
847module_platform_driver(dwc3_qcom_driver);
848
849MODULE_LICENSE("GPL v2");
850MODULE_DESCRIPTION("DesignWare DWC3 QCOM Glue Driver");