This change introduces appropriate additional steps in reset sequence and
stop routine corresponding to hexagon v56 1.5.0 on mss for msm8996.

Signed-off-by: Avaneesh Kumar Dwivedi <akdwi...@codeaurora.org>
---
 .../devicetree/bindings/remoteproc/qcom,q6v5.txt   |   1 +
 drivers/remoteproc/qcom_q6v5_pil.c                 | 179 ++++++++++++++++++---
 2 files changed, 155 insertions(+), 25 deletions(-)

diff --git a/Documentation/devicetree/bindings/remoteproc/qcom,q6v5.txt 
b/Documentation/devicetree/bindings/remoteproc/qcom,q6v5.txt
index 674ebc6..06f51a6 100644
--- a/Documentation/devicetree/bindings/remoteproc/qcom,q6v5.txt
+++ b/Documentation/devicetree/bindings/remoteproc/qcom,q6v5.txt
@@ -10,6 +10,7 @@ on the Qualcomm Hexagon core.
                "qcom,q6v5-pil"
                "qcom,msm8916-mss-pil"
                "qcom,msm8974-mss-pil"
+               "qcom,msm8996-mss-pil"
 
 - reg:
        Usage: required
diff --git a/drivers/remoteproc/qcom_q6v5_pil.c 
b/drivers/remoteproc/qcom_q6v5_pil.c
index 1018b8f..fb04461 100644
--- a/drivers/remoteproc/qcom_q6v5_pil.c
+++ b/drivers/remoteproc/qcom_q6v5_pil.c
@@ -31,6 +31,7 @@
 #include <linux/soc/qcom/smem.h>
 #include <linux/soc/qcom/smem_state.h>
 #include <linux/of_device.h>
+#include <linux/iopoll.h>
 
 #include "remoteproc_internal.h"
 #include "qcom_mdt_loader.h"
@@ -65,6 +66,8 @@
 #define QDSP6SS_RESET_REG              0x014
 #define QDSP6SS_GFMUX_CTL_REG          0x020
 #define QDSP6SS_PWR_CTL_REG            0x030
+#define QDSP6SS_MEM_PWR_CTL            0x0B0
+#define QDSP6SS_STRAP_ACC              0x110
 
 /* AXI Halt Register Offsets */
 #define AXI_HALTREQ_REG                        0x0
@@ -93,6 +96,15 @@
 #define QDSS_BHS_ON                    BIT(21)
 #define QDSS_LDO_BYP                   BIT(22)
 
+/* QDSP6v56 parameters */
+#define QDSP6v56_LDO_BYP                BIT(25)
+#define QDSP6v56_BHS_ON                 BIT(24)
+#define QDSP6v56_CLAMP_WL               BIT(21)
+#define QDSP6v56_CLAMP_QMC_MEM          BIT(22)
+#define HALT_CHECK_MAX_LOOPS            200
+#define QDSP6SS_XO_CBCR                 0x0038
+#define QDSP6SS_ACC_OVERRIDE_VAL       0x20
+
 struct reg_info {
        struct regulator *reg;
        int uV;
@@ -111,6 +123,7 @@ struct rproc_hexagon_res {
        struct qcom_mss_reg_res active_supply[2];
        char **proxy_clk_string;
        char **active_clk_string;
+       int hexagon_ver;
 };
 
 struct q6v5 {
@@ -152,8 +165,14 @@ struct q6v5 {
        phys_addr_t mpss_reloc;
        void *mpss_region;
        size_t mpss_size;
+       int hexagon_ver;
 };
 
+enum {
+       MSS_MSM8916, /*hexagon on msm8916*/
+       MSS_MSM8974, /*hexagon on msm8974*/
+       MSS_MSM8996, /*hexagon on msm8996*/
+};
 
 static int q6v5_regulator_init(struct device *dev, struct reg_info *regs,
                                const struct qcom_mss_reg_res *reg_res)
@@ -341,35 +360,107 @@ static int q6v5_rmb_mba_wait(struct q6v5 *qproc, u32 
status, int ms)
 
 static int q6v5proc_reset(struct q6v5 *qproc)
 {
-       u32 val;
+       u64 val;
        int ret;
+       int i;
 
-       /* Assert resets, stop core */
-       val = readl(qproc->reg_base + QDSP6SS_RESET_REG);
-       val |= (Q6SS_CORE_ARES | Q6SS_BUS_ARES_ENABLE | Q6SS_STOP_CORE);
-       writel(val, qproc->reg_base + QDSP6SS_RESET_REG);
 
-       /* Enable power block headswitch, and wait for it to stabilize */
-       val = readl(qproc->reg_base + QDSP6SS_PWR_CTL_REG);
-       val |= QDSS_BHS_ON | QDSS_LDO_BYP;
-       writel(val, qproc->reg_base + QDSP6SS_PWR_CTL_REG);
-       udelay(1);
-
-       /*
-        * Turn on memories. L2 banks should be done individually
-        * to minimize inrush current.
-        */
-       val = readl(qproc->reg_base + QDSP6SS_PWR_CTL_REG);
-       val |= Q6SS_SLP_RET_N | Q6SS_L2TAG_SLP_NRET_N |
-               Q6SS_ETB_SLP_NRET_N | Q6SS_L2DATA_STBY_N;
-       writel(val, qproc->reg_base + QDSP6SS_PWR_CTL_REG);
-       val |= Q6SS_L2DATA_SLP_NRET_N_2;
-       writel(val, qproc->reg_base + QDSP6SS_PWR_CTL_REG);
-       val |= Q6SS_L2DATA_SLP_NRET_N_1;
-       writel(val, qproc->reg_base + QDSP6SS_PWR_CTL_REG);
-       val |= Q6SS_L2DATA_SLP_NRET_N_0;
-       writel(val, qproc->reg_base + QDSP6SS_PWR_CTL_REG);
+       if (qproc->hexagon_ver == 0x2) {
+               /* Override the ACC value if required */
+               writel(QDSP6SS_ACC_OVERRIDE_VAL,
+                       qproc->reg_base + QDSP6SS_STRAP_ACC);
+
+               /* Assert resets, stop core */
+               val = readl(qproc->reg_base + QDSP6SS_RESET_REG);
+               val |= (Q6SS_CORE_ARES | Q6SS_BUS_ARES_ENABLE | Q6SS_STOP_CORE);
+               writel(val, qproc->reg_base + QDSP6SS_RESET_REG);
 
+               /* BHS require xo cbcr to be enabled */
+               val = readl(qproc->reg_base + QDSP6SS_XO_CBCR);
+               val |= 0x1;
+               writel(val, qproc->reg_base + QDSP6SS_XO_CBCR);
+               ret = readl_poll_timeout(qproc->reg_base + QDSP6SS_XO_CBCR,
+                               val, !(val & BIT(31)), 1, HALT_CHECK_MAX_LOOPS);
+               if (ret) {
+                       dev_err(qproc->dev,
+                               "xo cbcr enabling timed out (rc:%d)\n", ret);
+                       return ret;
+               }
+               if ((val & BIT(31))) {
+                       dev_err(qproc->dev,
+                               "Failed to enable xo branch clock.\n");
+                       return -EINVAL;
+               }
+               /*
+                * Enable power block headswitch,
+                * and wait for it to stabilize
+                */
+               val = readl(qproc->reg_base + QDSP6SS_PWR_CTL_REG);
+               val |= QDSP6v56_BHS_ON;
+               writel(val, qproc->reg_base + QDSP6SS_PWR_CTL_REG);
+               val |= readl(qproc->reg_base + QDSP6SS_PWR_CTL_REG);
+               udelay(1);
+               /* Put LDO in bypass mode */
+               val |= QDSP6v56_LDO_BYP;
+               writel(val, qproc->reg_base + QDSP6SS_PWR_CTL_REG);
+               /*
+                * Deassert QDSP6 compiler memory clamp
+                */
+               val = readl(qproc->reg_base + QDSP6SS_PWR_CTL_REG);
+               val &= ~QDSP6v56_CLAMP_QMC_MEM;
+               writel_relaxed(val, qproc->reg_base + QDSP6SS_PWR_CTL_REG);
+
+               /* Deassert memory peripheral sleep and L2 memory standby */
+               val |= (Q6SS_L2DATA_STBY_N | Q6SS_SLP_RET_N);
+               writel(val, qproc->reg_base + QDSP6SS_PWR_CTL_REG);
+
+               /* Turn on L1, L2, ETB and JU memories 1 at a time */
+               val = readl(qproc->reg_base + QDSP6SS_MEM_PWR_CTL);
+               for (i = 19; i >= 0; i--) {
+                       val |= BIT(i);
+                       writel(val, qproc->reg_base +
+                                               QDSP6SS_MEM_PWR_CTL);
+                       /*
+                        * Wait for 1us for both memory peripheral and
+                        * data array to turn on.
+                        */
+                        val |= readl(qproc->reg_base + QDSP6SS_MEM_PWR_CTL);
+                       udelay(1);
+               }
+               /* Remove word line clamp */
+               val = readl(qproc->reg_base + QDSP6SS_PWR_CTL_REG);
+               val &= ~QDSP6v56_CLAMP_WL;
+               writel(val, qproc->reg_base + QDSP6SS_PWR_CTL_REG);
+       } else {
+               /* Assert resets, stop core */
+               val = readl(qproc->reg_base + QDSP6SS_RESET_REG);
+               val |= (Q6SS_CORE_ARES | Q6SS_BUS_ARES_ENABLE | Q6SS_STOP_CORE);
+               writel(val, qproc->reg_base + QDSP6SS_RESET_REG);
+               /*
+                * Enable power block headswitch,
+                * and wait for it to stabilize
+                */
+               val = readl(qproc->reg_base + QDSP6SS_PWR_CTL_REG);
+               val |= QDSS_BHS_ON | QDSS_LDO_BYP;
+               writel(val, qproc->reg_base + QDSP6SS_PWR_CTL_REG);
+               val |= readl(qproc->reg_base + QDSP6SS_PWR_CTL_REG);
+               udelay(1);
+
+               /*
+                * Turn on memories. L2 banks should be done individually
+                * to minimize inrush current.
+                */
+               val = readl(qproc->reg_base + QDSP6SS_PWR_CTL_REG);
+               val |= Q6SS_SLP_RET_N | Q6SS_L2TAG_SLP_NRET_N |
+                       Q6SS_ETB_SLP_NRET_N | Q6SS_L2DATA_STBY_N;
+               writel(val, qproc->reg_base + QDSP6SS_PWR_CTL_REG);
+               val |= Q6SS_L2DATA_SLP_NRET_N_2;
+               writel(val, qproc->reg_base + QDSP6SS_PWR_CTL_REG);
+               val |= Q6SS_L2DATA_SLP_NRET_N_1;
+               writel(val, qproc->reg_base + QDSP6SS_PWR_CTL_REG);
+               val |= Q6SS_L2DATA_SLP_NRET_N_0;
+               writel(val, qproc->reg_base + QDSP6SS_PWR_CTL_REG);
+       }
        /* Remove IO clamp */
        val &= ~Q6SS_CLAMP_IO;
        writel(val, qproc->reg_base + QDSP6SS_PWR_CTL_REG);
@@ -664,6 +755,7 @@ static int q6v5_stop(struct rproc *rproc)
 {
        struct q6v5 *qproc = (struct q6v5 *)rproc->priv;
        int ret;
+       int val;
 
        qproc->running = false;
 
@@ -681,6 +773,15 @@ static int q6v5_stop(struct rproc *rproc)
        q6v5proc_halt_axi_port(qproc, qproc->halt_map, qproc->halt_modem);
        q6v5proc_halt_axi_port(qproc, qproc->halt_map, qproc->halt_nc);
 
+       if (qproc->hexagon_ver == 0x2) {
+               /*
+                * To avoid high MX current during LPASS/MSS restart.
+                */
+               val = readl_relaxed(qproc->reg_base + QDSP6SS_PWR_CTL_REG);
+               val |= Q6SS_CLAMP_IO | QDSP6v56_CLAMP_WL |
+                       QDSP6v56_CLAMP_QMC_MEM;
+               writel_relaxed(val,     qproc->reg_base + QDSP6SS_PWR_CTL_REG);
+       }
        reset_control_assert(qproc->mss_restart);
        q6v5_clk_disable(qproc->dev, qproc->active_clks,
                                qproc->active_clk_count);
@@ -987,6 +1088,7 @@ static int q6v5_probe(struct platform_device *pdev)
        if (ret)
                goto free_rproc;
 
+       qproc->hexagon_ver = desc->hexagon_ver;
        ret = q6v5_request_irq(qproc, pdev, "wdog", q6v5_wdog_interrupt);
        if (ret < 0)
                goto free_rproc;
@@ -1031,6 +1133,29 @@ static int q6v5_remove(struct platform_device *pdev)
        return 0;
 }
 
+static const struct rproc_hexagon_res msm8996_mss = {
+       .hexagon_mba_image = "mba.mbn",
+       .proxy_supply = (struct qcom_mss_reg_res[]) {
+               {
+                       .supply = "mx",
+               },
+               {
+                       .supply = "cx",
+                       .uA = 100000,
+               },
+               {
+                       .supply = "pll",
+                       .uA = 100000,
+               },
+               { NULL }
+       },
+       .active_supply = (struct qcom_mss_reg_res[]) { { NULL }, { NULL } },
+       .proxy_clk_string = (char*[]){"xo", "pnoc", "qdss", NULL},
+       .active_clk_string = (char*[]){"iface", "bus", "mem",
+               "gpll0_mss_clk", "snoc_axi_clk", "mnoc_axi_clk", NULL},
+       .hexagon_ver = MSS_MSM8996,
+};
+
 static const struct rproc_hexagon_res msm8916_mss = {
        .hexagon_mba_image = "mba.mbn",
        .proxy_supply = (struct qcom_mss_reg_res[]) {
@@ -1058,6 +1183,7 @@ static int q6v5_remove(struct platform_device *pdev)
        },
        .proxy_clk_string = (char*[]){"xo", NULL},
        .active_clk_string = (char*[]){"iface", "bus", "mem", NULL},
+       .hexagon_ver = MSS_MSM8916,
 };
 
 static const struct rproc_hexagon_res msm8974_mss = {
@@ -1087,11 +1213,14 @@ static int q6v5_remove(struct platform_device *pdev)
        },
        .proxy_clk_string = (char*[]){"xo", NULL},
        .active_clk_string = (char*[]){"iface", "bus", "mem", NULL},
+       .hexagon_ver = MSS_MSM8974,
 };
+
 static const struct of_device_id q6v5_of_match[] = {
        { .compatible = "qcom,q6v5-pil", .data = &msm8916_mss},
        { .compatible = "qcom,msm8916-mss-pil", .data = &msm8916_mss},
        { .compatible = "qcom,msm8974-mss-pil", .data = &msm8974_mss},
+       { .compatible = "qcom,msm8996-mss-pil", .data = &msm8996_mss},
        { },
 };
 
-- 
Qualcomm India Private Limited, on behalf of Qualcomm Innovation Center, Inc. 
is a member of the Code Aurora Forum,
a Linux Foundation Collaborative Project.

Reply via email to