From patchwork Wed Dec 7 20:33:44 2016 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Loic PALLARDY X-Patchwork-Id: 9465199 Return-Path: Received: from mail.wl.linuxfoundation.org (pdx-wl-mail.web.codeaurora.org [172.30.200.125]) by pdx-korg-patchwork.web.codeaurora.org (Postfix) with ESMTP id 57B606075A for ; Wed, 7 Dec 2016 20:34:59 +0000 (UTC) Received: from mail.wl.linuxfoundation.org (localhost [127.0.0.1]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id 592A928427 for ; Wed, 7 Dec 2016 20:34:59 +0000 (UTC) Received: by mail.wl.linuxfoundation.org (Postfix, from userid 486) id 4E4AE284D0; Wed, 7 Dec 2016 20:34:59 +0000 (UTC) X-Spam-Checker-Version: SpamAssassin 3.3.1 (2010-03-16) on pdx-wl-mail.web.codeaurora.org X-Spam-Level: X-Spam-Status: No, score=-6.9 required=2.0 tests=BAYES_00,RCVD_IN_DNSWL_HI autolearn=ham version=3.3.1 Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by mail.wl.linuxfoundation.org (Postfix) with ESMTP id B346D28532 for ; Wed, 7 Dec 2016 20:34:58 +0000 (UTC) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S932550AbcLGUe6 (ORCPT ); Wed, 7 Dec 2016 15:34:58 -0500 Received: from mx07-00178001.pphosted.com ([62.209.51.94]:35891 "EHLO mx07-00178001.pphosted.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1752885AbcLGUe5 (ORCPT ); Wed, 7 Dec 2016 15:34:57 -0500 Received: from pps.filterd (m0046037.ppops.net [127.0.0.1]) by m0046037.ppops.net (8.16.0.11/8.16.0.11) with SMTP id uB7KYE7M016243; Wed, 7 Dec 2016 21:34:23 +0100 Received: from beta.dmz-eu.st.com (beta.dmz-eu.st.com [164.129.1.35]) by mx07-.pphosted.com with ESMTP id 27554qvmrw-1 (version=TLSv1 cipher=ECDHE-RSA-AES256-SHA bits=256 verify=NOT); Wed, 07 Dec 2016 21:34:22 +0100 Received: from zeta.dmz-eu.st.com (zeta.dmz-eu.st.com [164.129.230.9]) by beta.dmz-eu.st.com (STMicroelectronics) with ESMTP id 2685E34; Wed, 7 Dec 2016 20:34:22 +0000 (GMT) Received: from Webmail-eu.st.com (Safex1hubcas21.st.com [10.75.90.44]) by zeta.dmz-eu.st.com (STMicroelectronics) with ESMTP id 05E5F4E98; Wed, 7 Dec 2016 20:34:22 +0000 (GMT) Received: from localhost (10.129.5.76) by Webmail-ga.st.com (10.75.90.48) with Microsoft SMTP Server (TLS) id 14.3.294.0; Wed, 7 Dec 2016 21:34:21 +0100 From: Loic Pallardy To: , , , CC: , , Subject: [PATCH v1 1/3] remoteproc: st: add virtio communication support Date: Wed, 7 Dec 2016 21:33:44 +0100 Message-ID: <1481142826-15528-2-git-send-email-loic.pallardy@st.com> X-Mailer: git-send-email 1.9.1 In-Reply-To: <1481142826-15528-1-git-send-email-loic.pallardy@st.com> References: <1481142826-15528-1-git-send-email-loic.pallardy@st.com> MIME-Version: 1.0 X-Originating-IP: [10.129.5.76] X-Proofpoint-Virus-Version: vendor=fsecure engine=2.50.10432:, , definitions=2016-12-07_06:, , signatures=0 Sender: linux-remoteproc-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: linux-remoteproc@vger.kernel.org X-Virus-Scanned: ClamAV using ClamSMTP This patch provides virtio communication support based on mailbox for ST coprocessors. Signed-off-by: Loic Pallardy --- drivers/remoteproc/Kconfig | 3 + drivers/remoteproc/st_remoteproc.c | 121 ++++++++++++++++++++++++++++++++++++- 2 files changed, 123 insertions(+), 1 deletion(-) diff --git a/drivers/remoteproc/Kconfig b/drivers/remoteproc/Kconfig index 51d7ca0..fd275c0 100644 --- a/drivers/remoteproc/Kconfig +++ b/drivers/remoteproc/Kconfig @@ -119,6 +119,9 @@ config ST_REMOTEPROC tristate "ST remoteproc support" depends on ARCH_STI depends on REMOTEPROC + select MAILBOX + select STI_MBOX + select RPMSG_VIRTIO help Say y here to support ST's adjunct processors via the remote processor framework. diff --git a/drivers/remoteproc/st_remoteproc.c b/drivers/remoteproc/st_remoteproc.c index da4e152..113caf2 100644 --- a/drivers/remoteproc/st_remoteproc.c +++ b/drivers/remoteproc/st_remoteproc.c @@ -15,6 +15,7 @@ #include #include #include +#include #include #include #include @@ -25,6 +26,17 @@ #include #include +#include "remoteproc_internal.h" + +#define ST_RPROC_MAX_VRING 2 + +#define MBOX_RX 0 +#define MBOX_TX 1 +#define MBOX_MAX 2 + +static struct mbox_client mbox_client_vq0; +static struct mbox_client mbox_client_vq1; + struct st_rproc_config { bool sw_reset; bool pwr_reset; @@ -39,8 +51,45 @@ struct st_rproc { u32 clk_rate; struct regmap *boot_base; u32 boot_offset; + struct mbox_chan *mbox_chan[ST_RPROC_MAX_VRING][MBOX_MAX]; }; +static void st_rproc_mbox_callback(struct device *dev, u32 msg) +{ + struct rproc *rproc = dev_get_drvdata(dev); + + if (rproc_vq_interrupt(rproc, msg) == IRQ_NONE) + dev_dbg(dev, "no message was found in vqid %d\n", msg); +} + +static void st_rproc_mbox_callback_vq0(struct mbox_client *mbox_client, + void *data) +{ + st_rproc_mbox_callback(mbox_client->dev, 0); +} + +static void st_rproc_mbox_callback_vq1(struct mbox_client *mbox_client, + void *data) +{ + st_rproc_mbox_callback(mbox_client->dev, 1); +} + +static void st_rproc_kick(struct rproc *rproc, int vqid) +{ + struct st_rproc *ddata = rproc->priv; + struct device *dev = rproc->dev.parent; + int ret; + + /* send the index of the triggered virtqueue in the mailbox payload */ + if (vqid < ST_RPROC_MAX_VRING) { + ret = mbox_send_message(ddata->mbox_chan[vqid][MBOX_TX], + (void *)&vqid); + if (ret < 0) + dev_err(dev, + "failed to send message via mbox: %d\n", ret); + } +} + static int st_rproc_start(struct rproc *rproc) { struct st_rproc *ddata = rproc->priv; @@ -108,6 +157,7 @@ static int st_rproc_stop(struct rproc *rproc) } static struct rproc_ops st_rproc_ops = { + .kick = st_rproc_kick, .start = st_rproc_start, .stop = st_rproc_stop, }; @@ -221,6 +271,7 @@ static int st_rproc_probe(struct platform_device *pdev) struct st_rproc *ddata; struct device_node *np = dev->of_node; struct rproc *rproc; + struct mbox_chan *chan; int enabled; int ret; @@ -257,13 +308,76 @@ static int st_rproc_probe(struct platform_device *pdev) clk_set_rate(ddata->clk, ddata->clk_rate); } + if (of_get_property(np, "mbox-names", NULL)) { + mbox_client_vq0.dev = dev; + mbox_client_vq0.tx_done = NULL; + mbox_client_vq0.tx_block = false; + mbox_client_vq0.knows_txdone = false; + mbox_client_vq0.rx_callback = st_rproc_mbox_callback_vq0; + + mbox_client_vq1.dev = dev; + mbox_client_vq1.tx_done = NULL; + mbox_client_vq1.tx_block = false; + mbox_client_vq1.knows_txdone = false; + mbox_client_vq1.rx_callback = st_rproc_mbox_callback_vq1; + + /* + * To control a co-processor without IPC mechanism. + * This driver can be used without mbox and rpmsg. + */ + chan = mbox_request_channel_byname(&mbox_client_vq0, "vq0_rx"); + if (IS_ERR(chan)) { + dev_err(&rproc->dev, "failed to request mbox chan 0\n"); + ret = PTR_ERR(chan); + goto free_rproc; + } else { + ddata->mbox_chan[0][MBOX_RX] = chan; + } + + chan = mbox_request_channel_byname(&mbox_client_vq0, "vq0_tx"); + if (IS_ERR(chan)) { + dev_err(&rproc->dev, "failed to request mbox chan 0\n"); + ret = PTR_ERR(chan); + goto free_one; + } else { + ddata->mbox_chan[0][MBOX_TX] = chan; + } + + chan = mbox_request_channel_byname(&mbox_client_vq1, "vq1_rx"); + if (IS_ERR(chan)) { + dev_err(&rproc->dev, "failed to request mbox chan 1\n"); + ret = PTR_ERR(chan); + goto free_two; + } else { + ddata->mbox_chan[1][MBOX_RX] = chan; + } + + chan = mbox_request_channel_byname(&mbox_client_vq1, "vq1_tx"); + if (IS_ERR(chan)) { + dev_err(&rproc->dev, "failed to request mbox chan 1\n"); + ret = PTR_ERR(chan); + goto free_three; + } else { + ddata->mbox_chan[1][MBOX_TX] = chan; + } + } + ret = rproc_add(rproc); if (ret) - goto free_rproc; + goto free_for; return 0; +free_for: + mbox_free_channel(ddata->mbox_chan[1][MBOX_TX]); +free_three: + mbox_free_channel(ddata->mbox_chan[1][MBOX_RX]); +free_two: + mbox_free_channel(ddata->mbox_chan[0][MBOX_TX]); +free_one: + mbox_free_channel(ddata->mbox_chan[0][MBOX_RX]); free_rproc: + clk_unprepare(ddata->clk); rproc_free(rproc); return ret; } @@ -279,6 +393,11 @@ static int st_rproc_remove(struct platform_device *pdev) of_reserved_mem_device_release(&pdev->dev); + mbox_free_channel(ddata->mbox_chan[0][MBOX_RX]); + mbox_free_channel(ddata->mbox_chan[1][MBOX_RX]); + mbox_free_channel(ddata->mbox_chan[0][MBOX_TX]); + mbox_free_channel(ddata->mbox_chan[1][MBOX_TX]); + rproc_free(rproc); return 0;