116 lines · c
1// SPDX-License-Identifier: GPL-2.02/*3 * Copyright 2020-2021 NXP4 */5 6#include <linux/init.h>7#include <linux/interconnect.h>8#include <linux/ioctl.h>9#include <linux/list.h>10#include <linux/kernel.h>11#include <linux/module.h>12#include <linux/platform_device.h>13#include "vpu.h"14#include "vpu_mbox.h"15#include "vpu_msgs.h"16 17static void vpu_mbox_rx_callback(struct mbox_client *cl, void *msg)18{19 struct vpu_mbox *rx = container_of(cl, struct vpu_mbox, cl);20 struct vpu_core *core = container_of(rx, struct vpu_core, rx);21 22 vpu_isr(core, *(u32 *)msg);23}24 25static int vpu_mbox_request_channel(struct device *dev, struct vpu_mbox *mbox)26{27 struct mbox_chan *ch;28 struct mbox_client *cl;29 30 if (!dev || !mbox)31 return -EINVAL;32 if (mbox->ch)33 return 0;34 35 cl = &mbox->cl;36 cl->dev = dev;37 if (mbox->block) {38 cl->tx_block = true;39 cl->tx_tout = 1000;40 } else {41 cl->tx_block = false;42 }43 cl->knows_txdone = false;44 cl->rx_callback = vpu_mbox_rx_callback;45 46 ch = mbox_request_channel_byname(cl, mbox->name);47 if (IS_ERR(ch))48 return dev_err_probe(dev, PTR_ERR(ch),49 "Failed to request mbox chan %s\n",50 mbox->name);51 52 mbox->ch = ch;53 return 0;54}55 56int vpu_mbox_init(struct vpu_core *core)57{58 scnprintf(core->tx_type.name, sizeof(core->tx_type.name) - 1, "tx0");59 core->tx_type.block = true;60 61 scnprintf(core->tx_data.name, sizeof(core->tx_data.name) - 1, "tx1");62 core->tx_data.block = false;63 64 scnprintf(core->rx.name, sizeof(core->rx.name) - 1, "rx");65 core->rx.block = true;66 67 return 0;68}69 70int vpu_mbox_request(struct vpu_core *core)71{72 int ret;73 74 ret = vpu_mbox_request_channel(core->dev, &core->tx_type);75 if (ret)76 goto error;77 ret = vpu_mbox_request_channel(core->dev, &core->tx_data);78 if (ret)79 goto error;80 ret = vpu_mbox_request_channel(core->dev, &core->rx);81 if (ret)82 goto error;83 84 dev_dbg(core->dev, "%s request mbox\n", vpu_core_type_desc(core->type));85 return 0;86error:87 vpu_mbox_free(core);88 return ret;89}90 91void vpu_mbox_free(struct vpu_core *core)92{93 mbox_free_channel(core->tx_type.ch);94 mbox_free_channel(core->tx_data.ch);95 mbox_free_channel(core->rx.ch);96 core->tx_type.ch = NULL;97 core->tx_data.ch = NULL;98 core->rx.ch = NULL;99 dev_dbg(core->dev, "%s free mbox\n", vpu_core_type_desc(core->type));100}101 102void vpu_mbox_send_type(struct vpu_core *core, u32 type)103{104 mbox_send_message(core->tx_type.ch, &type);105}106 107void vpu_mbox_send_msg(struct vpu_core *core, u32 type, u32 data)108{109 mbox_send_message(core->tx_data.ch, &data);110 mbox_send_message(core->tx_type.ch, &type);111}112 113void vpu_mbox_enable_rx(struct vpu_dev *dev)114{115}116