1// SPDX-License-Identifier: GPL-2.0 2/* 3 * Copyright 2020-2021 NXP 4 */ 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