1 // SPDX-License-Identifier: GPL-2.0+
2 // Copyright 2017-2020 NXP
4 #include <linux/module.h>
5 #include <linux/rpmsg.h>
6 #include "imx-pcm-rpmsg.h"
9 * struct imx_audio_rpmsg: private data
11 * @rpmsg_pdev: pointer of platform device
13 struct imx_audio_rpmsg {
14 struct platform_device *rpmsg_pdev;
17 static int imx_audio_rpmsg_cb(struct rpmsg_device *rpdev, void *data, int len,
20 struct imx_audio_rpmsg *rpmsg = dev_get_drvdata(&rpdev->dev);
21 struct rpmsg_r_msg *r_msg = (struct rpmsg_r_msg *)data;
22 struct rpmsg_info *info;
23 struct rpmsg_msg *msg;
26 if (!rpmsg->rpmsg_pdev)
29 info = platform_get_drvdata(rpmsg->rpmsg_pdev);
31 dev_dbg(&rpdev->dev, "get from%d: cmd:%d. %d\n",
32 src, r_msg->header.cmd, r_msg->param.resp);
34 switch (r_msg->header.type) {
36 /* TYPE C is notification from M core */
37 switch (r_msg->header.cmd) {
39 spin_lock_irqsave(&info->lock[TX], flags);
40 msg = &info->msg[TX_PERIOD_DONE + MSG_TYPE_A_NUM];
41 msg->r_msg.param.buffer_tail =
42 r_msg->param.buffer_tail;
43 msg->r_msg.param.buffer_tail %= info->num_period[TX];
44 spin_unlock_irqrestore(&info->lock[TX], flags);
45 info->callback[TX](info->callback_param[TX]);
48 spin_lock_irqsave(&info->lock[RX], flags);
49 msg = &info->msg[RX_PERIOD_DONE + MSG_TYPE_A_NUM];
50 msg->r_msg.param.buffer_tail =
51 r_msg->param.buffer_tail;
52 msg->r_msg.param.buffer_tail %= info->num_period[1];
53 spin_unlock_irqrestore(&info->lock[RX], flags);
54 info->callback[RX](info->callback_param[RX]);
57 dev_warn(&rpdev->dev, "unknown msg command\n");
62 /* TYPE B is response msg */
63 memcpy(&info->r_msg, r_msg, sizeof(struct rpmsg_r_msg));
64 complete(&info->cmd_complete);
67 dev_warn(&rpdev->dev, "unknown msg type\n");
74 static int imx_audio_rpmsg_probe(struct rpmsg_device *rpdev)
76 struct imx_audio_rpmsg *data;
79 dev_info(&rpdev->dev, "new channel: 0x%x -> 0x%x!\n",
80 rpdev->src, rpdev->dst);
82 data = devm_kzalloc(&rpdev->dev, sizeof(*data), GFP_KERNEL);
86 dev_set_drvdata(&rpdev->dev, data);
88 /* Register platform driver for rpmsg routine */
89 data->rpmsg_pdev = platform_device_register_data(&rpdev->dev,
93 if (IS_ERR(data->rpmsg_pdev)) {
94 dev_err(&rpdev->dev, "failed to register rpmsg platform.\n");
95 ret = PTR_ERR(data->rpmsg_pdev);
101 static void imx_audio_rpmsg_remove(struct rpmsg_device *rpdev)
103 struct imx_audio_rpmsg *data = dev_get_drvdata(&rpdev->dev);
105 if (data->rpmsg_pdev)
106 platform_device_unregister(data->rpmsg_pdev);
108 dev_info(&rpdev->dev, "audio rpmsg driver is removed\n");
111 static struct rpmsg_device_id imx_audio_rpmsg_id_table[] = {
112 { .name = "rpmsg-audio-channel" },
116 static struct rpmsg_driver imx_audio_rpmsg_driver = {
117 .drv.name = "imx_audio_rpmsg",
118 .drv.owner = THIS_MODULE,
119 .id_table = imx_audio_rpmsg_id_table,
120 .probe = imx_audio_rpmsg_probe,
121 .callback = imx_audio_rpmsg_cb,
122 .remove = imx_audio_rpmsg_remove,
125 module_rpmsg_driver(imx_audio_rpmsg_driver);
127 MODULE_DESCRIPTION("Freescale SoC Audio RPMSG interface");
128 MODULE_AUTHOR("Shengjiu Wang <shengjiu.wang@nxp.com>");
129 MODULE_ALIAS("platform:imx_audio_rpmsg");
130 MODULE_LICENSE("GPL v2");