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