hc
2023-12-09 b22da3d8526a935aa31e086e63f60ff3246cb61c
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
// SPDX-License-Identifier: GPL-2.0
 
#include "mtk_vcodec_fw_priv.h"
#include "mtk_vcodec_util.h"
#include "mtk_vcodec_drv.h"
 
static int mtk_vcodec_vpu_load_firmware(struct mtk_vcodec_fw *fw)
{
   return vpu_load_firmware(fw->pdev);
}
 
static unsigned int mtk_vcodec_vpu_get_vdec_capa(struct mtk_vcodec_fw *fw)
{
   return vpu_get_vdec_hw_capa(fw->pdev);
}
 
static unsigned int mtk_vcodec_vpu_get_venc_capa(struct mtk_vcodec_fw *fw)
{
   return vpu_get_venc_hw_capa(fw->pdev);
}
 
static void *mtk_vcodec_vpu_map_dm_addr(struct mtk_vcodec_fw *fw,
                   u32 dtcm_dmem_addr)
{
   return vpu_mapping_dm_addr(fw->pdev, dtcm_dmem_addr);
}
 
static int mtk_vcodec_vpu_set_ipi_register(struct mtk_vcodec_fw *fw, int id,
                      mtk_vcodec_ipi_handler handler,
                      const char *name, void *priv)
{
   /*
    * The handler we receive takes a void * as its first argument. We
    * cannot change this because it needs to be passed down to the rproc
    * subsystem when SCP is used. VPU takes a const argument, which is
    * more constrained, so the conversion below is safe.
    */
   ipi_handler_t handler_const = (ipi_handler_t)handler;
 
   return vpu_ipi_register(fw->pdev, id, handler_const, name, priv);
}
 
static int mtk_vcodec_vpu_ipi_send(struct mtk_vcodec_fw *fw, int id, void *buf,
                  unsigned int len, unsigned int wait)
{
   return vpu_ipi_send(fw->pdev, id, buf, len);
}
 
static void mtk_vcodec_vpu_release(struct mtk_vcodec_fw *fw)
{
   put_device(&fw->pdev->dev);
}
 
static void mtk_vcodec_vpu_reset_handler(void *priv)
{
   struct mtk_vcodec_dev *dev = priv;
   struct mtk_vcodec_ctx *ctx;
 
   mtk_v4l2_err("Watchdog timeout!!");
 
   mutex_lock(&dev->dev_mutex);
   list_for_each_entry(ctx, &dev->ctx_list, list) {
       ctx->state = MTK_STATE_ABORT;
       mtk_v4l2_debug(0, "[%d] Change to state MTK_STATE_ABORT",
                  ctx->id);
   }
   mutex_unlock(&dev->dev_mutex);
}
 
static const struct mtk_vcodec_fw_ops mtk_vcodec_vpu_msg = {
   .load_firmware = mtk_vcodec_vpu_load_firmware,
   .get_vdec_capa = mtk_vcodec_vpu_get_vdec_capa,
   .get_venc_capa = mtk_vcodec_vpu_get_venc_capa,
   .map_dm_addr = mtk_vcodec_vpu_map_dm_addr,
   .ipi_register = mtk_vcodec_vpu_set_ipi_register,
   .ipi_send = mtk_vcodec_vpu_ipi_send,
   .release = mtk_vcodec_vpu_release,
};
 
struct mtk_vcodec_fw *mtk_vcodec_fw_vpu_init(struct mtk_vcodec_dev *dev,
                        enum mtk_vcodec_fw_use fw_use)
{
   struct platform_device *fw_pdev;
   struct mtk_vcodec_fw *fw;
   enum rst_id rst_id;
 
   switch (fw_use) {
   case ENCODER:
       rst_id = VPU_RST_ENC;
       break;
   case DECODER:
   default:
       rst_id = VPU_RST_DEC;
       break;
   }
 
   fw_pdev = vpu_get_plat_device(dev->plat_dev);
   if (!fw_pdev) {
       mtk_v4l2_err("firmware device is not ready");
       return ERR_PTR(-EINVAL);
   }
   vpu_wdt_reg_handler(fw_pdev, mtk_vcodec_vpu_reset_handler, dev, rst_id);
 
   fw = devm_kzalloc(&dev->plat_dev->dev, sizeof(*fw), GFP_KERNEL);
   if (!fw)
       return ERR_PTR(-ENOMEM);
   fw->type = VPU;
   fw->ops = &mtk_vcodec_vpu_msg;
   fw->pdev = fw_pdev;
 
   return fw;
}