From mboxrd@z Thu Jan 1 00:00:00 1970 Return-Path: X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on aws-us-west-2-korg-lkml-1.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-15.2 required=3.0 tests=BAYES_00,DKIMWL_WL_HIGH, DKIM_SIGNED,DKIM_VALID,HEADER_FROM_DIFFERENT_DOMAINS,INCLUDES_CR_TRAILER, INCLUDES_PATCH,MAILING_LIST_MULTI,SPF_HELO_NONE,SPF_PASS,URIBL_BLOCKED autolearn=unavailable autolearn_force=no version=3.4.0 Received: from mail.kernel.org (mail.kernel.org [198.145.29.99]) by smtp.lore.kernel.org (Postfix) with ESMTP id 34E29C433FE for ; Sat, 5 Dec 2020 00:46:14 +0000 (UTC) Received: from merlin.infradead.org (merlin.infradead.org [205.233.59.134]) (using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits)) (No client certificate requested) by mail.kernel.org (Postfix) with ESMTPS id B32A022D71 for ; Sat, 5 Dec 2020 00:46:13 +0000 (UTC) DMARC-Filter: OpenDMARC Filter v1.3.2 mail.kernel.org B32A022D71 Authentication-Results: mail.kernel.org; dmarc=fail (p=none dis=none) header.from=linaro.org Authentication-Results: mail.kernel.org; spf=none smtp.mailfrom=linux-arm-kernel-bounces+linux-arm-kernel=archiver.kernel.org@lists.infradead.org DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=lists.infradead.org; s=merlin.20170209; h=Sender:Content-Transfer-Encoding: Content-Type:Cc:List-Subscribe:List-Help:List-Post:List-Archive: List-Unsubscribe:List-Id:In-Reply-To:MIME-Version:References:Message-ID: Subject:To:From:Date:Reply-To:Content-ID:Content-Description:Resent-Date: Resent-From:Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID:List-Owner; bh=X4q6AfD1qfk0eK73hEj5JE4Dd1mMGfDlIqBJ3yw2afo=; b=I98SEl1dANYfCiQ8jaq3lD/Q5 fixregM1Ziqiij5DXBCkyowwZrOA2hwVkMCwLbBBI2SB2X60OOG1bL6yAWgECa6ebxEoZ+z9JtPV/ u5cBF/9Dvq+RHaHAu9PZsDKRb5ymc1igEnqPD1YA+oXvSFtweZqJqAuXMPFTlSOqjtyAB4+NZwy56 b2KPLOJ4lJ3BMQ95QxJIkbP++HrOrQzDJgvWWw1exdQypW+0/zHyGuZTdKWWebvqYfH2uJmPe3Eun 27ADT/BOyfyiolJ9AjLan9F0NFWXfoKGrxOrKBwa238xefhRNPquZD9yGpiem+OQ+AY5uTxQImDQd PM7JA/O5A==; Received: from localhost ([::1] helo=merlin.infradead.org) by merlin.infradead.org with esmtp (Exim 4.92.3 #3 (Red Hat Linux)) id 1klLgf-0000hW-H3; Sat, 05 Dec 2020 00:44:33 +0000 Received: from mail-ot1-x342.google.com ([2607:f8b0:4864:20::342]) by merlin.infradead.org with esmtps (Exim 4.92.3 #3 (Red Hat Linux)) id 1klLgc-0000hB-3N for linux-arm-kernel@lists.infradead.org; Sat, 05 Dec 2020 00:44:31 +0000 Received: by mail-ot1-x342.google.com with SMTP id z24so7058776oto.6 for ; Fri, 04 Dec 2020 16:44:29 -0800 (PST) DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=linaro.org; s=google; h=date:from:to:cc:subject:message-id:references:mime-version :content-disposition:in-reply-to; bh=FKHcTrBVaUtk6AbcZrMyJksvnOdCrwx+JnD4iIZ6n34=; b=vWj1HS7XdM6sJsHKzZwXcDlz1P4t/m3xcRfRQ5muZhgl6MsePlIQhZt5BVmS/XfxPh yVp1O5+i7x+beMvQ974a/ITXECTTQuPN06cW56njFPmDMxu3HNNEjofllmgKJkuINzKh tqxoeVBUlyDyM0M7BRpKBaQYJfgCwl58GHWzHk0UPbYpJeq90u8E2/1vbPyoq+lAqCve obJBc4MricpaJDLYVqC4u1J0jRR2GUBV3isZLwcUMouHwBxn/E6sCU9Gpl1A274q1Qs1 7+LZylGMJA4QsMeJUPgiadPQSz3lh9B6uxvM+Y7y+Wnc5nO5EjhtihfRVLKBI9gNrYSU qGrA== X-Google-DKIM-Signature: v=1; a=rsa-sha256; c=relaxed/relaxed; d=1e100.net; s=20161025; h=x-gm-message-state:date:from:to:cc:subject:message-id:references :mime-version:content-disposition:in-reply-to; bh=FKHcTrBVaUtk6AbcZrMyJksvnOdCrwx+JnD4iIZ6n34=; b=fmMAnU/i64v9Yv8l1EQd/iIh8DZ0pQytfWcMFIN6EsWV7m0vZtzj5a5VGj1q1DwE35 v9zo2jIhIe2oIggLfSoKcSPrsrMOawCkxphvg/LIEQ1k6IY1CBxFhHXWmM6UPNSuKvrt YNyFo2P+D5D4YHeSwlzcvwoExl9GCfaQjCXj+SJqr+JyMw9h4vbygiDAu3ipZMM5V0VV igH19QPpab2mXjFpp5pUYPfMb8MHaB2jyeRhyOsN2T35ZS+LRHCgmQBZZ83Sn9MoNog1 2nI+dJnD2cXbeJGyl+Yd8nrJL0ZtHTBJg0KhgCl/kFdOFZ3NuY2SDPBF842r6tl28vCm E9sw== X-Gm-Message-State: AOAM530YjnqX/0/xAwe8e7mUzg0nvtk1JmyxGxwMI34Wwh6Je2p60ivO NMvUZK/1OMXp9LqhhP0nAGCiPRcUR1QMsw== X-Google-Smtp-Source: ABdhPJyW2IkteVS0klfDV4wsG3ZVAckzuNpnrVhfh/ARwBL3+3e4I/3vTa24jF508jL9ROxY5Gmt+Q== X-Received: by 2002:a9d:3988:: with SMTP id y8mr5561961otb.278.1607129067772; Fri, 04 Dec 2020 16:44:27 -0800 (PST) Received: from builder.lan (104-57-184-186.lightspeed.austtx.sbcglobal.net. [104.57.184.186]) by smtp.gmail.com with ESMTPSA id q1sm605827oic.38.2020.12.04.16.44.26 (version=TLS1_3 cipher=TLS_AES_256_GCM_SHA384 bits=256/256); Fri, 04 Dec 2020 16:44:27 -0800 (PST) Date: Fri, 4 Dec 2020 18:44:25 -0600 From: Bjorn Andersson To: "Peng Fan (OSS)" Subject: Re: [PATCH V3 7/7] remoteproc: imx_proc: enable virtio/mailbox Message-ID: References: <20201204074036.23870-1-peng.fan@oss.nxp.com> <20201204074036.23870-8-peng.fan@oss.nxp.com> MIME-Version: 1.0 Content-Disposition: inline In-Reply-To: <20201204074036.23870-8-peng.fan@oss.nxp.com> X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 X-CRM114-CacheID: sfid-20201204_194430_190569_F58A5143 X-CRM114-Status: GOOD ( 27.43 ) X-BeenThere: linux-arm-kernel@lists.infradead.org X-Mailman-Version: 2.1.29 Precedence: list List-Id: List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , Cc: ohad@wizery.com, Peng Fan , Richard Zhu , mathieu.poirier@linaro.org, festevam@gmail.com, s.hauer@pengutronix.de, linux-remoteproc@vger.kernel.org, linux-kernel@vger.kernel.org, o.rempel@pengutronix.de, linux-imx@nxp.com, kernel@pengutronix.de, shawnguo@kernel.org, linux-arm-kernel@lists.infradead.org Content-Type: text/plain; charset="us-ascii" Content-Transfer-Encoding: 7bit Sender: "linux-arm-kernel" Errors-To: linux-arm-kernel-bounces+linux-arm-kernel=archiver.kernel.org@lists.infradead.org On Fri 04 Dec 01:40 CST 2020, Peng Fan (OSS) wrote: > From: Peng Fan > > Use virtio/mailbox to build connection between Remote Proccessors > and Linux. Add work queue to handle incoming messages. > > Reviewed-by: Richard Zhu > Signed-off-by: Peng Fan > --- > drivers/remoteproc/imx_rproc.c | 133 ++++++++++++++++++++++++++++++++- > 1 file changed, 130 insertions(+), 3 deletions(-) > > diff --git a/drivers/remoteproc/imx_rproc.c b/drivers/remoteproc/imx_rproc.c > index afa650610996..584584a00921 100644 > --- a/drivers/remoteproc/imx_rproc.c > +++ b/drivers/remoteproc/imx_rproc.c > @@ -8,6 +8,7 @@ > #include > #include > #include > +#include > #include > #include > #include > @@ -16,6 +17,9 @@ > #include > #include > #include > +#include > + > +#include "remoteproc_internal.h" > > #define IMX7D_SRC_SCR 0x0C > #define IMX7D_ENABLE_M4 BIT(3) > @@ -88,6 +92,11 @@ struct imx_rproc { > const struct imx_rproc_dcfg *dcfg; > struct imx_rproc_mem mem[IMX7D_RPROC_MEM_MAX]; > struct clk *clk; > + struct mbox_client cl; > + struct mbox_chan *tx_ch; > + struct mbox_chan *rx_ch; > + struct work_struct rproc_work; > + struct workqueue_struct *workqueue; > }; > > static const struct imx_rproc_att imx_rproc_att_imx8mq[] = { > @@ -369,9 +378,33 @@ static int imx_rproc_parse_fw(struct rproc *rproc, const struct firmware *fw) > return 0; > } > > +static void imx_rproc_kick(struct rproc *rproc, int vqid) > +{ > + struct imx_rproc *priv = rproc->priv; > + int err; > + __u32 mmsg; > + > + if (!priv->tx_ch) { > + dev_err(priv->dev, "No initialized mbox tx channel\n"); > + return; > + } > + > + /* > + * Send the index of the triggered virtqueue as the mu payload. > + * Let remote processor know which virtqueue is used. > + */ > + mmsg = vqid << 16; > + > + err = mbox_send_message(priv->tx_ch, (void *)&mmsg); > + if (err < 0) > + dev_err(priv->dev, "%s: failed (%d, err:%d)\n", > + __func__, vqid, err); > +} > + > static const struct rproc_ops imx_rproc_ops = { > .start = imx_rproc_start, > .stop = imx_rproc_stop, > + .kick = imx_rproc_kick, > .da_to_va = imx_rproc_da_to_va, > .load = rproc_elf_load_segments, > .parse_fw = imx_rproc_parse_fw, > @@ -454,6 +487,77 @@ static void imx_rproc_memset(struct rproc *rproc, void *s, int c, size_t count) > memset_io((void * __iomem)s, c, count); > } > > +static void imx_rproc_vq_work(struct work_struct *work) > +{ > + struct imx_rproc *priv = container_of(work, struct imx_rproc, > + rproc_work); > + > + rproc_vq_interrupt(priv->rproc, 0); > + rproc_vq_interrupt(priv->rproc, 1); > +} > + > +static void imx_rproc_rx_callback(struct mbox_client *cl, void *msg) > +{ > + struct rproc *rproc = dev_get_drvdata(cl->dev); > + struct imx_rproc *priv = rproc->priv; > + > + queue_work(priv->workqueue, &priv->rproc_work); > +} > + > +static int imx_rproc_xtr_mbox_init(struct rproc *rproc) > +{ > + struct imx_rproc *priv = rproc->priv; > + struct device *dev = priv->dev; > + struct mbox_client *cl; > + int ret = 0; > + > + if (!of_get_property(dev->of_node, "mbox-names", NULL)) > + return 0; > + > + cl = &priv->cl; > + cl->dev = dev; > + cl->tx_block = true; > + cl->tx_tout = 100; > + cl->knows_txdone = false; > + cl->rx_callback = imx_rproc_rx_callback; > + > + priv->tx_ch = mbox_request_channel_byname(cl, "tx"); > + if (IS_ERR(priv->tx_ch)) { > + if (PTR_ERR(priv->tx_ch) == -EPROBE_DEFER) > + return -EPROBE_DEFER; > + ret = PTR_ERR(priv->tx_ch); > + dev_dbg(cl->dev, "failed to request mbox tx chan, ret %d\n", > + ret); This is worse than a dev_dbg(), something is actually wrong. Also there's no point in jumping to err_out here, because tx_ch is IS_ERR() so we're going to skip the first part and rx_ch is not IS_ERR() so you're going to call mbox_free_channel(NULL) and then return. So just replace this entire block with: return dev_err_probe(dev, PTR_ERR(priv->ch_ch), "failed to request tx mailbox channel: %d\n", ret); > + goto err_out; > + } > + > + priv->rx_ch = mbox_request_channel_byname(cl, "rx"); > + if (IS_ERR(priv->rx_ch)) { > + ret = PTR_ERR(priv->rx_ch); > + dev_dbg(cl->dev, "failed to request mbox rx chan, ret %d\n", > + ret); > + goto err_out; mbox_free_channel(priv->tx_ch); return dev_err_probe(dev, PTR_ERR(priv->ch_ch), "failed to request rx mailbox channel: %d\n", ret); > + } > + > + return ret; ret is 0 here. > + > +err_out: > + if (!IS_ERR(priv->tx_ch)) > + mbox_free_channel(priv->tx_ch); > + if (!IS_ERR(priv->rx_ch)) > + mbox_free_channel(priv->rx_ch); > + > + return ret; > +} > + > +static void imx_rproc_free_mbox(struct rproc *rproc) > +{ > + struct imx_rproc *priv = rproc->priv; > + > + mbox_free_channel(priv->tx_ch); > + mbox_free_channel(priv->rx_ch); > +} > + > static int imx_rproc_probe(struct platform_device *pdev) > { > struct device *dev = &pdev->dev; > @@ -496,18 +600,31 @@ static int imx_rproc_probe(struct platform_device *pdev) > priv->dev = dev; > > dev_set_drvdata(dev, rproc); > + priv->workqueue = create_workqueue(dev_name(dev)); > + if (!priv->workqueue) { > + dev_err(dev, "cannot create workqueue\n"); > + ret = -ENOMEM; > + goto err_put_rproc; > + } > + > + ret = imx_rproc_xtr_mbox_init(rproc); > + if (ret) { > + if (ret == -EPROBE_DEFER) > + goto err_put_wkq; > + /* mbox is optional, so not fail here */ imx_rproc_xtr_mbox_init() returns 0 if no mbox was specified, that means that in all cases that we reach here mailboxes where specified but an error occurred. You should not ignore this. > + } > > ret = imx_rproc_addr_init(priv, pdev); > if (ret) { > dev_err(dev, "failed on imx_rproc_addr_init\n"); > - goto err_put_rproc; > + goto err_put_mbox; > } > > priv->clk = devm_clk_get(dev, NULL); > if (IS_ERR(priv->clk)) { > dev_err(dev, "Failed to get clock\n"); > ret = PTR_ERR(priv->clk); > - goto err_put_rproc; > + goto err_put_mbox; > } > > /* > @@ -517,9 +634,11 @@ static int imx_rproc_probe(struct platform_device *pdev) > ret = clk_prepare_enable(priv->clk); > if (ret) { > dev_err(&rproc->dev, "Failed to enable clock\n"); > - goto err_put_rproc; > + goto err_put_mbox; > } > > + INIT_WORK(&(priv->rproc_work), imx_rproc_vq_work); > + > ret = rproc_add(rproc); > if (ret) { > dev_err(dev, "rproc_add failed\n"); > @@ -530,6 +649,13 @@ static int imx_rproc_probe(struct platform_device *pdev) > > err_put_clk: > clk_disable_unprepare(priv->clk); > +err_put_mbox: > + if (!IS_ERR(priv->tx_ch)) With above changes you won't get here with IS_ERR(tx_ch) || IS_ERR(rx_ch), so you can safely remove the conditionals and just call mbox_free_channel(). Regards, Bjorn > + mbox_free_channel(priv->tx_ch); > + if (!IS_ERR(priv->rx_ch)) > + mbox_free_channel(priv->rx_ch); > +err_put_wkq: > + destroy_workqueue(priv->workqueue); > err_put_rproc: > rproc_free(rproc); > > @@ -542,6 +668,7 @@ static int imx_rproc_remove(struct platform_device *pdev) > struct imx_rproc *priv = rproc->priv; > > clk_disable_unprepare(priv->clk); > + imx_rproc_free_mbox(rproc); > rproc_del(rproc); > rproc_free(rproc); > > -- > 2.28.0 > _______________________________________________ linux-arm-kernel mailing list linux-arm-kernel@lists.infradead.org http://lists.infradead.org/mailman/listinfo/linux-arm-kernel