drivers/media/platform/mtk-vcodec/vdec_vpu_if.c

   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_drv.h"
   8 #include "mtk_vcodec_util.h"
   9 #include "vdec_ipi_msg.h"
  10 #include "vdec_vpu_if.h"
  11
  12 static void handle_init_ack_msg(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_vcodec_debug(vpu, "+ 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 = vpu_mapping_dm_addr(vpu->dev, msg->vpu_inst_addr);
  22         vpu->inst_addr = msg->vpu_inst_addr;
  23
  24         mtk_vcodec_debug(vpu, "- vpu_inst_addr = 0x%x", vpu->inst_addr);
  25 }
  26
  27 /*
  28  * vpu_dec_ipi_handler - Handler for VPU ipi message.
  29  *
  30  * @data: ipi message
  31  * @len : length of ipi message
  32  * @priv: callback private data which is passed by decoder when register.
  33  *
  34  * This function runs in interrupt context and it means there's an IPI MSG
  35  * from VPU.
  36  */
  37 static void vpu_dec_ipi_handler(void *data, unsigned int len, void *priv)
  38 {
  39         struct vdec_vpu_ipi_ack *msg = data;
  40         struct vdec_vpu_inst *vpu = (struct vdec_vpu_inst *)
  41                                         (unsigned long)msg->ap_inst_addr;
  42
  43         mtk_vcodec_debug(vpu, "+ id=%X", msg->msg_id);
  44
  45         if (msg->status == 0) {
  46                 switch (msg->msg_id) {
  47                 case VPU_IPIMSG_DEC_INIT_ACK:
  48                         handle_init_ack_msg(data);
  49                         break;
  50
  51                 case VPU_IPIMSG_DEC_START_ACK:
  52                 case VPU_IPIMSG_DEC_END_ACK:
  53                 case VPU_IPIMSG_DEC_DEINIT_ACK:
  54                 case VPU_IPIMSG_DEC_RESET_ACK:
  55                         break;
  56
  57                 default:
  58                         mtk_vcodec_err(vpu, "invalid msg=%X", msg->msg_id);
  59                         break;
  60                 }
  61         }
  62
  63         mtk_vcodec_debug(vpu, "- id=%X", msg->msg_id);
  64         vpu->failure = msg->status;
  65         vpu->signaled = 1;
  66 }
  67
  68 static int vcodec_vpu_send_msg(struct vdec_vpu_inst *vpu, void *msg, int len)
  69 {
  70         int err;
  71
  72         mtk_vcodec_debug(vpu, "id=%X", *(uint32_t *)msg);
  73
  74         vpu->failure = 0;
  75         vpu->signaled = 0;
  76
  77         err = vpu_ipi_send(vpu->dev, vpu->id, msg, len);
  78         if (err) {
  79                 mtk_vcodec_err(vpu, "send fail vpu_id=%d msg_id=%X status=%d",
  80                                vpu->id, *(uint32_t *)msg, err);
  81                 return err;
  82         }
  83
  84         return vpu->failure;
  85 }
  86
  87 static int vcodec_send_ap_ipi(struct vdec_vpu_inst *vpu, unsigned int msg_id)
  88 {
  89         struct vdec_ap_ipi_cmd msg;
  90         int err = 0;
  91
  92         mtk_vcodec_debug(vpu, "+ id=%X", msg_id);
  93
  94         memset(&msg, 0, sizeof(msg));
  95         msg.msg_id = msg_id;
  96         msg.vpu_inst_addr = vpu->inst_addr;
  97
  98         err = vcodec_vpu_send_msg(vpu, &msg, sizeof(msg));
  99         mtk_vcodec_debug(vpu, "- id=%X ret=%d", msg_id, err);
 100         return err;
 101 }
 102
 103 int vpu_dec_init(struct vdec_vpu_inst *vpu)
 104 {
 105         struct vdec_ap_ipi_init msg;
 106         int err;
 107
 108         mtk_vcodec_debug_enter(vpu);
 109
 110         init_waitqueue_head(&vpu->wq);
 111         vpu->handler = vpu_dec_ipi_handler;
 112
 113         err = vpu_ipi_register(vpu->dev, vpu->id, vpu->handler, "vdec", NULL);
 114         if (err != 0) {
 115                 mtk_vcodec_err(vpu, "vpu_ipi_register fail status=%d", err);
 116                 return err;
 117         }
 118
 119         memset(&msg, 0, sizeof(msg));
 120         msg.msg_id = AP_IPIMSG_DEC_INIT;
 121         msg.ap_inst_addr = (unsigned long)vpu;
 122
 123         mtk_vcodec_debug(vpu, "vdec_inst=%p", vpu);
 124
 125         err = vcodec_vpu_send_msg(vpu, (void *)&msg, sizeof(msg));
 126         mtk_vcodec_debug(vpu, "- ret=%d", err);
 127         return err;
 128 }
 129
 130 int vpu_dec_start(struct vdec_vpu_inst *vpu, uint32_t *data, unsigned int len)
 131 {
 132         struct vdec_ap_ipi_dec_start msg;
 133         int i;
 134         int err = 0;
 135
 136         mtk_vcodec_debug_enter(vpu);
 137
 138         if (len > ARRAY_SIZE(msg.data)) {
 139                 mtk_vcodec_err(vpu, "invalid len = %d\n", len);
 140                 return -EINVAL;
 141         }
 142
 143         memset(&msg, 0, sizeof(msg));
 144         msg.msg_id = AP_IPIMSG_DEC_START;
 145         msg.vpu_inst_addr = vpu->inst_addr;
 146
 147         for (i = 0; i < len; i++)
 148                 msg.data[i] = data[i];
 149
 150         err = vcodec_vpu_send_msg(vpu, (void *)&msg, sizeof(msg));
 151         mtk_vcodec_debug(vpu, "- ret=%d", err);
 152         return err;
 153 }
 154
 155 int vpu_dec_end(struct vdec_vpu_inst *vpu)
 156 {
 157         return vcodec_send_ap_ipi(vpu, AP_IPIMSG_DEC_END);
 158 }
 159
 160 int vpu_dec_deinit(struct vdec_vpu_inst *vpu)
 161 {
 162         return vcodec_send_ap_ipi(vpu, AP_IPIMSG_DEC_DEINIT);
 163 }
 164
 165 int vpu_dec_reset(struct vdec_vpu_inst *vpu)
 166 {
 167         return vcodec_send_ap_ipi(vpu, AP_IPIMSG_DEC_RESET);
 168 }