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>

diff --git a/drivers/usb/dwc3/dwc3-qcom.c b/drivers/usb/dwc3/dwc3-qcom.c
index e1e78e9..fcf7f79 100644 (file)
--- a/drivers/usb/dwc3/dwc3-qcom.c
+++ b/drivers/usb/dwc3/dwc3-qcom.c
@@ -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);