mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
synced 2025-01-16 18:08:20 +00:00
remoteproc: zynqmp: fix lockstep mode memory region
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.shah@amd.com> Link: https://lore.kernel.org/r/20240412183708.4036007-2-tanmay.shah@amd.com Signed-off-by: Mathieu Poirier <mathieu.poirier@linaro.org>
This commit is contained in:
parent
fec2601f20
commit
b31bcda55f
@ -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,7 +594,7 @@ 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;
|
||||
goto release_tcm;
|
||||
}
|
||||
|
||||
rproc_add_carveout(rproc, rproc_mem);
|
||||
@ -603,7 +603,7 @@ static int add_tcm_carveout_split_mode(struct rproc *rproc)
|
||||
|
||||
return 0;
|
||||
|
||||
release_tcm_split:
|
||||
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;
|
||||
@ -612,128 +612,6 @@ release_tcm_split:
|
||||
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;
|
||||
}
|
||||
|
||||
/* 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:
|
||||
/* 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_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
|
||||
|
Loading…
x
Reference in New Issue
Block a user