1 // SPDX-License-Identifier: GPL-2.0
3 #include "mtk_vcodec_fw.h"
4 #include "mtk_vcodec_util.h"
5 #include "mtk_vcodec_drv.h"
7 struct mtk_vcodec_fw_ops {
8 int (*load_firmware)(struct mtk_vcodec_fw *fw);
9 unsigned int (*get_vdec_capa)(struct mtk_vcodec_fw *fw);
10 unsigned int (*get_venc_capa)(struct mtk_vcodec_fw *fw);
11 void * (*map_dm_addr)(struct mtk_vcodec_fw *fw, u32 dtcm_dmem_addr);
12 int (*ipi_register)(struct mtk_vcodec_fw *fw, int id,
13 mtk_vcodec_ipi_handler handler, const char *name, void *priv);
14 int (*ipi_send)(struct mtk_vcodec_fw *fw, int id, void *buf,
15 unsigned int len, unsigned int wait);
18 struct mtk_vcodec_fw {
19 enum mtk_vcodec_fw_type type;
20 const struct mtk_vcodec_fw_ops *ops;
21 struct platform_device *pdev;
25 static int mtk_vcodec_vpu_load_firmware(struct mtk_vcodec_fw *fw)
27 return vpu_load_firmware(fw->pdev);
30 static unsigned int mtk_vcodec_vpu_get_vdec_capa(struct mtk_vcodec_fw *fw)
32 return vpu_get_vdec_hw_capa(fw->pdev);
35 static unsigned int mtk_vcodec_vpu_get_venc_capa(struct mtk_vcodec_fw *fw)
37 return vpu_get_venc_hw_capa(fw->pdev);
40 static void *mtk_vcodec_vpu_map_dm_addr(struct mtk_vcodec_fw *fw,
43 return vpu_mapping_dm_addr(fw->pdev, dtcm_dmem_addr);
46 static int mtk_vcodec_vpu_set_ipi_register(struct mtk_vcodec_fw *fw, int id,
47 mtk_vcodec_ipi_handler handler,
48 const char *name, void *priv)
51 * The handler we receive takes a void * as its first argument. We
52 * cannot change this because it needs to be passed down to the rproc
53 * subsystem when SCP is used. VPU takes a const argument, which is
54 * more constrained, so the conversion below is safe.
56 ipi_handler_t handler_const = (ipi_handler_t)handler;
58 return vpu_ipi_register(fw->pdev, id, handler_const, name, priv);
61 static int mtk_vcodec_vpu_ipi_send(struct mtk_vcodec_fw *fw, int id, void *buf,
62 unsigned int len, unsigned int wait)
64 return vpu_ipi_send(fw->pdev, id, buf, len);
67 static const struct mtk_vcodec_fw_ops mtk_vcodec_vpu_msg = {
68 .load_firmware = mtk_vcodec_vpu_load_firmware,
69 .get_vdec_capa = mtk_vcodec_vpu_get_vdec_capa,
70 .get_venc_capa = mtk_vcodec_vpu_get_venc_capa,
71 .map_dm_addr = mtk_vcodec_vpu_map_dm_addr,
72 .ipi_register = mtk_vcodec_vpu_set_ipi_register,
73 .ipi_send = mtk_vcodec_vpu_ipi_send,
76 static int mtk_vcodec_scp_load_firmware(struct mtk_vcodec_fw *fw)
78 return rproc_boot(scp_get_rproc(fw->scp));
81 static unsigned int mtk_vcodec_scp_get_vdec_capa(struct mtk_vcodec_fw *fw)
83 return scp_get_vdec_hw_capa(fw->scp);
86 static unsigned int mtk_vcodec_scp_get_venc_capa(struct mtk_vcodec_fw *fw)
88 return scp_get_venc_hw_capa(fw->scp);
91 static void *mtk_vcodec_vpu_scp_dm_addr(struct mtk_vcodec_fw *fw,
94 return scp_mapping_dm_addr(fw->scp, dtcm_dmem_addr);
97 static int mtk_vcodec_scp_set_ipi_register(struct mtk_vcodec_fw *fw, int id,
98 mtk_vcodec_ipi_handler handler,
99 const char *name, void *priv)
101 return scp_ipi_register(fw->scp, id, handler, priv);
104 static int mtk_vcodec_scp_ipi_send(struct mtk_vcodec_fw *fw, int id, void *buf,
105 unsigned int len, unsigned int wait)
107 return scp_ipi_send(fw->scp, id, buf, len, wait);
110 static const struct mtk_vcodec_fw_ops mtk_vcodec_rproc_msg = {
111 .load_firmware = mtk_vcodec_scp_load_firmware,
112 .get_vdec_capa = mtk_vcodec_scp_get_vdec_capa,
113 .get_venc_capa = mtk_vcodec_scp_get_venc_capa,
114 .map_dm_addr = mtk_vcodec_vpu_scp_dm_addr,
115 .ipi_register = mtk_vcodec_scp_set_ipi_register,
116 .ipi_send = mtk_vcodec_scp_ipi_send,
119 static void mtk_vcodec_reset_handler(void *priv)
121 struct mtk_vcodec_dev *dev = priv;
122 struct mtk_vcodec_ctx *ctx;
124 mtk_v4l2_err("Watchdog timeout!!");
126 mutex_lock(&dev->dev_mutex);
127 list_for_each_entry(ctx, &dev->ctx_list, list) {
128 ctx->state = MTK_STATE_ABORT;
129 mtk_v4l2_debug(0, "[%d] Change to state MTK_STATE_ABORT",
132 mutex_unlock(&dev->dev_mutex);
135 struct mtk_vcodec_fw *mtk_vcodec_fw_select(struct mtk_vcodec_dev *dev,
136 enum mtk_vcodec_fw_type type,
139 const struct mtk_vcodec_fw_ops *ops;
140 struct mtk_vcodec_fw *fw;
141 struct platform_device *fw_pdev = NULL;
142 struct mtk_scp *scp = NULL;
146 ops = &mtk_vcodec_vpu_msg;
147 fw_pdev = vpu_get_plat_device(dev->plat_dev);
149 mtk_v4l2_err("firmware device is not ready");
150 return ERR_PTR(-EINVAL);
152 vpu_wdt_reg_handler(fw_pdev, mtk_vcodec_reset_handler,
156 ops = &mtk_vcodec_rproc_msg;
157 scp = scp_get(dev->plat_dev);
159 mtk_v4l2_err("could not get vdec scp handle");
160 return ERR_PTR(-EPROBE_DEFER);
164 mtk_v4l2_err("invalid vcodec fw type");
165 return ERR_PTR(-EINVAL);
168 fw = devm_kzalloc(&dev->plat_dev->dev, sizeof(*fw), GFP_KERNEL);
170 return ERR_PTR(-EINVAL);
179 EXPORT_SYMBOL_GPL(mtk_vcodec_fw_select);
181 void mtk_vcodec_fw_release(struct mtk_vcodec_fw *fw)
185 put_device(&fw->pdev->dev);
192 EXPORT_SYMBOL_GPL(mtk_vcodec_fw_release);
194 int mtk_vcodec_fw_load_firmware(struct mtk_vcodec_fw *fw)
196 return fw->ops->load_firmware(fw);
198 EXPORT_SYMBOL_GPL(mtk_vcodec_fw_load_firmware);
200 unsigned int mtk_vcodec_fw_get_vdec_capa(struct mtk_vcodec_fw *fw)
202 return fw->ops->get_vdec_capa(fw);
204 EXPORT_SYMBOL_GPL(mtk_vcodec_fw_get_vdec_capa);
206 unsigned int mtk_vcodec_fw_get_venc_capa(struct mtk_vcodec_fw *fw)
208 return fw->ops->get_venc_capa(fw);
210 EXPORT_SYMBOL_GPL(mtk_vcodec_fw_get_venc_capa);
212 void *mtk_vcodec_fw_map_dm_addr(struct mtk_vcodec_fw *fw, u32 mem_addr)
214 return fw->ops->map_dm_addr(fw, mem_addr);
216 EXPORT_SYMBOL_GPL(mtk_vcodec_fw_map_dm_addr);
218 int mtk_vcodec_fw_ipi_register(struct mtk_vcodec_fw *fw, int id,
219 mtk_vcodec_ipi_handler handler,
220 const char *name, void *priv)
222 return fw->ops->ipi_register(fw, id, handler, name, priv);
224 EXPORT_SYMBOL_GPL(mtk_vcodec_fw_ipi_register);
226 int mtk_vcodec_fw_ipi_send(struct mtk_vcodec_fw *fw, int id, void *buf,
227 unsigned int len, unsigned int wait)
229 return fw->ops->ipi_send(fw, id, buf, len, wait);
231 EXPORT_SYMBOL_GPL(mtk_vcodec_fw_ipi_send);