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