[media] media: Add Mediatek MDP Driver (c8eb2d7e) · Commits · e / devices / android_kernel_oneplus_sm7250

drivers/media/platform/Kconfig

+17 −0

Original line number	Diff line number	Diff line
		@@ -175,6 +175,23 @@ config VIDEO_MEDIATEK_VPU
		To compile this driver as a module, choose M here: the
		module will be called mtk-vpu.

		config VIDEO_MEDIATEK_MDP
		tristate "Mediatek MDP driver"
		depends on MTK_IOMMU \|\| COMPILE_TEST
		depends on VIDEO_DEV && VIDEO_V4L2
		depends on ARCH_MEDIATEK \|\| COMPILE_TEST
		depends on HAS_DMA
		select VIDEOBUF2_DMA_CONTIG
		select V4L2_MEM2MEM_DEV
		select VIDEO_MEDIATEK_VPU
		default n
		---help---
		It is a v4l2 driver and present in Mediatek MT8173 SoCs.
		The driver supports for scaling and color space conversion.

		To compile this driver as a module, choose M here: the
		module will be called mtk-mdp.

		config VIDEO_MEDIATEK_VCODEC
		tristate "Mediatek Video Codec driver"
		depends on MTK_IOMMU \|\| COMPILE_TEST

drivers/media/platform/Makefile

+2 −0

Original line number	Diff line number	Diff line
		@@ -66,3 +66,5 @@ ccflags-y += -I$(srctree)/drivers/media/i2c
		obj-$(CONFIG_VIDEO_MEDIATEK_VPU) += mtk-vpu/

		obj-$(CONFIG_VIDEO_MEDIATEK_VCODEC) += mtk-vcodec/

		obj-$(CONFIG_VIDEO_MEDIATEK_MDP) += mtk-mdp/

drivers/media/platform/mtk-mdp/Makefile

0 → 100644

+9 −0

Original line number	Diff line number	Diff line
		mtk-mdp-y += mtk_mdp_core.o
		mtk-mdp-y += mtk_mdp_comp.o
		mtk-mdp-y += mtk_mdp_m2m.o
		mtk-mdp-y += mtk_mdp_regs.o
		mtk-mdp-y += mtk_mdp_vpu.o

		obj-$(CONFIG_VIDEO_MEDIATEK_MDP) += mtk-mdp.o

		ccflags-y += -I$(srctree)/drivers/media/platform/mtk-vpu

drivers/media/platform/mtk-mdp/mtk_mdp_comp.c

0 → 100644

+159 −0

Original line number	Diff line number	Diff line
		/*
		* Copyright (c) 2016 MediaTek Inc.
		* Author: Ming Hsiu Tsai <minghsiu.tsai@mediatek.com>
		*
		* This program is free software; you can redistribute it and/or modify
		* it under the terms of the GNU General Public License version 2 as
		* published by the Free Software Foundation.
		*
		* This program is distributed in the hope that it will be useful,
		* but WITHOUT ANY WARRANTY; without even the implied warranty of
		* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
		* GNU General Public License for more details.
		*/

		#include <linux/clk.h>
		#include <linux/device.h>
		#include <linux/of.h>
		#include <linux/of_address.h>
		#include <linux/of_platform.h>
		#include <soc/mediatek/smi.h>

		#include "mtk_mdp_comp.h"


		static const char * const mtk_mdp_comp_stem[MTK_MDP_COMP_TYPE_MAX] = {
		"mdp_rdma",
		"mdp_rsz",
		"mdp_wdma",
		"mdp_wrot",
		};

		struct mtk_mdp_comp_match {
		enum mtk_mdp_comp_type type;
		int alias_id;
		};

		static const struct mtk_mdp_comp_match mtk_mdp_matches[MTK_MDP_COMP_ID_MAX] = {
		{ MTK_MDP_RDMA, 0 },
		{ MTK_MDP_RDMA, 1 },
		{ MTK_MDP_RSZ, 0 },
		{ MTK_MDP_RSZ, 1 },
		{ MTK_MDP_RSZ, 2 },
		{ MTK_MDP_WDMA, 0 },
		{ MTK_MDP_WROT, 0 },
		{ MTK_MDP_WROT, 1 },
		};

		int mtk_mdp_comp_get_id(struct device dev, struct device_node node,
		enum mtk_mdp_comp_type comp_type)
		{
		int id = of_alias_get_id(node, mtk_mdp_comp_stem[comp_type]);
		int i;

		for (i = 0; i < ARRAY_SIZE(mtk_mdp_matches); i++) {
		if (comp_type == mtk_mdp_matches[i].type &&
		id == mtk_mdp_matches[i].alias_id)
		return i;
		}

		dev_err(dev, "Failed to get id. type: %d, id: %d\n", comp_type, id);

		return -EINVAL;
		}

		void mtk_mdp_comp_clock_on(struct device dev, struct mtk_mdp_comp comp)
		{
		int i, err;

		if (comp->larb_dev) {
		err = mtk_smi_larb_get(comp->larb_dev);
		if (err)
		dev_err(dev,
		"failed to get larb, err %d. type:%d id:%d\n",
		err, comp->type, comp->id);
		}

		for (i = 0; i < ARRAY_SIZE(comp->clk); i++) {
		if (!comp->clk[i])
		continue;
		err = clk_prepare_enable(comp->clk[i]);
		if (err)
		dev_err(dev,
		"failed to enable clock, err %d. type:%d id:%d i:%d\n",
		err, comp->type, comp->id, i);
		}
		}

		void mtk_mdp_comp_clock_off(struct device dev, struct mtk_mdp_comp comp)
		{
		int i;

		for (i = 0; i < ARRAY_SIZE(comp->clk); i++) {
		if (!comp->clk[i])
		continue;
		clk_disable_unprepare(comp->clk[i]);
		}

		if (comp->larb_dev)
		mtk_smi_larb_put(comp->larb_dev);
		}

		int mtk_mdp_comp_init(struct device dev, struct device_node node,
		struct mtk_mdp_comp *comp, enum mtk_mdp_comp_id comp_id)
		{
		struct device_node *larb_node;
		struct platform_device *larb_pdev;
		int i;

		if (comp_id < 0 \|\| comp_id >= MTK_MDP_COMP_ID_MAX) {
		dev_err(dev, "Invalid comp_id %d\n", comp_id);
		return -EINVAL;
		}

		comp->dev_node = of_node_get(node);
		comp->id = comp_id;
		comp->type = mtk_mdp_matches[comp_id].type;
		comp->regs = of_iomap(node, 0);

		for (i = 0; i < ARRAY_SIZE(comp->clk); i++) {
		comp->clk[i] = of_clk_get(node, i);

		/* Only RDMA needs two clocks */
		if (comp->type != MTK_MDP_RDMA)
		break;
		}

		/* Only DMA capable components need the LARB property */
		comp->larb_dev = NULL;
		if (comp->type != MTK_MDP_RDMA &&
		comp->type != MTK_MDP_WDMA &&
		comp->type != MTK_MDP_WROT)
		return 0;

		larb_node = of_parse_phandle(node, "mediatek,larb", 0);
		if (!larb_node) {
		dev_err(dev,
		"Missing mediadek,larb phandle in %s node\n",
		node->full_name);
		return -EINVAL;
		}

		larb_pdev = of_find_device_by_node(larb_node);
		if (!larb_pdev) {
		dev_warn(dev, "Waiting for larb device %s\n",
		larb_node->full_name);
		of_node_put(larb_node);
		return -EPROBE_DEFER;
		}
		of_node_put(larb_node);

		comp->larb_dev = &larb_pdev->dev;

		return 0;
		}

		void mtk_mdp_comp_deinit(struct device dev, struct mtk_mdp_comp comp)
		{
		of_node_put(comp->dev_node);
		}

drivers/media/platform/mtk-mdp/mtk_mdp_comp.h

0 → 100644

+72 −0

Original line number	Diff line number	Diff line
		/*
		* Copyright (c) 2016 MediaTek Inc.
		* Author: Ming Hsiu Tsai <minghsiu.tsai@mediatek.com>
		*
		* This program is free software; you can redistribute it and/or modify
		* it under the terms of the GNU General Public License version 2 as
		* published by the Free Software Foundation.
		*
		* This program is distributed in the hope that it will be useful,
		* but WITHOUT ANY WARRANTY; without even the implied warranty of
		* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
		* GNU General Public License for more details.
		*/

		#ifndef __MTK_MDP_COMP_H__
		#define __MTK_MDP_COMP_H__

		/**
		* enum mtk_mdp_comp_type - the MDP component
		* @MTK_MDP_RDMA: Read DMA
		* @MTK_MDP_RSZ: Riszer
		* @MTK_MDP_WDMA: Write DMA
		* @MTK_MDP_WROT: Write DMA with rotation
		*/
		enum mtk_mdp_comp_type {
		MTK_MDP_RDMA,
		MTK_MDP_RSZ,
		MTK_MDP_WDMA,
		MTK_MDP_WROT,
		MTK_MDP_COMP_TYPE_MAX,
		};

		enum mtk_mdp_comp_id {
		MTK_MDP_COMP_RDMA0,
		MTK_MDP_COMP_RDMA1,
		MTK_MDP_COMP_RSZ0,
		MTK_MDP_COMP_RSZ1,
		MTK_MDP_COMP_RSZ2,
		MTK_MDP_COMP_WDMA,
		MTK_MDP_COMP_WROT0,
		MTK_MDP_COMP_WROT1,
		MTK_MDP_COMP_ID_MAX,
		};

		/**
		* struct mtk_mdp_comp - the MDP's function component data
		* @dev_node: component device node
		* @clk: clocks required for component
		* @regs: Mapped address of component registers.
		* @larb_dev: SMI device required for component
		* @type: component type
		* @id: component ID
		*/
		struct mtk_mdp_comp {
		struct device_node *dev_node;
		struct clk *clk[2];
		void __iomem *regs;
		struct device *larb_dev;
		enum mtk_mdp_comp_type type;
		enum mtk_mdp_comp_id id;
		};

		int mtk_mdp_comp_init(struct device dev, struct device_node node,
		struct mtk_mdp_comp *comp, enum mtk_mdp_comp_id comp_id);
		void mtk_mdp_comp_deinit(struct device dev, struct mtk_mdp_comp comp);
		int mtk_mdp_comp_get_id(struct device dev, struct device_node node,
		enum mtk_mdp_comp_type comp_type);
		void mtk_mdp_comp_clock_on(struct device dev, struct mtk_mdp_comp comp);
		void mtk_mdp_comp_clock_off(struct device dev, struct mtk_mdp_comp comp);


		#endif /* __MTK_MDP_COMP_H__ */