From patchwork Fri Feb 5 06:57:27 2021 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Shengjiu Wang X-Patchwork-Id: 376883 Delivered-To: patch@linaro.org Received: by 2002:a02:b18a:0:0:0:0:0 with SMTP id t10csp1975535jah; Thu, 4 Feb 2021 23:11:06 -0800 (PST) X-Google-Smtp-Source: ABdhPJzTmCB+HJNBVlgNzvXOm+CJYVDL5Xdydv6+fEBfdunNhR+PzgEHsFYVKocCCvvM8nSO34+l X-Received: by 2002:a05:6402:5193:: with SMTP id q19mr2258202edd.264.1612509066434; Thu, 04 Feb 2021 23:11:06 -0800 (PST) ARC-Seal: i=1; a=rsa-sha256; t=1612509066; cv=none; d=google.com; s=arc-20160816; b=u4s1kOwtonU/ZVrz4pMscCcC7Id1Fsb68t6TPaHd4E7ezG7M3Fh7kteIOJKc8JdGYD DbpMIYln3R63talzMYwhF+AOKgw1btf9xUonPQ8IlB8JCcN0H8uNR8WRpCiXciH19qeu 0pJEEyYSvcG7izH0WN4zkFYjFJDXPN+/p2xwr6Z71Zl7jtnQXOm1I/aKh9QBAGvbTiK2 n/q1pe12u43i5t7E+sBtT5JIU9VE7wovG2X5PbaEIhJFn1QJ/NF/plFSrdht68uwsOX3 O3k/OUtBGYZgeQj1nedE2Qh3lYdHKS194RWKeViJt6BV1Lyu0JxZEeZoGY0VGySKg+Rv LQbw== ARC-Message-Signature: i=1; a=rsa-sha256; c=relaxed/relaxed; d=google.com; s=arc-20160816; h=list-id:precedence:references:in-reply-to:message-id:date:subject :to:from; bh=pIRFHK1f1TbtJ/hk6QkFwbuXInFf9UgLiX2y7o35vmA=; b=LXvYnzthEGBGWPm6bwfLsyoLgKzaoPP0wWPE18t31mKhIlSZuIwHlfHJPQR4ynw2XN NfIpcT5vqPg6LjzY2E5aXQFQZG4JK2/VCZPeZfTZANH04jL8LedM74MxZ2TSwLOB4TuE d5AZBTSMJq/mq0712NfdyaX79wMXv0/nIuCFZisu46iA5m6nf1hmemqS1boBnabig3V4 1FHYwnNF8ZX0vwZ0dI8vcPr4ZqJUwqaBSMfnL3F/IbvgerHEs2P4WM7v++tAZ2SCrQ3O GunXn8c72Mn0qHElxbY6NUomn/Awnh8RxKc1R404zuE0SzPR74NC1glVtyPgdS39LIXw 43Zw== ARC-Authentication-Results: i=1; mx.google.com; spf=pass (google.com: domain of devicetree-owner@vger.kernel.org designates 23.128.96.18 as permitted sender) smtp.mailfrom=devicetree-owner@vger.kernel.org; dmarc=fail (p=NONE sp=NONE dis=NONE) header.from=nxp.com Return-Path: Received: from vger.kernel.org (vger.kernel.org. [23.128.96.18]) by mx.google.com with ESMTP id a25si4522137ejd.541.2021.02.04.23.11.06; Thu, 04 Feb 2021 23:11:06 -0800 (PST) Received-SPF: pass (google.com: domain of devicetree-owner@vger.kernel.org designates 23.128.96.18 as permitted sender) client-ip=23.128.96.18; Authentication-Results: mx.google.com; spf=pass (google.com: domain of devicetree-owner@vger.kernel.org designates 23.128.96.18 as permitted sender) smtp.mailfrom=devicetree-owner@vger.kernel.org; dmarc=fail (p=NONE sp=NONE dis=NONE) header.from=nxp.com Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S231354AbhBEHKN (ORCPT + 6 others); Fri, 5 Feb 2021 02:10:13 -0500 Received: from inva020.nxp.com ([92.121.34.13]:41474 "EHLO inva020.nxp.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S231355AbhBEHJh (ORCPT ); Fri, 5 Feb 2021 02:09:37 -0500 Received: from inva020.nxp.com (localhost [127.0.0.1]) by inva020.eu-rdc02.nxp.com (Postfix) with ESMTP id 004701A0C16; Fri, 5 Feb 2021 08:08:50 +0100 (CET) Received: from invc005.ap-rdc01.nxp.com (invc005.ap-rdc01.nxp.com [165.114.16.14]) by inva020.eu-rdc02.nxp.com (Postfix) with ESMTP id AF9921A0AE5; Fri, 5 Feb 2021 08:08:44 +0100 (CET) Received: from localhost.localdomain (shlinux2.ap.freescale.net [10.192.224.44]) by invc005.ap-rdc01.nxp.com (Postfix) with ESMTP id 29493402C4; Fri, 5 Feb 2021 08:08:38 +0100 (CET) From: Shengjiu Wang To: lgirdwood@gmail.com, broonie@kernel.org, perex@perex.cz, tiwai@suse.com, alsa-devel@alsa-project.org, linux-kernel@vger.kernel.org, timur@kernel.org, nicoleotsuka@gmail.com, Xiubo.Lee@gmail.com, festevam@gmail.com, linuxppc-dev@lists.ozlabs.org, robh+dt@kernel.org, devicetree@vger.kernel.org Subject: [PATCH 4/7] ASoC: imx-audio-rpmsg: Add rpmsg_driver for audio channel Date: Fri, 5 Feb 2021 14:57:27 +0800 Message-Id: <1612508250-10586-5-git-send-email-shengjiu.wang@nxp.com> X-Mailer: git-send-email 2.7.4 In-Reply-To: <1612508250-10586-1-git-send-email-shengjiu.wang@nxp.com> References: <1612508250-10586-1-git-send-email-shengjiu.wang@nxp.com> X-Virus-Scanned: ClamAV using ClamSMTP Precedence: bulk List-ID: X-Mailing-List: devicetree@vger.kernel.org This driver is used to accept the message from rpmsg audio channel, and if this driver is probed, it will help to register the platform driver, the platform driver will use this audio channel to send and receive message to and from Cortex-M core. Signed-off-by: Shengjiu Wang --- sound/soc/fsl/Kconfig | 4 + sound/soc/fsl/Makefile | 1 + sound/soc/fsl/imx-audio-rpmsg.c | 142 ++++++++++++++++++++++++++++++++ 3 files changed, 147 insertions(+) create mode 100644 sound/soc/fsl/imx-audio-rpmsg.c -- 2.27.0 diff --git a/sound/soc/fsl/Kconfig b/sound/soc/fsl/Kconfig index a688c3c2efbc..84d9f0f1f75b 100644 --- a/sound/soc/fsl/Kconfig +++ b/sound/soc/fsl/Kconfig @@ -126,6 +126,10 @@ config SND_SOC_IMX_PCM_DMA tristate select SND_SOC_GENERIC_DMAENGINE_PCM +config SND_SOC_IMX_AUDIO_RPMSG + tristate + depends on RPMSG + config SND_SOC_IMX_AUDMUX tristate "Digital Audio Mux module support" help diff --git a/sound/soc/fsl/Makefile b/sound/soc/fsl/Makefile index b63802f345cc..f08f3cd07ff5 100644 --- a/sound/soc/fsl/Makefile +++ b/sound/soc/fsl/Makefile @@ -60,6 +60,7 @@ obj-$(CONFIG_SND_SOC_IMX_AUDMUX) += snd-soc-imx-audmux.o obj-$(CONFIG_SND_SOC_IMX_PCM_FIQ) += imx-pcm-fiq.o obj-$(CONFIG_SND_SOC_IMX_PCM_DMA) += imx-pcm-dma.o +obj-$(CONFIG_SND_SOC_IMX_AUDIO_RPMSG) += imx-audio-rpmsg.o # i.MX Machine Support snd-soc-eukrea-tlv320-objs := eukrea-tlv320.o diff --git a/sound/soc/fsl/imx-audio-rpmsg.c b/sound/soc/fsl/imx-audio-rpmsg.c new file mode 100644 index 000000000000..c88af99ec4d9 --- /dev/null +++ b/sound/soc/fsl/imx-audio-rpmsg.c @@ -0,0 +1,142 @@ +// SPDX-License-Identifier: GPL-2.0+ +// Copyright 2017-2020 NXP + +#include +#include +#include "imx-pcm-rpmsg.h" + +/** + * struct imx_audio_rpmsg: private data + * + * @rpmsg_pdev: pointer of platform device + */ +struct imx_audio_rpmsg { + struct platform_device *rpmsg_pdev; +}; + +static int imx_audio_rpmsg_cb(struct rpmsg_device *rpdev, void *data, int len, + void *priv, u32 src) +{ + struct imx_audio_rpmsg *rpmsg = dev_get_drvdata(&rpdev->dev); + struct rpmsg_info *info = platform_get_drvdata(rpmsg->rpmsg_pdev); + struct rpmsg_r_msg *r_msg = (struct rpmsg_r_msg *)data; + struct rpmsg_msg *msg; + unsigned long flags; + + dev_dbg(&rpdev->dev, "get from%d: cmd:%d. %d\n", + src, r_msg->header.cmd, r_msg->param.resp); + + /* TYPE C is notification from M core */ + if (r_msg->header.type == MSG_TYPE_C) { + if (r_msg->header.cmd == TX_PERIOD_DONE) { + spin_lock_irqsave(&info->lock[TX], flags); + msg = &info->msg[TX_PERIOD_DONE + MSG_TYPE_A_NUM]; + + /** + * Low power mode: get the buffer pointer from + * receive msg. + */ + if (r_msg->header.major == 1 && + r_msg->header.minor == 2) + msg->r_msg.param.buffer_tail = + r_msg->param.buffer_tail; + else + msg->r_msg.param.buffer_tail++; + + msg->r_msg.param.buffer_tail %= info->num_period[TX]; + spin_unlock_irqrestore(&info->lock[TX], flags); + info->callback[TX](info->callback_param[TX]); + + } else if (r_msg->header.cmd == RX_PERIOD_DONE) { + spin_lock_irqsave(&info->lock[RX], flags); + msg = &info->msg[RX_PERIOD_DONE + MSG_TYPE_A_NUM]; + + if (r_msg->header.major == 1 && + r_msg->header.minor == 2) + msg->r_msg.param.buffer_tail = + r_msg->param.buffer_tail; + else + msg->r_msg.param.buffer_tail++; + + msg->r_msg.param.buffer_tail %= info->num_period[1]; + spin_unlock_irqrestore(&info->lock[RX], flags); + info->callback[RX](info->callback_param[RX]); + } + } + + /* TYPE B is response msg */ + if (r_msg->header.type == MSG_TYPE_B) { + memcpy(&info->r_msg, r_msg, sizeof(struct rpmsg_r_msg)); + complete(&info->cmd_complete); + } + + return 0; +} + +static int imx_audio_rpmsg_probe(struct rpmsg_device *rpdev) +{ + struct imx_audio_rpmsg *data; + int ret = 0; + + dev_info(&rpdev->dev, "new channel: 0x%x -> 0x%x!\n", + rpdev->src, rpdev->dst); + + data = devm_kzalloc(&rpdev->dev, sizeof(*data), GFP_KERNEL); + if (!data) + return -ENOMEM; + + dev_set_drvdata(&rpdev->dev, data); + + /* Register platform driver for rpmsg routine */ + data->rpmsg_pdev = platform_device_register_data(&rpdev->dev, + IMX_PCM_DRV_NAME, + PLATFORM_DEVID_NONE, + NULL, 0); + if (IS_ERR(data->rpmsg_pdev)) { + dev_err(&rpdev->dev, "failed to register rpmsg platform.\n"); + ret = PTR_ERR(data->rpmsg_pdev); + } + + return ret; +} + +static void imx_audio_rpmsg_remove(struct rpmsg_device *rpdev) +{ + struct imx_audio_rpmsg *data = dev_get_drvdata(&rpdev->dev); + + if (data->rpmsg_pdev) + platform_device_unregister(data->rpmsg_pdev); + + dev_info(&rpdev->dev, "audio rpmsg driver is removed\n"); +} + +static struct rpmsg_device_id imx_audio_rpmsg_id_table[] = { + { .name = "rpmsg-audio-channel" }, + { }, +}; + +static struct rpmsg_driver imx_audio_rpmsg_driver = { + .drv.name = "imx_audio_rpmsg", + .drv.owner = THIS_MODULE, + .id_table = imx_audio_rpmsg_id_table, + .probe = imx_audio_rpmsg_probe, + .callback = imx_audio_rpmsg_cb, + .remove = imx_audio_rpmsg_remove, +}; + +static int __init imx_audio_rpmsg_init(void) +{ + return register_rpmsg_driver(&imx_audio_rpmsg_driver); +} + +static void __exit imx_audio_rpmsg_exit(void) +{ + unregister_rpmsg_driver(&imx_audio_rpmsg_driver); +} +module_init(imx_audio_rpmsg_init); +module_exit(imx_audio_rpmsg_exit); + +MODULE_DESCRIPTION("Freescale SoC Audio RPMSG interface"); +MODULE_AUTHOR("Shengjiu Wang "); +MODULE_ALIAS("platform:imx_audio_rpmsg"); +MODULE_LICENSE("GPL v2");