[<prev] [next>] [<thread-prev] [thread-next>] [day] [month] [year] [list]
Message-Id: <20200424202505.29562-11-mathieu.poirier@linaro.org>
Date: Fri, 24 Apr 2020 14:25:03 -0600
From: Mathieu Poirier <mathieu.poirier@...aro.org>
To: bjorn.andersson@...aro.org, ohad@...ery.com,
mcoquelin.stm32@...il.com, alexandre.torgue@...com
Cc: loic.pallardy@...com, arnaud.pouliquen@...com,
linux-remoteproc@...r.kernel.org,
linux-stm32@...md-mailman.stormreply.com,
linux-arm-kernel@...ts.infradead.org, linux-kernel@...r.kernel.org
Subject: [PATCH v2 10/12] remoteproc: stm32: Introduce new parse fw ops for synchronisation
Introduce new parse firmware rproc_ops functions to be used when
synchonising with an MCU.
Mainly based on the work published by Arnaud Pouliquen [1].
[1]. https://patchwork.kernel.org/project/linux-remoteproc/list/?series=239877
Signed-off-by: Mathieu Poirier <mathieu.poirier@...aro.org>
Reviewed-by: Loic Pallardy <loic.pallardy@...com>
---
drivers/remoteproc/stm32_rproc.c | 51 +++++++++++++++++++++++++++++++-
1 file changed, 50 insertions(+), 1 deletion(-)
diff --git a/drivers/remoteproc/stm32_rproc.c b/drivers/remoteproc/stm32_rproc.c
index 86d23c35d805..b8ae8aed5585 100644
--- a/drivers/remoteproc/stm32_rproc.c
+++ b/drivers/remoteproc/stm32_rproc.c
@@ -215,7 +215,34 @@ static int stm32_rproc_elf_load_rsc_table(struct rproc *rproc,
return 0;
}
-static int stm32_rproc_parse_fw(struct rproc *rproc, const struct firmware *fw)
+static int stm32_rproc_sync_elf_load_rsc_table(struct rproc *rproc,
+ const struct firmware *fw)
+{
+ struct resource_table *table = NULL;
+ struct stm32_rproc *ddata = rproc->priv;
+
+ if (ddata->rsc_va) {
+ table = (struct resource_table *)ddata->rsc_va;
+ /* Assuming that the resource table fits in 1kB is fair */
+ rproc->cached_table = kmemdup(table, RSC_TBL_SIZE, GFP_KERNEL);
+ if (!rproc->cached_table)
+ return -ENOMEM;
+
+ rproc->table_ptr = rproc->cached_table;
+ rproc->table_sz = RSC_TBL_SIZE;
+ return 0;
+ }
+
+ rproc->cached_table = NULL;
+ rproc->table_ptr = NULL;
+ rproc->table_sz = 0;
+
+ dev_warn(&rproc->dev, "no resource table found for this firmware\n");
+ return 0;
+}
+
+static int stm32_rproc_parse_memory_regions(struct rproc *rproc,
+ const struct firmware *fw)
{
struct device *dev = rproc->dev.parent;
struct device_node *np = dev->of_node;
@@ -268,9 +295,30 @@ static int stm32_rproc_parse_fw(struct rproc *rproc, const struct firmware *fw)
index++;
}
+ return 0;
+}
+
+static int stm32_rproc_parse_fw(struct rproc *rproc, const struct firmware *fw)
+{
+ int ret = stm32_rproc_parse_memory_regions(rproc, fw);
+
+ if (ret)
+ return ret;
+
return stm32_rproc_elf_load_rsc_table(rproc, fw);
}
+static int stm32_rproc_sync_parse_fw(struct rproc *rproc,
+ const struct firmware *fw)
+{
+ int ret = stm32_rproc_parse_memory_regions(rproc, fw);
+
+ if (ret)
+ return ret;
+
+ return stm32_rproc_sync_elf_load_rsc_table(rproc, fw);
+}
+
static irqreturn_t stm32_rproc_wdg(int irq, void *data)
{
struct platform_device *pdev = data;
@@ -544,6 +592,7 @@ static struct rproc_ops st_rproc_ops = {
static __maybe_unused struct rproc_ops st_rproc_sync_ops = {
.start = stm32_rproc_sync_start,
.stop = stm32_rproc_stop,
+ .parse_fw = stm32_rproc_sync_parse_fw,
};
static const struct of_device_id stm32_rproc_match[] = {
--
2.20.1
Powered by blists - more mailing lists