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