1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * Copyright (c) 2016 MediaTek Inc.
4  * Author: PC Chen <pc.chen@mediatek.com>
5  */
6 
7 #include "mtk_vcodec_dec_drv.h"
8 #include "vdec_drv_if.h"
9 #include "vdec_ipi_msg.h"
10 #include "vdec_vpu_if.h"
11 
handle_init_ack_msg(const struct vdec_vpu_ipi_init_ack * msg)12 static void handle_init_ack_msg(const struct vdec_vpu_ipi_init_ack *msg)
13 {
14 	struct vdec_vpu_inst *vpu = (struct vdec_vpu_inst *)
15 					(unsigned long)msg->ap_inst_addr;
16 
17 	mtk_vdec_debug(vpu->ctx, "+ ap_inst_addr = 0x%llx", msg->ap_inst_addr);
18 
19 	/* mapping VPU address to kernel virtual address */
20 	/* the content in vsi is initialized to 0 in VPU */
21 	vpu->vsi = mtk_vcodec_fw_map_dm_addr(vpu->ctx->dev->fw_handler,
22 					     msg->vpu_inst_addr);
23 	vpu->inst_addr = msg->vpu_inst_addr;
24 
25 	mtk_vdec_debug(vpu->ctx, "- vpu_inst_addr = 0x%x", vpu->inst_addr);
26 
27 	/* Set default ABI version if dealing with unversioned firmware. */
28 	vpu->fw_abi_version = 0;
29 	/*
30 	 * Instance ID is only used if ABI version >= 2. Initialize it with
31 	 * garbage by default.
32 	 */
33 	vpu->inst_id = 0xdeadbeef;
34 
35 	/* VPU firmware does not contain a version field. */
36 	if (mtk_vcodec_fw_get_type(vpu->ctx->dev->fw_handler) == VPU)
37 		return;
38 
39 	/* Check firmware version. */
40 	vpu->fw_abi_version = msg->vdec_abi_version;
41 	mtk_vdec_debug(vpu->ctx, "firmware version 0x%x\n", vpu->fw_abi_version);
42 	switch (vpu->fw_abi_version) {
43 	case 1:
44 		break;
45 	case 2:
46 		vpu->inst_id = msg->inst_id;
47 		break;
48 	default:
49 		mtk_vdec_err(vpu->ctx, "unhandled firmware version 0x%x\n", vpu->fw_abi_version);
50 		vpu->failure = 1;
51 		break;
52 	}
53 }
54 
handle_get_param_msg_ack(const struct vdec_vpu_ipi_get_param_ack * msg)55 static void handle_get_param_msg_ack(const struct vdec_vpu_ipi_get_param_ack *msg)
56 {
57 	struct vdec_vpu_inst *vpu = (struct vdec_vpu_inst *)
58 					(unsigned long)msg->ap_inst_addr;
59 
60 	mtk_vdec_debug(vpu->ctx, "+ ap_inst_addr = 0x%llx", msg->ap_inst_addr);
61 
62 	/* param_type is enum vdec_get_param_type */
63 	switch (msg->param_type) {
64 	case GET_PARAM_PIC_INFO:
65 		vpu->fb_sz[0] = msg->data[0];
66 		vpu->fb_sz[1] = msg->data[1];
67 		break;
68 	default:
69 		mtk_vdec_err(vpu->ctx, "invalid get param type=%d", msg->param_type);
70 		vpu->failure = 1;
71 		break;
72 	}
73 }
74 
vpu_dec_check_ap_inst(struct mtk_vcodec_dec_dev * dec_dev,struct vdec_vpu_inst * vpu)75 static bool vpu_dec_check_ap_inst(struct mtk_vcodec_dec_dev *dec_dev, struct vdec_vpu_inst *vpu)
76 {
77 	struct mtk_vcodec_dec_ctx *ctx;
78 	int ret = false;
79 
80 	mutex_lock(&dec_dev->dev_ctx_lock);
81 	list_for_each_entry(ctx, &dec_dev->ctx_list, list) {
82 		if (!IS_ERR_OR_NULL(ctx) && ctx->vpu_inst == vpu) {
83 			ret = true;
84 			break;
85 		}
86 	}
87 	mutex_unlock(&dec_dev->dev_ctx_lock);
88 
89 	return ret;
90 }
91 
92 /*
93  * vpu_dec_ipi_handler - Handler for VPU ipi message.
94  *
95  * @data: ipi message
96  * @len : length of ipi message
97  * @priv: callback private data which is passed by decoder when register.
98  *
99  * This function runs in interrupt context and it means there's an IPI MSG
100  * from VPU.
101  */
vpu_dec_ipi_handler(void * data,unsigned int len,void * priv)102 static void vpu_dec_ipi_handler(void *data, unsigned int len, void *priv)
103 {
104 	struct mtk_vcodec_dec_dev *dec_dev;
105 	const struct vdec_vpu_ipi_ack *msg = data;
106 	struct vdec_vpu_inst *vpu;
107 
108 	dec_dev = (struct mtk_vcodec_dec_dev *)priv;
109 	vpu = (struct vdec_vpu_inst *)(unsigned long)msg->ap_inst_addr;
110 	if (!priv || !vpu) {
111 		pr_err(MTK_DBG_V4L2_STR "ap_inst_addr is NULL, did the SCP hang or crash?");
112 		return;
113 	}
114 
115 	if (!vpu_dec_check_ap_inst(dec_dev, vpu) || msg->msg_id < VPU_IPIMSG_DEC_INIT_ACK ||
116 	    msg->msg_id > VPU_IPIMSG_DEC_GET_PARAM_ACK) {
117 		mtk_v4l2_vdec_err(vpu->ctx, "vdec msg id not correctly => 0x%x", msg->msg_id);
118 		vpu->failure = -EINVAL;
119 		goto error;
120 	}
121 
122 	vpu->failure = msg->status;
123 	if (msg->status != 0)
124 		goto error;
125 
126 	switch (msg->msg_id) {
127 	case VPU_IPIMSG_DEC_INIT_ACK:
128 		handle_init_ack_msg(data);
129 		break;
130 
131 	case VPU_IPIMSG_DEC_START_ACK:
132 	case VPU_IPIMSG_DEC_END_ACK:
133 	case VPU_IPIMSG_DEC_DEINIT_ACK:
134 	case VPU_IPIMSG_DEC_RESET_ACK:
135 	case VPU_IPIMSG_DEC_CORE_ACK:
136 	case VPU_IPIMSG_DEC_CORE_END_ACK:
137 		break;
138 
139 	case VPU_IPIMSG_DEC_GET_PARAM_ACK:
140 		handle_get_param_msg_ack(data);
141 		break;
142 	default:
143 		mtk_vdec_err(vpu->ctx, "invalid msg=%X", msg->msg_id);
144 		break;
145 	}
146 
147 error:
148 	vpu->signaled = 1;
149 }
150 
vcodec_vpu_send_msg(struct vdec_vpu_inst * vpu,void * msg,int len)151 static int vcodec_vpu_send_msg(struct vdec_vpu_inst *vpu, void *msg, int len)
152 {
153 	int err, id, msgid;
154 
155 	msgid = *(uint32_t *)msg;
156 	mtk_vdec_debug(vpu->ctx, "id=%X", msgid);
157 
158 	vpu->failure = 0;
159 	vpu->signaled = 0;
160 
161 	if (vpu->ctx->dev->vdec_pdata->hw_arch == MTK_VDEC_LAT_SINGLE_CORE) {
162 		if (msgid == AP_IPIMSG_DEC_CORE ||
163 		    msgid == AP_IPIMSG_DEC_CORE_END)
164 			id = vpu->core_id;
165 		else
166 			id = vpu->id;
167 	} else {
168 		id = vpu->id;
169 	}
170 
171 	err = mtk_vcodec_fw_ipi_send(vpu->ctx->dev->fw_handler, id, msg,
172 				     len, 2000);
173 	if (err) {
174 		mtk_vdec_err(vpu->ctx, "send fail vpu_id=%d msg_id=%X status=%d",
175 			     id, msgid, err);
176 		return err;
177 	}
178 
179 	return vpu->failure;
180 }
181 
vcodec_send_ap_ipi(struct vdec_vpu_inst * vpu,unsigned int msg_id)182 static int vcodec_send_ap_ipi(struct vdec_vpu_inst *vpu, unsigned int msg_id)
183 {
184 	struct vdec_ap_ipi_cmd msg;
185 	int err = 0;
186 
187 	mtk_vdec_debug(vpu->ctx, "+ id=%X", msg_id);
188 
189 	memset(&msg, 0, sizeof(msg));
190 	msg.msg_id = msg_id;
191 	if (vpu->fw_abi_version < 2)
192 		msg.vpu_inst_addr = vpu->inst_addr;
193 	else
194 		msg.inst_id = vpu->inst_id;
195 	msg.codec_type = vpu->codec_type;
196 
197 	err = vcodec_vpu_send_msg(vpu, &msg, sizeof(msg));
198 	mtk_vdec_debug(vpu->ctx, "- id=%X ret=%d", msg_id, err);
199 	return err;
200 }
201 
vpu_dec_init(struct vdec_vpu_inst * vpu)202 int vpu_dec_init(struct vdec_vpu_inst *vpu)
203 {
204 	struct vdec_ap_ipi_init msg;
205 	int err;
206 
207 	init_waitqueue_head(&vpu->wq);
208 	vpu->handler = vpu_dec_ipi_handler;
209 	vpu->ctx->vpu_inst = vpu;
210 
211 	err = mtk_vcodec_fw_ipi_register(vpu->ctx->dev->fw_handler, vpu->id,
212 					 vpu->handler, "vdec", vpu->ctx->dev);
213 	if (err) {
214 		mtk_vdec_err(vpu->ctx, "vpu_ipi_register fail status=%d", err);
215 		return err;
216 	}
217 
218 	if (vpu->ctx->dev->vdec_pdata->hw_arch == MTK_VDEC_LAT_SINGLE_CORE) {
219 		err = mtk_vcodec_fw_ipi_register(vpu->ctx->dev->fw_handler,
220 						 vpu->core_id, vpu->handler,
221 						 "vdec", vpu->ctx->dev);
222 		if (err) {
223 			mtk_vdec_err(vpu->ctx, "vpu_ipi_register core fail status=%d", err);
224 			return err;
225 		}
226 	}
227 
228 	memset(&msg, 0, sizeof(msg));
229 	msg.msg_id = AP_IPIMSG_DEC_INIT;
230 	msg.ap_inst_addr = (unsigned long)vpu;
231 	msg.codec_type = vpu->codec_type;
232 
233 	mtk_vdec_debug(vpu->ctx, "vdec_inst=%p", vpu);
234 
235 	err = vcodec_vpu_send_msg(vpu, (void *)&msg, sizeof(msg));
236 
237 	if (IS_ERR_OR_NULL(vpu->vsi)) {
238 		mtk_vdec_err(vpu->ctx, "invalid vdec vsi, status=%d", err);
239 		return -EINVAL;
240 	}
241 
242 	mtk_vdec_debug(vpu->ctx, "- ret=%d", err);
243 	return err;
244 }
245 
vpu_dec_start(struct vdec_vpu_inst * vpu,uint32_t * data,unsigned int len)246 int vpu_dec_start(struct vdec_vpu_inst *vpu, uint32_t *data, unsigned int len)
247 {
248 	struct vdec_ap_ipi_dec_start msg;
249 	int i;
250 	int err = 0;
251 
252 	if (len > ARRAY_SIZE(msg.data)) {
253 		mtk_vdec_err(vpu->ctx, "invalid len = %d\n", len);
254 		return -EINVAL;
255 	}
256 
257 	memset(&msg, 0, sizeof(msg));
258 	msg.msg_id = AP_IPIMSG_DEC_START;
259 	if (vpu->fw_abi_version < 2)
260 		msg.vpu_inst_addr = vpu->inst_addr;
261 	else
262 		msg.inst_id = vpu->inst_id;
263 
264 	for (i = 0; i < len; i++)
265 		msg.data[i] = data[i];
266 	msg.codec_type = vpu->codec_type;
267 
268 	err = vcodec_vpu_send_msg(vpu, (void *)&msg, sizeof(msg));
269 	mtk_vdec_debug(vpu->ctx, "- ret=%d", err);
270 	return err;
271 }
272 
vpu_dec_get_param(struct vdec_vpu_inst * vpu,uint32_t * data,unsigned int len,unsigned int param_type)273 int vpu_dec_get_param(struct vdec_vpu_inst *vpu, uint32_t *data,
274 		      unsigned int len, unsigned int param_type)
275 {
276 	struct vdec_ap_ipi_get_param msg;
277 	int err;
278 
279 	if (len > ARRAY_SIZE(msg.data)) {
280 		mtk_vdec_err(vpu->ctx, "invalid len = %d\n", len);
281 		return -EINVAL;
282 	}
283 
284 	memset(&msg, 0, sizeof(msg));
285 	msg.msg_id = AP_IPIMSG_DEC_GET_PARAM;
286 	msg.inst_id = vpu->inst_id;
287 	memcpy(msg.data, data, sizeof(unsigned int) * len);
288 	msg.param_type = param_type;
289 	msg.codec_type = vpu->codec_type;
290 
291 	err = vcodec_vpu_send_msg(vpu, (void *)&msg, sizeof(msg));
292 	mtk_vdec_debug(vpu->ctx, "- ret=%d", err);
293 	return err;
294 }
295 
vpu_dec_core(struct vdec_vpu_inst * vpu)296 int vpu_dec_core(struct vdec_vpu_inst *vpu)
297 {
298 	return vcodec_send_ap_ipi(vpu, AP_IPIMSG_DEC_CORE);
299 }
300 
vpu_dec_end(struct vdec_vpu_inst * vpu)301 int vpu_dec_end(struct vdec_vpu_inst *vpu)
302 {
303 	return vcodec_send_ap_ipi(vpu, AP_IPIMSG_DEC_END);
304 }
305 
vpu_dec_core_end(struct vdec_vpu_inst * vpu)306 int vpu_dec_core_end(struct vdec_vpu_inst *vpu)
307 {
308 	return vcodec_send_ap_ipi(vpu, AP_IPIMSG_DEC_CORE_END);
309 }
310 
vpu_dec_deinit(struct vdec_vpu_inst * vpu)311 int vpu_dec_deinit(struct vdec_vpu_inst *vpu)
312 {
313 	return vcodec_send_ap_ipi(vpu, AP_IPIMSG_DEC_DEINIT);
314 }
315 
vpu_dec_reset(struct vdec_vpu_inst * vpu)316 int vpu_dec_reset(struct vdec_vpu_inst *vpu)
317 {
318 	return vcodec_send_ap_ipi(vpu, AP_IPIMSG_DEC_RESET);
319 }
320