Commit bea46b98 authored by Sandeep Maheswaram's avatar Sandeep Maheswaram Committed by Felipe Balbi
Browse files

usb: dwc3: qcom: Add interconnect support in dwc3 driver 



Add interconnect support in dwc3-qcom driver to vote for bus
bandwidth.

This requires for two different paths - from USB to
DDR. The other is from APPS to USB.

Reviewed-by: default avatarMatthias Kaehlcke <mka@chromium.org>
Signed-off-by: default avatarSandeep Maheswaram <sanm@codeaurora.org>
Signed-off-by: default avatarChandana Kishori Chiluveru <cchiluve@codeaurora.org>
Signed-off-by: default avatarFelipe Balbi <balbi@kernel.org>
parent 072f34c2

drivers/usb/dwc3/dwc3-qcom.c

+118 −2
Original line number Diff line number Diff line
@@ -13,6 +13,7 @@ 
#include <linux/module.h>

#include <linux/kernel.h>

#include <linux/extcon.h>

#include <linux/interconnect.h>

#include <linux/of_platform.h>

#include <linux/platform_device.h>

#include <linux/phy/phy.h>
@@ -43,6 +44,14 @@ 
#define SDM845_QSCRATCH_SIZE			0x400

#define SDM845_DWC3_CORE_SIZE			0xcd00



/* Interconnect path bandwidths in MBps */

#define USB_MEMORY_AVG_HS_BW MBps_to_icc(240)

#define USB_MEMORY_PEAK_HS_BW MBps_to_icc(700)

#define USB_MEMORY_AVG_SS_BW  MBps_to_icc(1000)

#define USB_MEMORY_PEAK_SS_BW MBps_to_icc(2500)

#define APPS_USB_AVG_BW 0

#define APPS_USB_PEAK_BW MBps_to_icc(40)



struct dwc3_acpi_pdata {

	u32			qscratch_base_offset;

	u32			qscratch_base_size;
@@ -76,6 +85,8 @@ struct dwc3_qcom { 
	enum usb_dr_mode	mode;

	bool			is_suspended;

	bool			pm_suspended;

	struct icc_path		*icc_path_ddr;

	struct icc_path		*icc_path_apps;

};



static inline void dwc3_qcom_setbits(void __iomem *base, u32 offset, u32 val)
@@ -190,6 +201,96 @@ static int dwc3_qcom_register_extcon(struct dwc3_qcom *qcom) 
	return 0;

}



static int dwc3_qcom_interconnect_enable(struct dwc3_qcom *qcom)

{

	int ret;



	ret = icc_enable(qcom->icc_path_ddr);

	if (ret)

		return ret;



	ret = icc_enable(qcom->icc_path_apps);

	if (ret)

		icc_disable(qcom->icc_path_ddr);



	return ret;

}



static int dwc3_qcom_interconnect_disable(struct dwc3_qcom *qcom)

{

	int ret;



	ret = icc_disable(qcom->icc_path_ddr);

	if (ret)

		return ret;



	ret = icc_disable(qcom->icc_path_apps);

	if (ret)

		icc_enable(qcom->icc_path_ddr);



	return ret;

}



/**

 * dwc3_qcom_interconnect_init() - Get interconnect path handles

 * and set bandwidhth.

 * @qcom:			Pointer to the concerned usb core.

 *

 */

static int dwc3_qcom_interconnect_init(struct dwc3_qcom *qcom)

{

	struct device *dev = qcom->dev;

	int ret;



	qcom->icc_path_ddr = of_icc_get(dev, "usb-ddr");

	if (IS_ERR(qcom->icc_path_ddr)) {

		dev_err(dev, "failed to get usb-ddr path: %ld\n",

			PTR_ERR(qcom->icc_path_ddr));

		return PTR_ERR(qcom->icc_path_ddr);

	}



	qcom->icc_path_apps = of_icc_get(dev, "apps-usb");

	if (IS_ERR(qcom->icc_path_apps)) {

		dev_err(dev, "failed to get apps-usb path: %ld\n",

				PTR_ERR(qcom->icc_path_apps));

		return PTR_ERR(qcom->icc_path_apps);

	}



	if (usb_get_maximum_speed(&qcom->dwc3->dev) >= USB_SPEED_SUPER ||

			usb_get_maximum_speed(&qcom->dwc3->dev) == USB_SPEED_UNKNOWN)

		ret = icc_set_bw(qcom->icc_path_ddr,

			USB_MEMORY_AVG_SS_BW, USB_MEMORY_PEAK_SS_BW);

	else

		ret = icc_set_bw(qcom->icc_path_ddr,

			USB_MEMORY_AVG_HS_BW, USB_MEMORY_PEAK_HS_BW);



	if (ret) {

		dev_err(dev, "failed to set bandwidth for usb-ddr path: %d\n", ret);

		return ret;

	}



	ret = icc_set_bw(qcom->icc_path_apps,

		APPS_USB_AVG_BW, APPS_USB_PEAK_BW);

	if (ret) {

		dev_err(dev, "failed to set bandwidth for apps-usb path: %d\n", ret);

		return ret;

	}



	return 0;

}



/**

 * dwc3_qcom_interconnect_exit() - Release interconnect path handles

 * @qcom:			Pointer to the concerned usb core.

 *

 * This function is used to release interconnect path handle.

 */

static void dwc3_qcom_interconnect_exit(struct dwc3_qcom *qcom)

{

	icc_put(qcom->icc_path_ddr);

	icc_put(qcom->icc_path_apps);

}



static void dwc3_qcom_disable_interrupts(struct dwc3_qcom *qcom)

{

	if (qcom->hs_phy_irq) {
@@ -239,7 +340,7 @@ static void dwc3_qcom_enable_interrupts(struct dwc3_qcom *qcom) 
static int dwc3_qcom_suspend(struct dwc3_qcom *qcom)

{

	u32 val;

	int i;

	int i, ret;



	if (qcom->is_suspended)

		return 0;
@@ -251,6 +352,10 @@ static int dwc3_qcom_suspend(struct dwc3_qcom *qcom) 
	for (i = qcom->num_clocks - 1; i >= 0; i--)

		clk_disable_unprepare(qcom->clks[i]);



	ret = dwc3_qcom_interconnect_disable(qcom);

	if (ret)

		dev_warn(qcom->dev, "failed to disable interconnect: %d\n", ret);



	qcom->is_suspended = true;

	dwc3_qcom_enable_interrupts(qcom);
@@ -276,6 +381,10 @@ static int dwc3_qcom_resume(struct dwc3_qcom *qcom) 
		}

	}



	ret = dwc3_qcom_interconnect_enable(qcom);

	if (ret)

		dev_warn(qcom->dev, "failed to enable interconnect: %d\n", ret);



	/* Clear existing events from PHY related to L2 in/out */

	dwc3_qcom_setbits(qcom->qscratch_base, PWR_EVNT_IRQ_STAT_REG,

			  PWR_EVNT_LPM_IN_L2_MASK | PWR_EVNT_LPM_OUT_L2_MASK);
@@ -638,6 +747,10 @@ static int dwc3_qcom_probe(struct platform_device *pdev) 
		goto depopulate;

	}



	ret = dwc3_qcom_interconnect_init(qcom);

	if (ret)

		goto depopulate;



	qcom->mode = usb_get_dr_mode(&qcom->dwc3->dev);



	/* enable vbus override for device mode */
@@ -647,7 +760,7 @@ static int dwc3_qcom_probe(struct platform_device *pdev) 
	/* register extcon to override sw_vbus on Vbus change later */

	ret = dwc3_qcom_register_extcon(qcom);

	if (ret)

		goto depopulate;

		goto interconnect_exit;



	device_init_wakeup(&pdev->dev, 1);

	qcom->is_suspended = false;
@@ -657,6 +770,8 @@ static int dwc3_qcom_probe(struct platform_device *pdev) 


	return 0;



interconnect_exit:

	dwc3_qcom_interconnect_exit(qcom);

depopulate:

	if (np)

		of_platform_depopulate(&pdev->dev);
@@ -687,6 +802,7 @@ static int dwc3_qcom_remove(struct platform_device *pdev) 
	}

	qcom->num_clocks = 0;



	dwc3_qcom_interconnect_exit(qcom);

	reset_control_assert(qcom->resets);



	pm_runtime_allow(dev);

CRA Git | Maintained and supported by SUSTech CRA and CCSE