mtk_vcodec_fw_vpu.c

  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	unsigned long flags;
 51
 52	dev_err(&dev->plat_dev->dev, "Watchdog timeout!!");
 53
 54	spin_lock_irqsave(&dev->dev_ctx_lock, flags);
 55	list_for_each_entry(ctx, &dev->ctx_list, list) {
 56		ctx->state = MTK_STATE_ABORT;
 57		mtk_v4l2_vdec_dbg(0, ctx, "[%d] Change to state MTK_STATE_ABORT", ctx->id);
 58	}
 59	spin_unlock_irqrestore(&dev->dev_ctx_lock, flags);
 60}
 61
 62static void mtk_vcodec_vpu_reset_enc_handler(void *priv)
 63{
 64	struct mtk_vcodec_enc_dev *dev = priv;
 65	struct mtk_vcodec_enc_ctx *ctx;
 66	unsigned long flags;
 67
 68	dev_err(&dev->plat_dev->dev, "Watchdog timeout!!");
 69
 70	spin_lock_irqsave(&dev->dev_ctx_lock, flags);
 71	list_for_each_entry(ctx, &dev->ctx_list, list) {
 72		ctx->state = MTK_STATE_ABORT;
 73		mtk_v4l2_vdec_dbg(0, ctx, "[%d] Change to state MTK_STATE_ABORT", ctx->id);
 74	}
 75	spin_unlock_irqrestore(&dev->dev_ctx_lock, flags);
 76}
 77
 78static const struct mtk_vcodec_fw_ops mtk_vcodec_vpu_msg = {
 79	.load_firmware = mtk_vcodec_vpu_load_firmware,
 80	.get_vdec_capa = mtk_vcodec_vpu_get_vdec_capa,
 81	.get_venc_capa = mtk_vcodec_vpu_get_venc_capa,
 82	.map_dm_addr = mtk_vcodec_vpu_map_dm_addr,
 83	.ipi_register = mtk_vcodec_vpu_set_ipi_register,
 84	.ipi_send = mtk_vcodec_vpu_ipi_send,
 85	.release = mtk_vcodec_vpu_release,
 86};
 87
 88struct mtk_vcodec_fw *mtk_vcodec_fw_vpu_init(void *priv, enum mtk_vcodec_fw_use fw_use)
 89{
 90	struct platform_device *fw_pdev;
 91	struct platform_device *plat_dev;
 92	struct mtk_vcodec_fw *fw;
 93	enum rst_id rst_id;
 94
 95	if (fw_use == ENCODER) {
 96		struct mtk_vcodec_enc_dev *enc_dev = priv;
 97
 98		plat_dev = enc_dev->plat_dev;
 99		rst_id = VPU_RST_ENC;
100	} else if (fw_use == DECODER) {
101		struct mtk_vcodec_dec_dev *dec_dev = priv;
102
103		plat_dev = dec_dev->plat_dev;
104		rst_id = VPU_RST_DEC;
105	} else {
106		pr_err("Invalid fw_use %d (use a reasonable fw id here)\n", fw_use);
107		return ERR_PTR(-EINVAL);
108	}
109
110	fw_pdev = vpu_get_plat_device(plat_dev);
111	if (!fw_pdev) {
112		dev_err(&plat_dev->dev, "firmware device is not ready");
113		return ERR_PTR(-EINVAL);
114	}
115
116	if (fw_use == DECODER)
117		vpu_wdt_reg_handler(fw_pdev, mtk_vcodec_vpu_reset_dec_handler, priv, rst_id);
118	else
119		vpu_wdt_reg_handler(fw_pdev, mtk_vcodec_vpu_reset_enc_handler, priv, rst_id);
120
121	fw = devm_kzalloc(&plat_dev->dev, sizeof(*fw), GFP_KERNEL);
122	if (!fw) {
123		put_device(&fw_pdev->dev);
124		return ERR_PTR(-ENOMEM);
125	}
126	fw->type = VPU;
127	fw->ops = &mtk_vcodec_vpu_msg;
128	fw->pdev = fw_pdev;
129	fw->fw_use = fw_use;
130
131	return fw;
132}