1// SPDX-License-Identifier: GPL-2.0
2
3#include "../decoder/mtk_vcodec_dec_drv.h"
4#include "../encoder/mtk_vcodec_enc_drv.h"
5#include "mtk_vcodec_fw_priv.h"
6
7static int mtk_vcodec_vpu_load_firmware(struct mtk_vcodec_fw *fw)
8{
9	return vpu_load_firmware(fw->pdev);
10}
11
12static unsigned int mtk_vcodec_vpu_get_vdec_capa(struct mtk_vcodec_fw *fw)
13{
14	return vpu_get_vdec_hw_capa(fw->pdev);
15}
16
17static unsigned int mtk_vcodec_vpu_get_venc_capa(struct mtk_vcodec_fw *fw)
18{
19	return vpu_get_venc_hw_capa(fw->pdev);
20}
21
22static void *mtk_vcodec_vpu_map_dm_addr(struct mtk_vcodec_fw *fw,
23					u32 dtcm_dmem_addr)
24{
25	return vpu_mapping_dm_addr(fw->pdev, dtcm_dmem_addr);
26}
27
28static int mtk_vcodec_vpu_set_ipi_register(struct mtk_vcodec_fw *fw, int id,
29					   mtk_vcodec_ipi_handler handler,
30					   const char *name, void *priv)
31{
32	return vpu_ipi_register(fw->pdev, id, handler, name, priv);
33}
34
35static int mtk_vcodec_vpu_ipi_send(struct mtk_vcodec_fw *fw, int id, void *buf,
36				   unsigned int len, unsigned int wait)
37{
38	return vpu_ipi_send(fw->pdev, id, buf, len);
39}
40
41static void mtk_vcodec_vpu_release(struct mtk_vcodec_fw *fw)
42{
43	put_device(&fw->pdev->dev);
44}
45
46static void mtk_vcodec_vpu_reset_dec_handler(void *priv)
47{
48	struct mtk_vcodec_dec_dev *dev = priv;
49	struct mtk_vcodec_dec_ctx *ctx;
50
51	dev_err(&dev->plat_dev->dev, "Watchdog timeout!!");
52
53	mutex_lock(&dev->dev_ctx_lock);
54	list_for_each_entry(ctx, &dev->ctx_list, list) {
55		ctx->state = MTK_STATE_ABORT;
56		mtk_v4l2_vdec_dbg(0, ctx, "[%d] Change to state MTK_STATE_ABORT", ctx->id);
57	}
58	mutex_unlock(&dev->dev_ctx_lock);
59}
60
61static void mtk_vcodec_vpu_reset_enc_handler(void *priv)
62{
63	struct mtk_vcodec_enc_dev *dev = priv;
64	struct mtk_vcodec_enc_ctx *ctx;
65
66	dev_err(&dev->plat_dev->dev, "Watchdog timeout!!");
67
68	mutex_lock(&dev->dev_ctx_lock);
69	list_for_each_entry(ctx, &dev->ctx_list, list) {
70		ctx->state = MTK_STATE_ABORT;
71		mtk_v4l2_vdec_dbg(0, ctx, "[%d] Change to state MTK_STATE_ABORT", ctx->id);
72	}
73	mutex_unlock(&dev->dev_ctx_lock);
74}
75
76static const struct mtk_vcodec_fw_ops mtk_vcodec_vpu_msg = {
77	.load_firmware = mtk_vcodec_vpu_load_firmware,
78	.get_vdec_capa = mtk_vcodec_vpu_get_vdec_capa,
79	.get_venc_capa = mtk_vcodec_vpu_get_venc_capa,
80	.map_dm_addr = mtk_vcodec_vpu_map_dm_addr,
81	.ipi_register = mtk_vcodec_vpu_set_ipi_register,
82	.ipi_send = mtk_vcodec_vpu_ipi_send,
83	.release = mtk_vcodec_vpu_release,
84};
85
86struct mtk_vcodec_fw *mtk_vcodec_fw_vpu_init(void *priv, enum mtk_vcodec_fw_use fw_use)
87{
88	struct platform_device *fw_pdev;
89	struct platform_device *plat_dev;
90	struct mtk_vcodec_fw *fw;
91	enum rst_id rst_id;
92
93	if (fw_use == ENCODER) {
94		struct mtk_vcodec_enc_dev *enc_dev = priv;
95
96		plat_dev = enc_dev->plat_dev;
97		rst_id = VPU_RST_ENC;
98	} else if (fw_use == DECODER) {
99		struct mtk_vcodec_dec_dev *dec_dev = priv;
100
101		plat_dev = dec_dev->plat_dev;
102		rst_id = VPU_RST_DEC;
103	} else {
104		pr_err("Invalid fw_use %d (use a reasonable fw id here)\n", fw_use);
105		return ERR_PTR(-EINVAL);
106	}
107
108	fw_pdev = vpu_get_plat_device(plat_dev);
109	if (!fw_pdev) {
110		dev_err(&plat_dev->dev, "firmware device is not ready");
111		return ERR_PTR(-EINVAL);
112	}
113
114	if (fw_use == DECODER)
115		vpu_wdt_reg_handler(fw_pdev, mtk_vcodec_vpu_reset_dec_handler, priv, rst_id);
116	else
117		vpu_wdt_reg_handler(fw_pdev, mtk_vcodec_vpu_reset_enc_handler, priv, rst_id);
118
119	fw = devm_kzalloc(&plat_dev->dev, sizeof(*fw), GFP_KERNEL);
120	if (!fw)
121		return ERR_PTR(-ENOMEM);
122	fw->type = VPU;
123	fw->ops = &mtk_vcodec_vpu_msg;
124	fw->pdev = fw_pdev;
125	fw->fw_use = fw_use;
126
127	return fw;
128}
129