320 lines · c
1// SPDX-License-Identifier: GPL-2.02/*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 12static 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 with31 * 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 55static 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 75static 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 message96 * @len : length of ipi message97 * @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 MSG100 * from VPU.101 */102static 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 147error:148 vpu->signaled = 1;149}150 151static 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 else166 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 182static 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 else194 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 202int 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 246int 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 else262 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 273int 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 296int vpu_dec_core(struct vdec_vpu_inst *vpu)297{298 return vcodec_send_ap_ipi(vpu, AP_IPIMSG_DEC_CORE);299}300 301int vpu_dec_end(struct vdec_vpu_inst *vpu)302{303 return vcodec_send_ap_ipi(vpu, AP_IPIMSG_DEC_END);304}305 306int vpu_dec_core_end(struct vdec_vpu_inst *vpu)307{308 return vcodec_send_ap_ipi(vpu, AP_IPIMSG_DEC_CORE_END);309}310 311int vpu_dec_deinit(struct vdec_vpu_inst *vpu)312{313 return vcodec_send_ap_ipi(vpu, AP_IPIMSG_DEC_DEINIT);314}315 316int vpu_dec_reset(struct vdec_vpu_inst *vpu)317{318 return vcodec_send_ap_ipi(vpu, AP_IPIMSG_DEC_RESET);319}320