In lockstep mode, r5 core0 uses TCM of R5 core1. Following is lockstep
mode memory region as per hardware reference manual.

    |      *TCM*         |   *R5 View* | *Linux view* |
    | R5_0 ATCM (128 KB) | 0x0000_0000 | 0xFFE0_0000  |
    | R5_0 BTCM (128 KB) | 0x0002_0000 | 0xFFE2_0000  |

However, driver shouldn't model it as above because R5 core0 TCM and core1
TCM has different power-domains mapped to it.
Hence, TCM address space in lockstep mode should be modeled as 64KB
regions only where each region has its own power-domain as following:

    |      *TCM*         |   *R5 View* | *Linux view* |
    | R5_0 ATCM0 (64 KB) | 0x0000_0000 | 0xFFE0_0000  |
    | R5_0 BTCM0 (64 KB) | 0x0002_0000 | 0xFFE2_0000  |
    | R5_0 ATCM1 (64 KB) | 0x0001_0000 | 0xFFE1_0000  |
    | R5_0 BTCM1 (64 KB) | 0x0003_0000 | 0xFFE3_0000  |

This makes driver maintanance easy and makes design robust for future
platorms as well.

Signed-off-by: Tanmay Shah <tanmay.s...@amd.com>
---
 drivers/remoteproc/xlnx_r5_remoteproc.c | 146 ++----------------------
 1 file changed, 12 insertions(+), 134 deletions(-)

diff --git a/drivers/remoteproc/xlnx_r5_remoteproc.c 
b/drivers/remoteproc/xlnx_r5_remoteproc.c
index cfbd97b89c26..0f942440b4e2 100644
--- a/drivers/remoteproc/xlnx_r5_remoteproc.c
+++ b/drivers/remoteproc/xlnx_r5_remoteproc.c
@@ -84,12 +84,12 @@ static const struct mem_bank_data zynqmp_tcm_banks_split[] 
= {
        {0xffeb0000UL, 0x20000, 0x10000UL, PD_R5_1_BTCM, "btcm1"},
 };
 
-/* In lockstep mode cluster combines each 64KB TCM and makes 128KB TCM */
+/* In lockstep mode cluster uses each 64KB TCM from second core as well */
 static const struct mem_bank_data zynqmp_tcm_banks_lockstep[] = {
-       {0xffe00000UL, 0x0, 0x20000UL, PD_R5_0_ATCM, "atcm0"}, /* TCM 128KB 
each */
-       {0xffe20000UL, 0x20000, 0x20000UL, PD_R5_0_BTCM, "btcm0"},
-       {0, 0, 0, PD_R5_1_ATCM, ""},
-       {0, 0, 0, PD_R5_1_BTCM, ""},
+       {0xffe00000UL, 0x0, 0x10000UL, PD_R5_0_ATCM, "atcm0"}, /* TCM 64KB each 
*/
+       {0xffe20000UL, 0x20000, 0x10000UL, PD_R5_0_BTCM, "btcm0"},
+       {0xffe10000UL, 0x10000, 0x10000UL, PD_R5_1_ATCM, "atcm1"},
+       {0xffe30000UL, 0x30000, 0x10000UL, PD_R5_1_BTCM, "btcm1"},
 };
 
 /**
@@ -541,14 +541,14 @@ static int tcm_mem_map(struct rproc *rproc,
 }
 
 /*
- * add_tcm_carveout_split_mode()
+ * add_tcm_banks()
  * @rproc: single R5 core's corresponding rproc instance
  *
- * allocate and add remoteproc carveout for TCM memory in split mode
+ * allocate and add remoteproc carveout for TCM memory
  *
  * return 0 on success, otherwise non-zero value on failure
  */
-static int add_tcm_carveout_split_mode(struct rproc *rproc)
+static int add_tcm_banks(struct rproc *rproc)
 {
        struct rproc_mem_entry *rproc_mem;
        struct zynqmp_r5_core *r5_core;
@@ -581,10 +581,10 @@ static int add_tcm_carveout_split_mode(struct rproc 
*rproc)
                                             ZYNQMP_PM_REQUEST_ACK_BLOCKING);
                if (ret < 0) {
                        dev_err(dev, "failed to turn on TCM 0x%x", 
pm_domain_id);
-                       goto release_tcm_split;
+                       goto release_tcm;
                }
 
-               dev_dbg(dev, "TCM carveout split mode %s addr=%llx, da=0x%x, 
size=0x%lx",
+               dev_dbg(dev, "TCM carveout %s addr=%llx, da=0x%x, size=0x%lx",
                        bank_name, bank_addr, da, bank_size);
 
                rproc_mem = rproc_mem_entry_init(dev, NULL, bank_addr,
@@ -594,99 +594,16 @@ static int add_tcm_carveout_split_mode(struct rproc 
*rproc)
                if (!rproc_mem) {
                        ret = -ENOMEM;
                        zynqmp_pm_release_node(pm_domain_id);
-                       goto release_tcm_split;
-               }
-
-               rproc_add_carveout(rproc, rproc_mem);
-               rproc_coredump_add_segment(rproc, da, bank_size);
-       }
-
-       return 0;
-
-release_tcm_split:
-       /* If failed, Turn off all TCM banks turned on before */
-       for (i--; i >= 0; i--) {
-               pm_domain_id = r5_core->tcm_banks[i]->pm_domain_id;
-               zynqmp_pm_release_node(pm_domain_id);
-       }
-       return ret;
-}
-
-/*
- * add_tcm_carveout_lockstep_mode()
- * @rproc: single R5 core's corresponding rproc instance
- *
- * allocate and add remoteproc carveout for TCM memory in lockstep mode
- *
- * return 0 on success, otherwise non-zero value on failure
- */
-static int add_tcm_carveout_lockstep_mode(struct rproc *rproc)
-{
-       struct rproc_mem_entry *rproc_mem;
-       struct zynqmp_r5_core *r5_core;
-       int i, num_banks, ret;
-       phys_addr_t bank_addr;
-       size_t bank_size = 0;
-       struct device *dev;
-       u32 pm_domain_id;
-       char *bank_name;
-       u32 da;
-
-       r5_core = rproc->priv;
-       dev = r5_core->dev;
-
-       /* Go through zynqmp banks for r5 node */
-       num_banks = r5_core->tcm_bank_count;
-
-       /*
-        * In lockstep mode, TCM is contiguous memory block
-        * However, each TCM block still needs to be enabled individually.
-        * So, Enable each TCM block individually.
-        * Although ATCM and BTCM is contiguous memory block, add two separate
-        * carveouts for both.
-        */
-       for (i = 0; i < num_banks; i++) {
-               pm_domain_id = r5_core->tcm_banks[i]->pm_domain_id;
-
-               /* Turn on each TCM bank individually */
-               ret = zynqmp_pm_request_node(pm_domain_id,
-                                            ZYNQMP_PM_CAPABILITY_ACCESS, 0,
-                                            ZYNQMP_PM_REQUEST_ACK_BLOCKING);
-               if (ret < 0) {
-                       dev_err(dev, "failed to turn on TCM 0x%x", 
pm_domain_id);
-                       goto release_tcm_lockstep;
-               }
-
-               bank_size = r5_core->tcm_banks[i]->size;
-               if (bank_size == 0)
-                       continue;
-
-               bank_addr = r5_core->tcm_banks[i]->addr;
-               da = r5_core->tcm_banks[i]->da;
-               bank_name = r5_core->tcm_banks[i]->bank_name;
-
-               /* Register TCM address range, TCM map and unmap functions */
-               rproc_mem = rproc_mem_entry_init(dev, NULL, bank_addr,
-                                                bank_size, da,
-                                                tcm_mem_map, tcm_mem_unmap,
-                                                bank_name);
-               if (!rproc_mem) {
-                       ret = -ENOMEM;
-                       zynqmp_pm_release_node(pm_domain_id);
-                       goto release_tcm_lockstep;
+                       goto release_tcm;
                }
 
-               /* If registration is success, add carveouts */
                rproc_add_carveout(rproc, rproc_mem);
                rproc_coredump_add_segment(rproc, da, bank_size);
-
-               dev_dbg(dev, "TCM carveout lockstep mode %s addr=0x%llx, 
da=0x%x, size=0x%lx",
-                       bank_name, bank_addr, da, bank_size);
        }
 
        return 0;
 
-release_tcm_lockstep:
+release_tcm:
        /* If failed, Turn off all TCM banks turned on before */
        for (i--; i >= 0; i--) {
                pm_domain_id = r5_core->tcm_banks[i]->pm_domain_id;
@@ -695,45 +612,6 @@ static int add_tcm_carveout_lockstep_mode(struct rproc 
*rproc)
        return ret;
 }
 
-/*
- * add_tcm_banks()
- * @rproc: single R5 core's corresponding rproc instance
- *
- * allocate and add remoteproc carveouts for TCM memory based on cluster mode
- *
- * return 0 on success, otherwise non-zero value on failure
- */
-static int add_tcm_banks(struct rproc *rproc)
-{
-       struct zynqmp_r5_cluster *cluster;
-       struct zynqmp_r5_core *r5_core;
-       struct device *dev;
-
-       r5_core = rproc->priv;
-       if (!r5_core)
-               return -EINVAL;
-
-       dev = r5_core->dev;
-
-       cluster = dev_get_drvdata(dev->parent);
-       if (!cluster) {
-               dev_err(dev->parent, "Invalid driver data\n");
-               return -EINVAL;
-       }
-
-       /*
-        * In lockstep mode TCM banks are one contiguous memory region of 256Kb
-        * In split mode, each TCM bank is 64Kb and not contiguous.
-        * We add memory carveouts accordingly.
-        */
-       if (cluster->mode == SPLIT_MODE)
-               return add_tcm_carveout_split_mode(rproc);
-       else if (cluster->mode == LOCKSTEP_MODE)
-               return add_tcm_carveout_lockstep_mode(rproc);
-
-       return -EINVAL;
-}
-
 /*
  * zynqmp_r5_parse_fw()
  * @rproc: single R5 core's corresponding rproc instance
-- 
2.25.1


Reply via email to