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

source code of linux/drivers/usb/dwc3/dwc3-qcom.c