105 lines
2.6 KiB
C
105 lines
2.6 KiB
C
// 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)
|
|
{
|
|
return vpu_ipi_register(fw->pdev, id, handler, 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;
|
|
}
|