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 63ffbf23d5SDaniel Baluta static int imx_dsp_probe(struct platform_device *pdev) 64ffbf23d5SDaniel Baluta { 65ffbf23d5SDaniel Baluta struct device *dev = &pdev->dev; 66ffbf23d5SDaniel Baluta struct imx_dsp_ipc *dsp_ipc; 67ffbf23d5SDaniel Baluta struct imx_dsp_chan *dsp_chan; 68ffbf23d5SDaniel Baluta struct mbox_client *cl; 69ffbf23d5SDaniel Baluta char *chan_name; 70ffbf23d5SDaniel Baluta int ret; 71ffbf23d5SDaniel Baluta int i, j; 72ffbf23d5SDaniel Baluta 73ffbf23d5SDaniel Baluta device_set_of_node_from_dev(&pdev->dev, pdev->dev.parent); 74ffbf23d5SDaniel Baluta 75ffbf23d5SDaniel Baluta dsp_ipc = devm_kzalloc(dev, sizeof(*dsp_ipc), GFP_KERNEL); 76ffbf23d5SDaniel Baluta if (!dsp_ipc) 77ffbf23d5SDaniel Baluta return -ENOMEM; 78ffbf23d5SDaniel Baluta 79ffbf23d5SDaniel Baluta for (i = 0; i < DSP_MU_CHAN_NUM; i++) { 80ffbf23d5SDaniel Baluta if (i < 2) 81ffbf23d5SDaniel Baluta chan_name = kasprintf(GFP_KERNEL, "txdb%d", i); 82ffbf23d5SDaniel Baluta else 83ffbf23d5SDaniel Baluta chan_name = kasprintf(GFP_KERNEL, "rxdb%d", i - 2); 84ffbf23d5SDaniel Baluta 85ffbf23d5SDaniel Baluta if (!chan_name) 86ffbf23d5SDaniel Baluta return -ENOMEM; 87ffbf23d5SDaniel Baluta 88ffbf23d5SDaniel Baluta dsp_chan = &dsp_ipc->chans[i]; 89ffbf23d5SDaniel Baluta cl = &dsp_chan->cl; 90ffbf23d5SDaniel Baluta cl->dev = dev; 91ffbf23d5SDaniel Baluta cl->tx_block = false; 92ffbf23d5SDaniel Baluta cl->knows_txdone = true; 93ffbf23d5SDaniel Baluta cl->rx_callback = imx_dsp_handle_rx; 94ffbf23d5SDaniel Baluta 95ffbf23d5SDaniel Baluta dsp_chan->ipc = dsp_ipc; 96ffbf23d5SDaniel Baluta dsp_chan->idx = i % 2; 97ffbf23d5SDaniel Baluta dsp_chan->ch = mbox_request_channel_byname(cl, chan_name); 98ffbf23d5SDaniel Baluta if (IS_ERR(dsp_chan->ch)) { 99ffbf23d5SDaniel Baluta ret = PTR_ERR(dsp_chan->ch); 100ffbf23d5SDaniel Baluta if (ret != -EPROBE_DEFER) 101ffbf23d5SDaniel Baluta dev_err(dev, "Failed to request mbox chan %s ret %d\n", 102ffbf23d5SDaniel Baluta chan_name, ret); 103ffbf23d5SDaniel Baluta goto out; 104ffbf23d5SDaniel Baluta } 105ffbf23d5SDaniel Baluta 106ffbf23d5SDaniel Baluta dev_dbg(dev, "request mbox chan %s\n", chan_name); 107ffbf23d5SDaniel Baluta /* chan_name is not used anymore by framework */ 108ffbf23d5SDaniel Baluta kfree(chan_name); 109ffbf23d5SDaniel Baluta } 110ffbf23d5SDaniel Baluta 111ffbf23d5SDaniel Baluta dsp_ipc->dev = dev; 112ffbf23d5SDaniel Baluta 113ffbf23d5SDaniel Baluta dev_set_drvdata(dev, dsp_ipc); 114ffbf23d5SDaniel Baluta 115ffbf23d5SDaniel Baluta dev_info(dev, "NXP i.MX DSP IPC initialized\n"); 116ffbf23d5SDaniel Baluta 117ffbf23d5SDaniel Baluta return devm_of_platform_populate(dev); 118ffbf23d5SDaniel Baluta out: 119ffbf23d5SDaniel Baluta kfree(chan_name); 120ffbf23d5SDaniel Baluta for (j = 0; j < i; j++) { 121ffbf23d5SDaniel Baluta dsp_chan = &dsp_ipc->chans[j]; 122ffbf23d5SDaniel Baluta mbox_free_channel(dsp_chan->ch); 123ffbf23d5SDaniel Baluta } 124ffbf23d5SDaniel Baluta 125ffbf23d5SDaniel Baluta return ret; 126ffbf23d5SDaniel Baluta } 127ffbf23d5SDaniel Baluta 128ffbf23d5SDaniel Baluta static int imx_dsp_remove(struct platform_device *pdev) 129ffbf23d5SDaniel Baluta { 130ffbf23d5SDaniel Baluta struct imx_dsp_chan *dsp_chan; 131ffbf23d5SDaniel Baluta struct imx_dsp_ipc *dsp_ipc; 132ffbf23d5SDaniel Baluta int i; 133ffbf23d5SDaniel Baluta 134ffbf23d5SDaniel Baluta dsp_ipc = dev_get_drvdata(&pdev->dev); 135ffbf23d5SDaniel Baluta 136ffbf23d5SDaniel Baluta for (i = 0; i < DSP_MU_CHAN_NUM; i++) { 137ffbf23d5SDaniel Baluta dsp_chan = &dsp_ipc->chans[i]; 138ffbf23d5SDaniel Baluta mbox_free_channel(dsp_chan->ch); 139ffbf23d5SDaniel Baluta } 140ffbf23d5SDaniel Baluta 141ffbf23d5SDaniel Baluta return 0; 142ffbf23d5SDaniel Baluta } 143ffbf23d5SDaniel Baluta 144ffbf23d5SDaniel Baluta static struct platform_driver imx_dsp_driver = { 145ffbf23d5SDaniel Baluta .driver = { 146ffbf23d5SDaniel Baluta .name = "imx-dsp", 147ffbf23d5SDaniel Baluta }, 148ffbf23d5SDaniel Baluta .probe = imx_dsp_probe, 149ffbf23d5SDaniel Baluta .remove = imx_dsp_remove, 150ffbf23d5SDaniel Baluta }; 151ffbf23d5SDaniel Baluta builtin_platform_driver(imx_dsp_driver); 152ffbf23d5SDaniel Baluta 153ffbf23d5SDaniel Baluta MODULE_AUTHOR("Daniel Baluta <daniel.baluta@nxp.com>"); 154ffbf23d5SDaniel Baluta MODULE_DESCRIPTION("IMX DSP IPC protocol driver"); 155ffbf23d5SDaniel Baluta MODULE_LICENSE("GPL v2"); 156