media: mtk-jpegdec: support jpegdec multi-hardware (0fa49df4) · Commits · EulixOS / Software / Kernel

drivers/media/platform/mediatek/jpeg/Makefile

+3 −2

Original line number	Diff line number	Diff line
		# SPDX-License-Identifier: GPL-2.0-only
		obj-$(CONFIG_VIDEO_MEDIATEK_JPEG) += mtk_jpeg.o \
		mtk-jpeg-enc-hw.o
		mtk-jpeg-enc-hw.o \
		mtk-jpeg-dec-hw.o

		mtk_jpeg-y := mtk_jpeg_core.o \
		mtk_jpeg_dec_hw.o \
		mtk_jpeg_dec_parse.o

		mtk-jpeg-enc-hw-y := mtk_jpeg_enc_hw.o
		mtk-jpeg-dec-hw-y := mtk_jpeg_dec_hw.o

drivers/media/platform/mediatek/jpeg/mtk_jpeg_core.h

+42 −0

Original line number	Diff line number	Diff line
		@@ -102,6 +102,13 @@ enum mtk_jpegenc_hw_id {
		MTK_JPEGENC_HW_MAX,
		};

		enum mtk_jpegdec_hw_id {
		MTK_JPEGDEC_HW0,
		MTK_JPEGDEC_HW1,
		MTK_JPEGDEC_HW2,
		MTK_JPEGDEC_HW_MAX,
		};

		/**
		* struct mtk_jpegenc_clk - Structure used to store vcodec clock information
		* @clks: JPEG encode clock
		@@ -112,6 +119,16 @@ struct mtk_jpegenc_clk {
		int clk_num;
		};

		/**
		* struct mtk_jpegdec_clk - Structure used to store vcodec clock information
		* @clks: JPEG decode clock
		* @clk_num: JPEG decode clock numbers
		*/
		struct mtk_jpegdec_clk {
		struct clk_bulk_data *clks;
		int clk_num;
		};

		/**
		* struct mtk_jpegenc_comp_dev - JPEG COREX abstraction
		* @dev: JPEG device
		@@ -140,6 +157,24 @@ struct mtk_jpegenc_comp_dev {
		spinlock_t hw_lock;
		};

		/**
		* struct mtk_jpegdec_comp_dev - JPEG COREX abstraction
		* @dev: JPEG device
		* @plat_dev: platform device data
		* @reg_base: JPEG registers mapping
		* @master_dev: mtk_jpeg_dev device
		* @jdec_clk: mtk_jpegdec_clk
		* @jpegdec_irq: jpeg decode irq num
		*/
		struct mtk_jpegdec_comp_dev {
		struct device *dev;
		struct platform_device *plat_dev;
		void __iomem *reg_base;
		struct mtk_jpeg_dev *master_dev;
		struct mtk_jpegdec_clk jdec_clk;
		int jpegdec_irq;
		};

		/**
		* struct mtk_jpeg_dev - JPEG IP abstraction
		* @lock: the mutex protecting this structure
		@@ -158,6 +193,9 @@ struct mtk_jpegenc_comp_dev {
		* @is_jpgenc_multihw: the flag of multi-hw core
		* @enc_hw_wq: jpg encode wait queue
		* @enchw_rdy: jpg encode hw ready flag
		* @reg_decbase: jpg decode register base addr
		* @dec_hw_dev: jpg decode hardware device
		* @is_jpgdec_multihw: the flag of dec multi-hw core
		*/
		struct mtk_jpeg_dev {
		struct mutex lock;
		@@ -177,6 +215,10 @@ struct mtk_jpeg_dev {
		bool is_jpgenc_multihw;
		wait_queue_head_t enc_hw_wq;
		atomic_t enchw_rdy;

		void __iomem *reg_decbase[MTK_JPEGDEC_HW_MAX];
		struct mtk_jpegdec_comp_dev *dec_hw_dev[MTK_JPEGDEC_HW_MAX];
		bool is_jpgdec_multihw;
		};

		/**

drivers/media/platform/mediatek/jpeg/mtk_jpeg_dec_hw.c

+169 −0

Original line number	Diff line number	Diff line
		@@ -5,9 +5,24 @@
		* Rick Chang <rick.chang@mediatek.com>
		*/

		#include <linux/clk.h>
		#include <linux/interrupt.h>
		#include <linux/irq.h>
		#include <linux/io.h>
		#include <linux/kernel.h>
		#include <linux/module.h>
		#include <linux/of.h>
		#include <linux/of_device.h>
		#include <linux/pm_runtime.h>
		#include <linux/slab.h>
		#include <media/media-device.h>
		#include <media/videobuf2-core.h>
		#include <media/videobuf2-v4l2.h>
		#include <media/v4l2-mem2mem.h>
		#include <media/v4l2-dev.h>
		#include <media/v4l2-device.h>
		#include <media/v4l2-fh.h>
		#include <media/v4l2-event.h>

		#include "mtk_jpeg_core.h"
		#include "mtk_jpeg_dec_hw.h"
		@@ -24,6 +39,16 @@ enum mtk_jpeg_color {
		MTK_JPEG_COLOR_400 = 0x00110000
		};

		#if defined(CONFIG_OF)
		static const struct of_device_id mtk_jpegdec_hw_ids[] = {
		{
		.compatible = "mediatek,mt8195-jpgdec-hw",
		},
		{},
		};
		MODULE_DEVICE_TABLE(of, mtk_jpegdec_hw_ids);
		#endif

		static inline int mtk_jpeg_verify_align(u32 val, int align, u32 reg)
		{
		if (val & (align - 1)) {
		@@ -414,3 +439,147 @@ void mtk_jpeg_dec_set_config(void __iomem *base,
		mtk_jpeg_dec_set_pause_mcu_idx(base, config->total_mcu);
		}
		EXPORT_SYMBOL_GPL(mtk_jpeg_dec_set_config);

		static irqreturn_t mtk_jpegdec_hw_irq_handler(int irq, void *priv)
		{
		struct vb2_v4l2_buffer src_buf, dst_buf;
		struct mtk_jpeg_src_buf *jpeg_src_buf;
		enum vb2_buffer_state buf_state;
		struct mtk_jpeg_ctx *ctx;
		u32 dec_irq_ret;
		u32 irq_status;
		int i;

		struct mtk_jpegdec_comp_dev *jpeg = priv;
		struct mtk_jpeg_dev *master_jpeg = jpeg->master_dev;

		irq_status = mtk_jpeg_dec_get_int_status(jpeg->reg_base);
		dec_irq_ret = mtk_jpeg_dec_enum_result(irq_status);
		if (dec_irq_ret >= MTK_JPEG_DEC_RESULT_UNDERFLOW)
		mtk_jpeg_dec_reset(jpeg->reg_base);
		if (dec_irq_ret != MTK_JPEG_DEC_RESULT_EOF_DONE)
		return IRQ_NONE;

		ctx = v4l2_m2m_get_curr_priv(master_jpeg->m2m_dev);
		if (!ctx) {
		dev_err(jpeg->dev, "Context is NULL\n");
		return IRQ_HANDLED;
		}

		src_buf = v4l2_m2m_src_buf_remove(ctx->fh.m2m_ctx);
		dst_buf = v4l2_m2m_dst_buf_remove(ctx->fh.m2m_ctx);
		v4l2_m2m_buf_copy_metadata(src_buf, dst_buf, true);
		jpeg_src_buf =
		container_of(src_buf, struct mtk_jpeg_src_buf, b);

		for (i = 0; i < dst_buf->vb2_buf.num_planes; i++)
		vb2_set_plane_payload(&dst_buf->vb2_buf, i,
		jpeg_src_buf->dec_param.comp_size[i]);

		buf_state = VB2_BUF_STATE_DONE;

		v4l2_m2m_buf_done(src_buf, buf_state);
		v4l2_m2m_buf_done(dst_buf, buf_state);
		v4l2_m2m_job_finish(master_jpeg->m2m_dev, ctx->fh.m2m_ctx);
		pm_runtime_put(ctx->jpeg->dev);

		return IRQ_HANDLED;
		}

		static int mtk_jpegdec_hw_init_irq(struct mtk_jpegdec_comp_dev *dev)
		{
		struct platform_device *pdev = dev->plat_dev;
		int ret;

		dev->jpegdec_irq = platform_get_irq(pdev, 0);
		if (dev->jpegdec_irq < 0)
		return dev->jpegdec_irq;

		ret = devm_request_irq(&pdev->dev,
		dev->jpegdec_irq,
		mtk_jpegdec_hw_irq_handler,
		0,
		pdev->name, dev);
		if (ret) {
		dev_err(&pdev->dev, "Failed to devm_request_irq %d (%d)",
		dev->jpegdec_irq, ret);
		return ret;
		}

		return 0;
		}

		static int mtk_jpegdec_hw_probe(struct platform_device *pdev)
		{
		struct mtk_jpegdec_clk *jpegdec_clk;
		struct mtk_jpeg_dev *master_dev;
		struct mtk_jpegdec_comp_dev *dev;
		int ret, i;

		struct device *decs = &pdev->dev;

		if (!decs->parent)
		return -EPROBE_DEFER;

		master_dev = dev_get_drvdata(decs->parent);
		if (!master_dev)
		return -EPROBE_DEFER;

		dev = devm_kzalloc(&pdev->dev, sizeof(*dev), GFP_KERNEL);
		if (!dev)
		return -ENOMEM;

		dev->plat_dev = pdev;
		dev->dev = &pdev->dev;

		if (!master_dev->is_jpgdec_multihw) {
		master_dev->is_jpgdec_multihw = true;
		for (i = 0; i < MTK_JPEGDEC_HW_MAX; i++)
		master_dev->dec_hw_dev[i] = NULL;
		}

		jpegdec_clk = &dev->jdec_clk;

		jpegdec_clk->clk_num = devm_clk_bulk_get_all(&pdev->dev,
		&jpegdec_clk->clks);
		if (jpegdec_clk->clk_num < 0)
		return dev_err_probe(&pdev->dev,
		jpegdec_clk->clk_num,
		"Failed to get jpegdec clock count.\n");

		dev->reg_base = devm_platform_ioremap_resource(pdev, 0);
		if (IS_ERR(dev->reg_base))
		return PTR_ERR(dev->reg_base);

		ret = mtk_jpegdec_hw_init_irq(dev);
		if (ret)
		return dev_err_probe(&pdev->dev, ret,
		"Failed to register JPEGDEC irq handler.\n");

		for (i = 0; i < MTK_JPEGDEC_HW_MAX; i++) {
		if (master_dev->dec_hw_dev[i])
		continue;

		master_dev->dec_hw_dev[i] = dev;
		master_dev->reg_decbase[i] = dev->reg_base;
		dev->master_dev = master_dev;
		}

		platform_set_drvdata(pdev, dev);
		pm_runtime_enable(&pdev->dev);

		return 0;
		}

		static struct platform_driver mtk_jpegdec_hw_driver = {
		.probe = mtk_jpegdec_hw_probe,
		.driver = {
		.name = "mtk-jpegdec-hw",
		.of_match_table = of_match_ptr(mtk_jpegdec_hw_ids),
		},
		};

		module_platform_driver(mtk_jpegdec_hw_driver);

		MODULE_DESCRIPTION("MediaTek JPEG decode HW driver");
		MODULE_LICENSE("GPL");