Linux Audio

Check our new training course

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