From patchwork Mon Apr 6 11:33:08 2020 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Nikita Shubin X-Patchwork-Id: 11475297 Return-Path: Received: from mail.kernel.org (pdx-korg-mail-1.web.codeaurora.org [172.30.200.123]) by pdx-korg-patchwork-2.web.codeaurora.org (Postfix) with ESMTP id 61F2F112C for ; Mon, 6 Apr 2020 11:32:14 +0000 (UTC) Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by mail.kernel.org (Postfix) with ESMTP id 408BA2072A for ; Mon, 6 Apr 2020 11:32:14 +0000 (UTC) Authentication-Results: mail.kernel.org; dkim=pass (1024-bit key) header.d=maquefel.me header.i=@maquefel.me header.b="qWUrR2VS" Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1727181AbgDFLcN (ORCPT ); Mon, 6 Apr 2020 07:32:13 -0400 Received: from forward103p.mail.yandex.net ([77.88.28.106]:42809 "EHLO forward103p.mail.yandex.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1726858AbgDFLcN (ORCPT ); Mon, 6 Apr 2020 07:32:13 -0400 Received: from mxback8g.mail.yandex.net (mxback8g.mail.yandex.net [IPv6:2a02:6b8:0:1472:2741:0:8b7:169]) by forward103p.mail.yandex.net (Yandex) with ESMTP id 76EF718C041F; Mon, 6 Apr 2020 14:32:10 +0300 (MSK) Received: from iva6-add863d6e49c.qloud-c.yandex.net (iva6-add863d6e49c.qloud-c.yandex.net [2a02:6b8:c0c:7ea0:0:640:add8:63d6]) by mxback8g.mail.yandex.net (mxback/Yandex) with ESMTP id N5wck4Svr5-WA8eClK8; Mon, 06 Apr 2020 14:32:10 +0300 DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=maquefel.me; s=mail; t=1586172730; bh=gn4X4dwb/lGc1aff1jWlSmhgRv7I3Jq+82nqfbVnrDA=; h=In-Reply-To:Subject:To:From:Cc:References:Date:Message-Id; b=qWUrR2VSCnrWGTRWQGPGQAw6W6+Aq9M0i/MerQPIsUY5nyH33Sdp+3qw7WGMpjxeU BYYs6faqIwlD/cdSBngdUpIMoluVQCgNF1NJC+aX/mJtY9wnan4VwMHxjuXVP7FCts KAHBOITctctnR3pSW3FH5BUq6moTJyxpWFGkjC7U= Authentication-Results: mxback8g.mail.yandex.net; dkim=pass header.i=@maquefel.me Received: by iva6-add863d6e49c.qloud-c.yandex.net (smtp/Yandex) with ESMTPSA id CHTIIrjdik-W92uoY3j; Mon, 06 Apr 2020 14:32:09 +0300 (using TLSv1.3 with cipher TLS_AES_256_GCM_SHA384 (256/256 bits)) (Client certificate not present) From: nikita.shubin@maquefel.me To: nikita.shubin@maquefel.me Cc: Nikita Shubin , Ohad Ben-Cohen , Bjorn Andersson , Shawn Guo , Sascha Hauer , Pengutronix Kernel Team , Fabio Estevam , NXP Linux Team , linux-remoteproc@vger.kernel.org, linux-arm-kernel@lists.infradead.org, linux-kernel@vger.kernel.org Subject: [PATCH v2 1/3] remoteproc: imx_rproc: set pc on start Date: Mon, 6 Apr 2020 14:33:08 +0300 Message-Id: <20200406113310.3041-2-nikita.shubin@maquefel.me> X-Mailer: git-send-email 2.25.1 In-Reply-To: <20200406113310.3041-1-nikita.shubin@maquefel.me> References: <20200304142628.8471-1-NShubin@topcon.com> <20200406113310.3041-1-nikita.shubin@maquefel.me> MIME-Version: 1.0 Sender: linux-remoteproc-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-remoteproc@vger.kernel.org In case elf file interrupt vector is not supposed to be at OCRAM_S, it is needed to write elf entry point to OCRAM_S + 0x4, to boot M4 firmware. Otherwise firmware located anywhere besides OCRAM_S won't boot. The firmware must set stack poiner as first instruction: Reset_Handler: ldr sp, = __stack /* set stack pointer */ Signed-off-by: Nikita Shubin --- drivers/remoteproc/imx_rproc.c | 16 +++++++++++++++- 1 file changed, 15 insertions(+), 1 deletion(-) diff --git a/drivers/remoteproc/imx_rproc.c b/drivers/remoteproc/imx_rproc.c index 3e72b6f38d4b..bebc58d0f711 100644 --- a/drivers/remoteproc/imx_rproc.c +++ b/drivers/remoteproc/imx_rproc.c @@ -45,6 +45,8 @@ #define IMX7D_RPROC_MEM_MAX 8 +#define IMX_BOOT_PC 0x4 + /** * struct imx_rproc_mem - slim internal memory structure * @cpu_addr: MPU virtual address of the memory region @@ -85,6 +87,7 @@ struct imx_rproc { const struct imx_rproc_dcfg *dcfg; struct imx_rproc_mem mem[IMX7D_RPROC_MEM_MAX]; struct clk *clk; + void __iomem *bootreg; }; static const struct imx_rproc_att imx_rproc_att_imx7d[] = { @@ -162,11 +165,16 @@ static int imx_rproc_start(struct rproc *rproc) struct device *dev = priv->dev; int ret; + /* write entry point to program counter */ + writel(rproc->bootaddr, priv->bootreg); + ret = regmap_update_bits(priv->regmap, dcfg->src_reg, dcfg->src_mask, dcfg->src_start); if (ret) dev_err(dev, "Failed to enable M4!\n"); + dev_info(&rproc->dev, "Started from 0x%x\n", rproc->bootaddr); + return ret; } @@ -182,6 +190,9 @@ static int imx_rproc_stop(struct rproc *rproc) if (ret) dev_err(dev, "Failed to stop M4!\n"); + /* clear entry points */ + writel(0, priv->bootreg); + return ret; } @@ -243,7 +254,8 @@ static void *imx_rproc_da_to_va(struct rproc *rproc, u64 da, int len) static const struct rproc_ops imx_rproc_ops = { .start = imx_rproc_start, .stop = imx_rproc_stop, - .da_to_va = imx_rproc_da_to_va, + .da_to_va = imx_rproc_da_to_va, + .get_boot_addr = rproc_elf_get_boot_addr, }; static int imx_rproc_addr_init(struct imx_rproc *priv, @@ -360,6 +372,8 @@ static int imx_rproc_probe(struct platform_device *pdev) goto err_put_rproc; } + priv->bootreg = imx_rproc_da_to_va(rproc, IMX_BOOT_PC, sizeof(u32)); + /* * clk for M4 block including memory. Should be * enabled before .start for FW transfer. From patchwork Mon Apr 6 11:33:09 2020 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Nikita Shubin X-Patchwork-Id: 11475299 Return-Path: Received: from mail.kernel.org (pdx-korg-mail-1.web.codeaurora.org [172.30.200.123]) by pdx-korg-patchwork-2.web.codeaurora.org (Postfix) with ESMTP id 889BC1392 for ; Mon, 6 Apr 2020 11:32:19 +0000 (UTC) Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by mail.kernel.org (Postfix) with ESMTP id 5DF7E206C3 for ; Mon, 6 Apr 2020 11:32:19 +0000 (UTC) Authentication-Results: mail.kernel.org; dkim=pass (1024-bit key) header.d=maquefel.me header.i=@maquefel.me header.b="KpnFHusq" Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1727181AbgDFLcT (ORCPT ); Mon, 6 Apr 2020 07:32:19 -0400 Received: from forward103j.mail.yandex.net ([5.45.198.246]:39608 "EHLO forward103j.mail.yandex.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1726858AbgDFLcS (ORCPT ); Mon, 6 Apr 2020 07:32:18 -0400 Received: from mxback27o.mail.yandex.net (mxback27o.mail.yandex.net [IPv6:2a02:6b8:0:1a2d::78]) by forward103j.mail.yandex.net (Yandex) with ESMTP id 1047E67409B6; Mon, 6 Apr 2020 14:32:14 +0300 (MSK) Received: from iva6-add863d6e49c.qloud-c.yandex.net (iva6-add863d6e49c.qloud-c.yandex.net [2a02:6b8:c0c:7ea0:0:640:add8:63d6]) by mxback27o.mail.yandex.net (mxback/Yandex) with ESMTP id D7Ch6kcz29-WDfWYrPo; Mon, 06 Apr 2020 14:32:14 +0300 DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=maquefel.me; s=mail; t=1586172734; bh=8uEW0zqccUGzY8Atll6dm+xMaA+rH6YNmty2LTtP4t0=; h=In-Reply-To:Subject:To:From:Cc:References:Date:Message-Id; b=KpnFHusqtimVXVvdAOK7ru7dkQ/hdhsjfdDLbbXWn2mQNKJIej9BWZS9a8hgG4AKI qMQqz//B181cIXDovpv3OxKl2XRQ9vTyTNF4zp6XOxoiRvQifCdlyeQZATMXHNEHBJ DTkFS0V11ZOrunF9WxwNf305IQHJmIik/aJ0rAnU= Authentication-Results: mxback27o.mail.yandex.net; dkim=pass header.i=@maquefel.me Received: by iva6-add863d6e49c.qloud-c.yandex.net (smtp/Yandex) with ESMTPSA id CHTIIrjdik-WC2ug4GN; Mon, 06 Apr 2020 14:32:12 +0300 (using TLSv1.3 with cipher TLS_AES_256_GCM_SHA384 (256/256 bits)) (Client certificate not present) From: nikita.shubin@maquefel.me To: nikita.shubin@maquefel.me Cc: Nikita Shubin , Ohad Ben-Cohen , Bjorn Andersson , Shawn Guo , Sascha Hauer , Pengutronix Kernel Team , Fabio Estevam , NXP Linux Team , linux-remoteproc@vger.kernel.org, linux-kernel@vger.kernel.org, linux-arm-kernel@lists.infradead.org Subject: [PATCH v2 2/3] remoteproc: imx_rproc: mailbox support Date: Mon, 6 Apr 2020 14:33:09 +0300 Message-Id: <20200406113310.3041-3-nikita.shubin@maquefel.me> X-Mailer: git-send-email 2.25.1 In-Reply-To: <20200406113310.3041-1-nikita.shubin@maquefel.me> References: <20200304142628.8471-1-NShubin@topcon.com> <20200406113310.3041-1-nikita.shubin@maquefel.me> MIME-Version: 1.0 Sender: linux-remoteproc-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-remoteproc@vger.kernel.org Add support for mailboxes to imx_rproc Signed-off-by: Nikita Shubin Reported-by: kbuild test robot --- drivers/remoteproc/Kconfig | 2 + drivers/remoteproc/imx_rproc.c | 142 ++++++++++++++++++++++++++++++++- 2 files changed, 143 insertions(+), 1 deletion(-) diff --git a/drivers/remoteproc/Kconfig b/drivers/remoteproc/Kconfig index 94afdde4bc9f..02d23a54c9cf 100644 --- a/drivers/remoteproc/Kconfig +++ b/drivers/remoteproc/Kconfig @@ -17,6 +17,8 @@ if REMOTEPROC config IMX_REMOTEPROC tristate "IMX6/7 remoteproc support" depends on ARCH_MXC + select MAILBOX + select IMX_MBOX help Say y here to support iMX's remote processors (Cortex M4 on iMX7D) via the remote processor framework. diff --git a/drivers/remoteproc/imx_rproc.c b/drivers/remoteproc/imx_rproc.c index bebc58d0f711..d2bede4ccb70 100644 --- a/drivers/remoteproc/imx_rproc.c +++ b/drivers/remoteproc/imx_rproc.c @@ -14,6 +14,9 @@ #include #include #include +#include + +#include "remoteproc_internal.h" #define IMX7D_SRC_SCR 0x0C #define IMX7D_ENABLE_M4 BIT(3) @@ -47,6 +50,12 @@ #define IMX_BOOT_PC 0x4 +#define IMX_MBOX_NB_VQ 2 +#define IMX_MBOX_NB_MBX 2 + +#define IMX_MBX_VQ0 "vq0" +#define IMX_MBX_VQ1 "vq1" + /** * struct imx_rproc_mem - slim internal memory structure * @cpu_addr: MPU virtual address of the memory region @@ -80,6 +89,14 @@ struct imx_rproc_dcfg { size_t att_size; }; +struct imx_mbox { + const unsigned char name[10]; + struct mbox_chan *chan; + struct mbox_client client; + struct work_struct vq_work; + int vq_id; +}; + struct imx_rproc { struct device *dev; struct regmap *regmap; @@ -88,6 +105,8 @@ struct imx_rproc { struct imx_rproc_mem mem[IMX7D_RPROC_MEM_MAX]; struct clk *clk; void __iomem *bootreg; + struct imx_mbox mb[IMX_MBOX_NB_MBX]; + struct workqueue_struct *workqueue; }; static const struct imx_rproc_att imx_rproc_att_imx7d[] = { @@ -251,10 +270,118 @@ static void *imx_rproc_da_to_va(struct rproc *rproc, u64 da, int len) return va; } +static void imx_rproc_mb_vq_work(struct work_struct *work) +{ + struct imx_mbox *mb = container_of(work, struct imx_mbox, vq_work); + struct rproc *rproc = dev_get_drvdata(mb->client.dev); + + if (rproc_vq_interrupt(rproc, mb->vq_id) == IRQ_NONE) + dev_dbg(&rproc->dev, "no message found in vq%d\n", mb->vq_id); +} + +static void imx_rproc_mb_callback(struct mbox_client *cl, void *data) +{ + struct rproc *rproc = dev_get_drvdata(cl->dev); + struct imx_mbox *mb = container_of(cl, struct imx_mbox, client); + struct imx_rproc *ddata = rproc->priv; + + queue_work(ddata->workqueue, &mb->vq_work); +} + +static const struct imx_mbox imx_rproc_mbox[IMX_MBOX_NB_MBX] = { + { + .name = IMX_MBX_VQ0, + .vq_id = 0, + .client = { + .rx_callback = imx_rproc_mb_callback, + .tx_block = false, + }, + }, + { + .name = IMX_MBX_VQ1, + .vq_id = 1, + .client = { + .rx_callback = imx_rproc_mb_callback, + .tx_block = false, + }, + }, +}; + +static void imx_rproc_request_mbox(struct rproc *rproc) +{ + struct imx_rproc *ddata = rproc->priv; + struct device *dev = &rproc->dev; + unsigned int i; + const unsigned char *name; + struct mbox_client *cl; + + /* Initialise mailbox structure table */ + memcpy(ddata->mb, imx_rproc_mbox, sizeof(imx_rproc_mbox)); + + for (i = 0; i < IMX_MBOX_NB_MBX; i++) { + name = ddata->mb[i].name; + + cl = &ddata->mb[i].client; + cl->dev = dev->parent; + + ddata->mb[i].chan = mbox_request_channel_byname(cl, name); + + dev_dbg(dev, "%s: name=%s, idx=%u\n", + __func__, name, ddata->mb[i].vq_id); + + if (IS_ERR(ddata->mb[i].chan)) { + dev_warn(dev, "cannot get %s mbox\n", name); + ddata->mb[i].chan = NULL; + } + + if (ddata->mb[i].vq_id >= 0) + INIT_WORK(&ddata->mb[i].vq_work, imx_rproc_mb_vq_work); + } +} + +static void imx_rproc_free_mbox(struct rproc *rproc) +{ + struct imx_rproc *ddata = rproc->priv; + unsigned int i; + + dev_dbg(&rproc->dev, "%s: %d boxes\n", + __func__, ARRAY_SIZE(ddata->mb)); + + for (i = 0; i < ARRAY_SIZE(ddata->mb); i++) { + if (ddata->mb[i].chan) + mbox_free_channel(ddata->mb[i].chan); + ddata->mb[i].chan = NULL; + } +} + +static void imx_rproc_kick(struct rproc *rproc, int vqid) +{ + struct imx_rproc *ddata = rproc->priv; + unsigned int i; + int err; + + if (WARN_ON(vqid >= IMX_MBOX_NB_VQ)) + return; + + for (i = 0; i < IMX_MBOX_NB_MBX; i++) { + if (vqid != ddata->mb[i].vq_id) + continue; + if (!ddata->mb[i].chan) + return; + dev_dbg(&rproc->dev, "sending message : vqid = %d\n", vqid); + err = mbox_send_message(ddata->mb[i].chan, &vqid); + if (err < 0) + dev_err(&rproc->dev, "%s: failed (%s, err:%d)\n", + __func__, ddata->mb[i].name, err); + return; + } +} + static const struct rproc_ops imx_rproc_ops = { .start = imx_rproc_start, .stop = imx_rproc_stop, .da_to_va = imx_rproc_da_to_va, + .kick = imx_rproc_kick, .get_boot_addr = rproc_elf_get_boot_addr, }; @@ -384,14 +511,26 @@ static int imx_rproc_probe(struct platform_device *pdev) goto err_put_rproc; } + priv->workqueue = create_workqueue(dev_name(dev)); + if (!priv->workqueue) { + dev_err(dev, "cannot create workqueue\n"); + ret = -ENOMEM; + goto err_put_clk; + } + + imx_rproc_request_mbox(rproc); + ret = rproc_add(rproc); if (ret) { dev_err(dev, "rproc_add failed\n"); - goto err_put_clk; + goto err_free_mb; } return 0; +err_free_mb: + imx_rproc_free_mbox(rproc); + destroy_workqueue(priv->workqueue); err_put_clk: clk_disable_unprepare(priv->clk); err_put_rproc: @@ -407,6 +546,7 @@ static int imx_rproc_remove(struct platform_device *pdev) clk_disable_unprepare(priv->clk); rproc_del(rproc); + imx_rproc_free_mbox(rproc); rproc_free(rproc); return 0; From patchwork Mon Apr 6 11:33:10 2020 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Nikita Shubin X-Patchwork-Id: 11475301 Return-Path: Received: from mail.kernel.org (pdx-korg-mail-1.web.codeaurora.org [172.30.200.123]) by pdx-korg-patchwork-2.web.codeaurora.org (Postfix) with ESMTP id 09D3E1392 for ; Mon, 6 Apr 2020 11:32:22 +0000 (UTC) Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by mail.kernel.org (Postfix) with ESMTP id D2C9F2072A for ; Mon, 6 Apr 2020 11:32:21 +0000 (UTC) Authentication-Results: mail.kernel.org; dkim=pass (1024-bit key) header.d=maquefel.me header.i=@maquefel.me header.b="nkjpfeD1" Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1727512AbgDFLcV (ORCPT ); Mon, 6 Apr 2020 07:32:21 -0400 Received: from forward100p.mail.yandex.net ([77.88.28.100]:40284 "EHLO forward100p.mail.yandex.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1727481AbgDFLcV (ORCPT ); Mon, 6 Apr 2020 07:32:21 -0400 Received: from mxback18j.mail.yandex.net (mxback18j.mail.yandex.net [IPv6:2a02:6b8:0:1619::94]) by forward100p.mail.yandex.net (Yandex) with ESMTP id 8EFA959802A0; Mon, 6 Apr 2020 14:32:17 +0300 (MSK) Received: from iva6-add863d6e49c.qloud-c.yandex.net (iva6-add863d6e49c.qloud-c.yandex.net [2a02:6b8:c0c:7ea0:0:640:add8:63d6]) by mxback18j.mail.yandex.net (mxback/Yandex) with ESMTP id fq58GT5zVa-WGOSMI2V; Mon, 06 Apr 2020 14:32:17 +0300 DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=maquefel.me; s=mail; t=1586172737; bh=ucsdRRT+zZSKCrcUo+bbn9vGVT94WMNFHwYtuQ4aOdo=; h=In-Reply-To:Subject:To:From:Cc:References:Date:Message-Id; b=nkjpfeD1NrlyznWG1s4dpWYU0knd/9uazEY/jrjGtdM0jdYIc61Xhbag4hEliGnyI STJL8HAK46Z6jVb3nKduhgGd/FzatvD1mTX3A8e2+tatR+0SWnYswGIS+8w1dqrdOH TILdnV2QXTcgHDkX2GVeQnMO9sT2zcOejFbPOzVU= Authentication-Results: mxback18j.mail.yandex.net; dkim=pass header.i=@maquefel.me Received: by iva6-add863d6e49c.qloud-c.yandex.net (smtp/Yandex) with ESMTPSA id CHTIIrjdik-WF2uGgoU; Mon, 06 Apr 2020 14:32:15 +0300 (using TLSv1.3 with cipher TLS_AES_256_GCM_SHA384 (256/256 bits)) (Client certificate not present) From: nikita.shubin@maquefel.me To: nikita.shubin@maquefel.me Cc: Nikita Shubin , Ohad Ben-Cohen , Bjorn Andersson , Shawn Guo , Sascha Hauer , Pengutronix Kernel Team , Fabio Estevam , NXP Linux Team , linux-remoteproc@vger.kernel.org, linux-arm-kernel@lists.infradead.org, linux-kernel@vger.kernel.org Subject: [PATCH v2 3/3] remoteproc: imx_rproc: memory regions Date: Mon, 6 Apr 2020 14:33:10 +0300 Message-Id: <20200406113310.3041-4-nikita.shubin@maquefel.me> X-Mailer: git-send-email 2.25.1 In-Reply-To: <20200406113310.3041-1-nikita.shubin@maquefel.me> References: <20200304142628.8471-1-NShubin@topcon.com> <20200406113310.3041-1-nikita.shubin@maquefel.me> MIME-Version: 1.0 Sender: linux-remoteproc-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-remoteproc@vger.kernel.org Add support for carveout memory regions required for vdev vring's and buffer. Search in device tree and allocate memory regions like for ocram: vdev0vring0: vdev0vring0@00920000 { compatible = "shared-dma-pool"; reg = <0x00920000 0x2000>; no-map; }; vdev0vring1: vdev0vring1@00922000 { compatible = "shared-dma-pool"; reg = <0x00922000 0x2000>; no-map; }; vdev0buffer: vdev0buffer@00924000 { compatible = "shared-dma-pool"; reg = <0x00924000 0x4000>; no-map; }; imx7d-cm4 { compatible = "fsl,imx7d-cm4"; memory-region = <&ocram>, <&vdev0vring0>, <&vdev0vring1>, \ <&vdev0buffer>; } vdev0vring0, vdev0vring1, vdev0buffer are required for virtio functioning. Signed-off-by: Nikita Shubin --- drivers/remoteproc/imx_rproc.c | 119 ++++++++++++++++++++++++++++++++- 1 file changed, 118 insertions(+), 1 deletion(-) diff --git a/drivers/remoteproc/imx_rproc.c b/drivers/remoteproc/imx_rproc.c index d2bede4ccb70..cdcff2bd2867 100644 --- a/drivers/remoteproc/imx_rproc.c +++ b/drivers/remoteproc/imx_rproc.c @@ -11,6 +11,7 @@ #include #include #include +#include #include #include #include @@ -238,6 +239,29 @@ static int imx_rproc_da_to_sys(struct imx_rproc *priv, u64 da, return -ENOENT; } +static int imx_rproc_sys_to_da(struct imx_rproc *priv, u64 sys, + int len, u64 *da) +{ + const struct imx_rproc_dcfg *dcfg = priv->dcfg; + int i; + + /* parse address translation table */ + for (i = 0; i < dcfg->att_size; i++) { + const struct imx_rproc_att *att = &dcfg->att[i]; + + if (sys >= att->sa && sys + len <= att->sa + att->size) { + unsigned int offset = sys - att->sa; + + *da = att->da + offset; + return 0; + } + } + + dev_warn(priv->dev, "Translation failed: sys = 0x%llx len = 0x%x\n", + sys, len); + return -ENOENT; +} + static void *imx_rproc_da_to_va(struct rproc *rproc, u64 da, int len) { struct imx_rproc *priv = rproc->priv; @@ -372,16 +396,109 @@ static void imx_rproc_kick(struct rproc *rproc, int vqid) err = mbox_send_message(ddata->mb[i].chan, &vqid); if (err < 0) dev_err(&rproc->dev, "%s: failed (%s, err:%d)\n", - __func__, ddata->mb[i].name, err); + __func__, ddata->mb[i].name, err); return; } } +static int imx_rproc_mem_alloc(struct rproc *rproc, + struct rproc_mem_entry *mem) +{ + struct device *dev = rproc->dev.parent; + void *va; + + dev_dbg(dev, "map memory: %pa+%x\n", &mem->dma, mem->len); + va = ioremap_wc(mem->dma, mem->len); + if (IS_ERR_OR_NULL(va)) { + dev_err(dev, "Unable to map memory region: %pa+%x\n", + &mem->dma, mem->len); + return -ENOMEM; + } + + /* Update memory entry va */ + mem->va = va; + + return 0; +} + +static int imx_rproc_mem_release(struct rproc *rproc, + struct rproc_mem_entry *mem) +{ + dev_dbg(rproc->dev.parent, "unmap memory: %pa\n", &mem->dma); + iounmap(mem->va); + + return 0; +} + +static int imx_rproc_parse_fw(struct rproc *rproc, const struct firmware *fw) +{ + struct imx_rproc *priv = rproc->priv; + struct device *dev = rproc->dev.parent; + struct device_node *np = dev->of_node; + struct of_phandle_iterator it; + struct rproc_mem_entry *mem = 0; + struct reserved_mem *rmem; + u64 da; + int index = 0; + + /* Register associated reserved memory regions */ + of_phandle_iterator_init(&it, np, "memory-region", NULL, 0); + while (of_phandle_iterator_next(&it) == 0) { + rmem = of_reserved_mem_lookup(it.node); + if (!rmem) { + dev_err(dev, "unable to acquire memory-region\n"); + return -EINVAL; + } + + /* + * Let's assume all data in device tree is from + * CPU A7 point of view then we should translate + * rmem->base into M4 da + */ + if (imx_rproc_sys_to_da(priv, rmem->base, rmem->size, &da)) { + dev_err(dev, "memory region not valid %pa\n", + &rmem->base); + return -EINVAL; + } + + if (strcmp(it.node->name, "vdev0buffer")) { + /* Register memory region */ + mem = rproc_mem_entry_init(dev, NULL, + (dma_addr_t)rmem->base, + rmem->size, da, + imx_rproc_mem_alloc, + imx_rproc_mem_release, + it.node->name); + + if (mem) + rproc_coredump_add_segment(rproc, da, + rmem->size); + } else { + mem = rproc_of_resm_mem_entry_init(dev, index, + rmem->size, + rmem->base, + it.node->name); + } + + if (!mem) + return -ENOMEM; + + rproc_add_carveout(rproc, mem); + index++; + } + + return rproc_elf_load_rsc_table(rproc, fw); +} + static const struct rproc_ops imx_rproc_ops = { .start = imx_rproc_start, .stop = imx_rproc_stop, .da_to_va = imx_rproc_da_to_va, .kick = imx_rproc_kick, + .load = rproc_elf_load_segments, + .parse_fw = imx_rproc_parse_fw, + .find_loaded_rsc_table = rproc_elf_find_loaded_rsc_table, + .sanity_check = rproc_elf_sanity_check, .get_boot_addr = rproc_elf_get_boot_addr, };