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: Matthias Kaehlcke <mka@chromium.org> Signed-off-by: Sandeep Maheswaram <sanm@codeaurora.org> Signed-off-by: Chandana Kishori Chiluveru <cchiluve@codeaurora.org> Signed-off-by: Felipe Balbi <balbi@kernel.org>
This commit is contained in:
parent
072f34c2eb
commit
bea46b9815
|
@ -13,6 +13,7 @@
|
||||||
#include <linux/module.h>
|
#include <linux/module.h>
|
||||||
#include <linux/kernel.h>
|
#include <linux/kernel.h>
|
||||||
#include <linux/extcon.h>
|
#include <linux/extcon.h>
|
||||||
|
#include <linux/interconnect.h>
|
||||||
#include <linux/of_platform.h>
|
#include <linux/of_platform.h>
|
||||||
#include <linux/platform_device.h>
|
#include <linux/platform_device.h>
|
||||||
#include <linux/phy/phy.h>
|
#include <linux/phy/phy.h>
|
||||||
|
@ -43,6 +44,14 @@
|
||||||
#define SDM845_QSCRATCH_SIZE 0x400
|
#define SDM845_QSCRATCH_SIZE 0x400
|
||||||
#define SDM845_DWC3_CORE_SIZE 0xcd00
|
#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 {
|
struct dwc3_acpi_pdata {
|
||||||
u32 qscratch_base_offset;
|
u32 qscratch_base_offset;
|
||||||
u32 qscratch_base_size;
|
u32 qscratch_base_size;
|
||||||
|
@ -76,6 +85,8 @@ struct dwc3_qcom {
|
||||||
enum usb_dr_mode mode;
|
enum usb_dr_mode mode;
|
||||||
bool is_suspended;
|
bool is_suspended;
|
||||||
bool pm_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)
|
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;
|
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)
|
static void dwc3_qcom_disable_interrupts(struct dwc3_qcom *qcom)
|
||||||
{
|
{
|
||||||
if (qcom->hs_phy_irq) {
|
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)
|
static int dwc3_qcom_suspend(struct dwc3_qcom *qcom)
|
||||||
{
|
{
|
||||||
u32 val;
|
u32 val;
|
||||||
int i;
|
int i, ret;
|
||||||
|
|
||||||
if (qcom->is_suspended)
|
if (qcom->is_suspended)
|
||||||
return 0;
|
return 0;
|
||||||
|
@ -251,6 +352,10 @@ static int dwc3_qcom_suspend(struct dwc3_qcom *qcom)
|
||||||
for (i = qcom->num_clocks - 1; i >= 0; i--)
|
for (i = qcom->num_clocks - 1; i >= 0; i--)
|
||||||
clk_disable_unprepare(qcom->clks[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;
|
qcom->is_suspended = true;
|
||||||
dwc3_qcom_enable_interrupts(qcom);
|
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 */
|
/* Clear existing events from PHY related to L2 in/out */
|
||||||
dwc3_qcom_setbits(qcom->qscratch_base, PWR_EVNT_IRQ_STAT_REG,
|
dwc3_qcom_setbits(qcom->qscratch_base, PWR_EVNT_IRQ_STAT_REG,
|
||||||
PWR_EVNT_LPM_IN_L2_MASK | PWR_EVNT_LPM_OUT_L2_MASK);
|
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;
|
goto depopulate;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
ret = dwc3_qcom_interconnect_init(qcom);
|
||||||
|
if (ret)
|
||||||
|
goto depopulate;
|
||||||
|
|
||||||
qcom->mode = usb_get_dr_mode(&qcom->dwc3->dev);
|
qcom->mode = usb_get_dr_mode(&qcom->dwc3->dev);
|
||||||
|
|
||||||
/* enable vbus override for device mode */
|
/* 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 */
|
/* register extcon to override sw_vbus on Vbus change later */
|
||||||
ret = dwc3_qcom_register_extcon(qcom);
|
ret = dwc3_qcom_register_extcon(qcom);
|
||||||
if (ret)
|
if (ret)
|
||||||
goto depopulate;
|
goto interconnect_exit;
|
||||||
|
|
||||||
device_init_wakeup(&pdev->dev, 1);
|
device_init_wakeup(&pdev->dev, 1);
|
||||||
qcom->is_suspended = false;
|
qcom->is_suspended = false;
|
||||||
|
@ -657,6 +770,8 @@ static int dwc3_qcom_probe(struct platform_device *pdev)
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
|
interconnect_exit:
|
||||||
|
dwc3_qcom_interconnect_exit(qcom);
|
||||||
depopulate:
|
depopulate:
|
||||||
if (np)
|
if (np)
|
||||||
of_platform_depopulate(&pdev->dev);
|
of_platform_depopulate(&pdev->dev);
|
||||||
|
@ -687,6 +802,7 @@ static int dwc3_qcom_remove(struct platform_device *pdev)
|
||||||
}
|
}
|
||||||
qcom->num_clocks = 0;
|
qcom->num_clocks = 0;
|
||||||
|
|
||||||
|
dwc3_qcom_interconnect_exit(qcom);
|
||||||
reset_control_assert(qcom->resets);
|
reset_control_assert(qcom->resets);
|
||||||
|
|
||||||
pm_runtime_allow(dev);
|
pm_runtime_allow(dev);
|
||||||
|
|
Loading…
Reference in a new issue