1ffbf23d5SDaniel Baluta // SPDX-License-Identifier: GPL-2.0+ 2ffbf23d5SDaniel Baluta /* 3ffbf23d5SDaniel Baluta * Copyright 2019 NXP 4ffbf23d5SDaniel Baluta * Author: Daniel Baluta <daniel.baluta@nxp.com> 5ffbf23d5SDaniel Baluta * 6ffbf23d5SDaniel Baluta * Implementation of the DSP IPC interface (host side) 7ffbf23d5SDaniel Baluta */ 8ffbf23d5SDaniel Baluta 9ffbf23d5SDaniel Baluta #include <linux/firmware/imx/dsp.h> 10ffbf23d5SDaniel Baluta #include <linux/kernel.h> 11ffbf23d5SDaniel Baluta #include <linux/mailbox_client.h> 12ffbf23d5SDaniel Baluta #include <linux/module.h> 13ffbf23d5SDaniel Baluta #include <linux/of_platform.h> 14ffbf23d5SDaniel Baluta #include <linux/platform_device.h> 15ffbf23d5SDaniel Baluta #include <linux/slab.h> 16ffbf23d5SDaniel Baluta 17ffbf23d5SDaniel Baluta /* 18ffbf23d5SDaniel Baluta * imx_dsp_ring_doorbell - triggers an interrupt on the other side (DSP) 19ffbf23d5SDaniel Baluta * 20ffbf23d5SDaniel Baluta * @dsp: DSP IPC handle 21ffbf23d5SDaniel Baluta * @chan_idx: index of the channel where to trigger the interrupt 22ffbf23d5SDaniel Baluta * 23ffbf23d5SDaniel Baluta * Returns non-negative value for success, negative value for error 24ffbf23d5SDaniel Baluta */ 25ffbf23d5SDaniel Baluta int imx_dsp_ring_doorbell(struct imx_dsp_ipc *ipc, unsigned int idx) 26ffbf23d5SDaniel Baluta { 27ffbf23d5SDaniel Baluta int ret; 28ffbf23d5SDaniel Baluta struct imx_dsp_chan *dsp_chan; 29ffbf23d5SDaniel Baluta 30ffbf23d5SDaniel Baluta if (idx >= DSP_MU_CHAN_NUM) 31ffbf23d5SDaniel Baluta return -EINVAL; 32ffbf23d5SDaniel Baluta 33ffbf23d5SDaniel Baluta dsp_chan = &ipc->chans[idx]; 34ffbf23d5SDaniel Baluta ret = mbox_send_message(dsp_chan->ch, NULL); 35ffbf23d5SDaniel Baluta if (ret < 0) 36ffbf23d5SDaniel Baluta return ret; 37ffbf23d5SDaniel Baluta 38ffbf23d5SDaniel Baluta return 0; 39ffbf23d5SDaniel Baluta } 40ffbf23d5SDaniel Baluta EXPORT_SYMBOL(imx_dsp_ring_doorbell); 41ffbf23d5SDaniel Baluta 42ffbf23d5SDaniel Baluta /* 43ffbf23d5SDaniel Baluta * imx_dsp_handle_rx - rx callback used by imx mailbox 44ffbf23d5SDaniel Baluta * 45ffbf23d5SDaniel Baluta * @c: mbox client 46ffbf23d5SDaniel Baluta * @msg: message received 47ffbf23d5SDaniel Baluta * 48ffbf23d5SDaniel Baluta * Users of DSP IPC will need to privde handle_reply and handle_request 49ffbf23d5SDaniel Baluta * callbacks. 50ffbf23d5SDaniel Baluta */ 51ffbf23d5SDaniel Baluta static void imx_dsp_handle_rx(struct mbox_client *c, void *msg) 52ffbf23d5SDaniel Baluta { 53ffbf23d5SDaniel Baluta struct imx_dsp_chan *chan = container_of(c, struct imx_dsp_chan, cl); 54ffbf23d5SDaniel Baluta 55ffbf23d5SDaniel Baluta if (chan->idx == 0) { 56ffbf23d5SDaniel Baluta chan->ipc->ops->handle_reply(chan->ipc); 57ffbf23d5SDaniel Baluta } else { 58ffbf23d5SDaniel Baluta chan->ipc->ops->handle_request(chan->ipc); 59ffbf23d5SDaniel Baluta imx_dsp_ring_doorbell(chan->ipc, 1); 60ffbf23d5SDaniel Baluta } 61ffbf23d5SDaniel Baluta } 62ffbf23d5SDaniel Baluta 634d3f4f03SDaniel Baluta static int imx_dsp_setup_channels(struct imx_dsp_ipc *dsp_ipc) 64ffbf23d5SDaniel Baluta { 654d3f4f03SDaniel Baluta struct device *dev = dsp_ipc->dev; 66ffbf23d5SDaniel Baluta struct imx_dsp_chan *dsp_chan; 67ffbf23d5SDaniel Baluta struct mbox_client *cl; 68ffbf23d5SDaniel Baluta char *chan_name; 69ffbf23d5SDaniel Baluta int ret; 70ffbf23d5SDaniel Baluta int i, j; 71ffbf23d5SDaniel Baluta 72ffbf23d5SDaniel Baluta for (i = 0; i < DSP_MU_CHAN_NUM; i++) { 73ffbf23d5SDaniel Baluta if (i < 2) 74ffbf23d5SDaniel Baluta chan_name = kasprintf(GFP_KERNEL, "txdb%d", i); 75ffbf23d5SDaniel Baluta else 76ffbf23d5SDaniel Baluta chan_name = kasprintf(GFP_KERNEL, "rxdb%d", i - 2); 77ffbf23d5SDaniel Baluta 78ffbf23d5SDaniel Baluta if (!chan_name) 79ffbf23d5SDaniel Baluta return -ENOMEM; 80ffbf23d5SDaniel Baluta 81ffbf23d5SDaniel Baluta dsp_chan = &dsp_ipc->chans[i]; 82*04632698SDaniel Baluta dsp_chan->name = chan_name; 83ffbf23d5SDaniel Baluta cl = &dsp_chan->cl; 84ffbf23d5SDaniel Baluta cl->dev = dev; 85ffbf23d5SDaniel Baluta cl->tx_block = false; 86ffbf23d5SDaniel Baluta cl->knows_txdone = true; 87ffbf23d5SDaniel Baluta cl->rx_callback = imx_dsp_handle_rx; 88ffbf23d5SDaniel Baluta 89ffbf23d5SDaniel Baluta dsp_chan->ipc = dsp_ipc; 90ffbf23d5SDaniel Baluta dsp_chan->idx = i % 2; 91ffbf23d5SDaniel Baluta dsp_chan->ch = mbox_request_channel_byname(cl, chan_name); 92ffbf23d5SDaniel Baluta if (IS_ERR(dsp_chan->ch)) { 93ffbf23d5SDaniel Baluta ret = PTR_ERR(dsp_chan->ch); 94ffbf23d5SDaniel Baluta if (ret != -EPROBE_DEFER) 95ffbf23d5SDaniel Baluta dev_err(dev, "Failed to request mbox chan %s ret %d\n", 96ffbf23d5SDaniel Baluta chan_name, ret); 97ffbf23d5SDaniel Baluta goto out; 98ffbf23d5SDaniel Baluta } 99ffbf23d5SDaniel Baluta 100ffbf23d5SDaniel Baluta dev_dbg(dev, "request mbox chan %s\n", chan_name); 101ffbf23d5SDaniel Baluta } 102ffbf23d5SDaniel Baluta 1030e4e8cc3SDaniel Baluta return 0; 104ffbf23d5SDaniel Baluta out: 105ffbf23d5SDaniel Baluta for (j = 0; j < i; j++) { 106ffbf23d5SDaniel Baluta dsp_chan = &dsp_ipc->chans[j]; 107ffbf23d5SDaniel Baluta mbox_free_channel(dsp_chan->ch); 108*04632698SDaniel Baluta kfree(dsp_chan->name); 109ffbf23d5SDaniel Baluta } 110ffbf23d5SDaniel Baluta 111ffbf23d5SDaniel Baluta return ret; 112ffbf23d5SDaniel Baluta } 113ffbf23d5SDaniel Baluta 1144d3f4f03SDaniel Baluta static int imx_dsp_probe(struct platform_device *pdev) 1154d3f4f03SDaniel Baluta { 1164d3f4f03SDaniel Baluta struct device *dev = &pdev->dev; 1174d3f4f03SDaniel Baluta struct imx_dsp_ipc *dsp_ipc; 1184d3f4f03SDaniel Baluta int ret; 1194d3f4f03SDaniel Baluta 1204d3f4f03SDaniel Baluta device_set_of_node_from_dev(&pdev->dev, pdev->dev.parent); 1214d3f4f03SDaniel Baluta 1224d3f4f03SDaniel Baluta dsp_ipc = devm_kzalloc(dev, sizeof(*dsp_ipc), GFP_KERNEL); 1234d3f4f03SDaniel Baluta if (!dsp_ipc) 1244d3f4f03SDaniel Baluta return -ENOMEM; 1254d3f4f03SDaniel Baluta 1264d3f4f03SDaniel Baluta dsp_ipc->dev = dev; 1274d3f4f03SDaniel Baluta dev_set_drvdata(dev, dsp_ipc); 1284d3f4f03SDaniel Baluta 1294d3f4f03SDaniel Baluta ret = imx_dsp_setup_channels(dsp_ipc); 1304d3f4f03SDaniel Baluta if (ret < 0) 1314d3f4f03SDaniel Baluta return ret; 1324d3f4f03SDaniel Baluta 1334d3f4f03SDaniel Baluta dev_info(dev, "NXP i.MX DSP IPC initialized\n"); 1344d3f4f03SDaniel Baluta 1354d3f4f03SDaniel Baluta return 0; 1364d3f4f03SDaniel Baluta } 1374d3f4f03SDaniel Baluta 138ffbf23d5SDaniel Baluta static int imx_dsp_remove(struct platform_device *pdev) 139ffbf23d5SDaniel Baluta { 140ffbf23d5SDaniel Baluta struct imx_dsp_chan *dsp_chan; 141ffbf23d5SDaniel Baluta struct imx_dsp_ipc *dsp_ipc; 142ffbf23d5SDaniel Baluta int i; 143ffbf23d5SDaniel Baluta 144ffbf23d5SDaniel Baluta dsp_ipc = dev_get_drvdata(&pdev->dev); 145ffbf23d5SDaniel Baluta 146ffbf23d5SDaniel Baluta for (i = 0; i < DSP_MU_CHAN_NUM; i++) { 147ffbf23d5SDaniel Baluta dsp_chan = &dsp_ipc->chans[i]; 148ffbf23d5SDaniel Baluta mbox_free_channel(dsp_chan->ch); 149*04632698SDaniel Baluta kfree(dsp_chan->name); 150ffbf23d5SDaniel Baluta } 151ffbf23d5SDaniel Baluta 152ffbf23d5SDaniel Baluta return 0; 153ffbf23d5SDaniel Baluta } 154ffbf23d5SDaniel Baluta 155ffbf23d5SDaniel Baluta static struct platform_driver imx_dsp_driver = { 156ffbf23d5SDaniel Baluta .driver = { 157ffbf23d5SDaniel Baluta .name = "imx-dsp", 158ffbf23d5SDaniel Baluta }, 159ffbf23d5SDaniel Baluta .probe = imx_dsp_probe, 160ffbf23d5SDaniel Baluta .remove = imx_dsp_remove, 161ffbf23d5SDaniel Baluta }; 162ffbf23d5SDaniel Baluta builtin_platform_driver(imx_dsp_driver); 163ffbf23d5SDaniel Baluta 164ffbf23d5SDaniel Baluta MODULE_AUTHOR("Daniel Baluta <daniel.baluta@nxp.com>"); 165ffbf23d5SDaniel Baluta MODULE_DESCRIPTION("IMX DSP IPC protocol driver"); 166ffbf23d5SDaniel Baluta MODULE_LICENSE("GPL v2"); 167