interconnect: icc-rpm: add support for QoS reg offset

SDM660 driver expects to have QoS registers at the beginning of NoC
address space (sdm660 platform shifts NoC base address). Add support for
using QoS register offset, so that other platforms do not have to change
existing device trees.

Signed-off-by: Dmitry Baryshkov <dmitry.baryshkov@linaro.org>
Reviewed-by: AngeloGioacchino Del Regno <angelogioacchino.delregno@somainline.org>
Tested-by: Shawn Guo <shawn.guo@linaro.org>
Link: https://lore.kernel.org/r/20210903232421.1384199-6-dmitry.baryshkov@linaro.org
Signed-off-by: Georgi Djakov <djakov@kernel.org>

diff --git a/drivers/interconnect/qcom/icc-rpm.c b/drivers/interconnect/qcom/icc-rpm.c
index 96a160edece9e7b8b854088250e0042a0d424c6c..ef7999a08c8bf2a18437dd8829c0d929bee7b05e 100644 (file)
--- a/drivers/interconnect/qcom/icc-rpm.c
+++ b/drivers/interconnect/qcom/icc-rpm.c
@@ -39,7 +39,7 @@
 #define NOC_QOS_MODEn_ADDR(n)          (0xc + (n * 0x1000))
 #define NOC_QOS_MODEn_MASK             0x3
 
-static int qcom_icc_bimc_set_qos_health(struct regmap *rmap,
+static int qcom_icc_bimc_set_qos_health(struct qcom_icc_provider *qp,
                                        struct qcom_icc_qos *qos,
                                        int regnum)
 {
@@ -58,8 +58,8 @@ static int qcom_icc_bimc_set_qos_health(struct regmap *rmap,
                mask |= M_BKE_HEALTH_CFG_LIMITCMDS_MASK;
        }
 
-       return regmap_update_bits(rmap,
-                                 M_BKE_HEALTH_CFG_ADDR(regnum, qos->qos_port),
+       return regmap_update_bits(qp->regmap,
+                                 qp->qos_offset + M_BKE_HEALTH_CFG_ADDR(regnum, qos->qos_port),
                                  mask, val);
 }
 
@@ -84,7 +84,7 @@ static int qcom_icc_set_bimc_qos(struct icc_node *src, u64 max_bw)
         */
        if (mode != NOC_QOS_MODE_BYPASS) {
                for (i = 3; i >= 0; i--) {
-                       rc = qcom_icc_bimc_set_qos_health(qp->regmap,
+                       rc = qcom_icc_bimc_set_qos_health(qp,
                                                          &qn->qos, i);
                        if (rc)
                                return rc;
@@ -94,11 +94,12 @@ static int qcom_icc_set_bimc_qos(struct icc_node *src, u64 max_bw)
                val = 1;
        }
 
-       return regmap_update_bits(qp->regmap, M_BKE_EN_ADDR(qn->qos.qos_port),
+       return regmap_update_bits(qp->regmap,
+                                 qp->qos_offset + M_BKE_EN_ADDR(qn->qos.qos_port),
                                  M_BKE_EN_EN_BMASK, val);
 }
 
-static int qcom_icc_noc_set_qos_priority(struct regmap *rmap,
+static int qcom_icc_noc_set_qos_priority(struct qcom_icc_provider *qp,
                                         struct qcom_icc_qos *qos)
 {
        u32 val;
@@ -106,12 +107,14 @@ static int qcom_icc_noc_set_qos_priority(struct regmap *rmap,
 
        /* Must be updated one at a time, P1 first, P0 last */
        val = qos->areq_prio << NOC_QOS_PRIORITY_P1_SHIFT;
-       rc = regmap_update_bits(rmap, NOC_QOS_PRIORITYn_ADDR(qos->qos_port),
+       rc = regmap_update_bits(qp->regmap,
+                               qp->qos_offset + NOC_QOS_PRIORITYn_ADDR(qos->qos_port),
                                NOC_QOS_PRIORITY_P1_MASK, val);
        if (rc)
                return rc;
 
-       return regmap_update_bits(rmap, NOC_QOS_PRIORITYn_ADDR(qos->qos_port),
+       return regmap_update_bits(qp->regmap,
+                                 qp->qos_offset + NOC_QOS_PRIORITYn_ADDR(qos->qos_port),
                                  NOC_QOS_PRIORITY_P0_MASK, qos->prio_level);
 }
 
@@ -140,7 +143,7 @@ static int qcom_icc_set_noc_qos(struct icc_node *src, u64 max_bw)
        if (mode == NOC_QOS_MODE_FIXED) {
                dev_dbg(src->provider->dev, "NoC QoS: %s: Set Fixed mode\n",
                        qn->name);
-               rc = qcom_icc_noc_set_qos_priority(qp->regmap, &qn->qos);
+               rc = qcom_icc_noc_set_qos_priority(qp, &qn->qos);
                if (rc)
                        return rc;
        } else if (mode == NOC_QOS_MODE_BYPASS) {
@@ -149,7 +152,7 @@ static int qcom_icc_set_noc_qos(struct icc_node *src, u64 max_bw)
        }
 
        return regmap_update_bits(qp->regmap,
-                                 NOC_QOS_MODEn_ADDR(qn->qos.qos_port),
+                                 qp->qos_offset + NOC_QOS_MODEn_ADDR(qn->qos.qos_port),
                                  NOC_QOS_MODEn_MASK, mode);
 }
 
@@ -305,6 +308,7 @@ int qnoc_probe(struct platform_device *pdev)
        qp->num_clks = cd_num;
 
        qp->is_bimc_node = desc->is_bimc_node;
+       qp->qos_offset = desc->qos_offset;
 
        if (desc->regmap_cfg) {
                struct resource *res;

diff --git a/drivers/interconnect/qcom/icc-rpm.h b/drivers/interconnect/qcom/icc-rpm.h
index 25d11c6a73d739db828b5aa4531d21fa659a3c70..0824ee34d81686f60655ab5def737b1f53257e01 100644 (file)
--- a/drivers/interconnect/qcom/icc-rpm.h
+++ b/drivers/interconnect/qcom/icc-rpm.h
@@ -18,6 +18,7 @@
  * @bus_clks: the clk_bulk_data table of bus clocks
  * @num_clks: the total number of clk_bulk_data entries
  * @is_bimc_node: indicates whether to use bimc specific setting
+ * @qos_offset: offset to QoS registers
  * @regmap: regmap for QoS registers read/write access
  */
 struct qcom_icc_provider {
@@ -25,6 +26,7 @@ struct qcom_icc_provider {
        int num_clks;
        bool is_bimc_node;
        struct regmap *regmap;
+       unsigned int qos_offset;
        struct clk_bulk_data bus_clks[];
 };
 
@@ -77,6 +79,7 @@ struct qcom_icc_desc {
        size_t num_clocks;
        bool is_bimc_node;
        const struct regmap_config *regmap_cfg;
+       unsigned int qos_offset;
 };
 
 #define DEFINE_QNODE(_name, _id, _buswidth, _mas_rpm_id, _slv_rpm_id,  \