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