diff mbox series

[v6,2/8] drm/mediatek: add component POSTMASK

Message ID 20210202081237.774442-3-hsinyi@chromium.org
State New
Headers show
Series drm/mediatek: add support for mediatek SOC MT8192 | expand

Commit Message

Hsin-Yi Wang Feb. 2, 2021, 8:12 a.m. UTC
From: Yongqiang Niu <yongqiang.niu@mediatek.com>

This patch add component POSTMASK.

Signed-off-by: Yongqiang Niu <yongqiang.niu@mediatek.com>
Signed-off-by: Hsin-Yi Wang <hsinyi@chromium.org>
---
 drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.c | 102 ++++++++++++++------
 drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.h |   1 +
 2 files changed, 73 insertions(+), 30 deletions(-)

Comments

CK Hu (胡俊光) Feb. 2, 2021, 9:09 a.m. UTC | #1
Hi, Hsin-Yi:

On Tue, 2021-02-02 at 16:12 +0800, Hsin-Yi Wang wrote:
> From: Yongqiang Niu <yongqiang.niu@mediatek.com>

> 

> This patch add component POSTMASK.


Reviewed-by: CK Hu <ck.hu@mediatek.com>


> 

> Signed-off-by: Yongqiang Niu <yongqiang.niu@mediatek.com>

> Signed-off-by: Hsin-Yi Wang <hsinyi@chromium.org>

> ---

>  drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.c | 102 ++++++++++++++------

>  drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.h |   1 +

>  2 files changed, 73 insertions(+), 30 deletions(-)

> 

> diff --git a/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.c b/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.c

> index b6c4e73031ca6..0a84ae53eb72a 100644

> --- a/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.c

> +++ b/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.c

> @@ -64,6 +64,12 @@

>  

>  #define AAL_EN					BIT(0)

>  

> +#define DISP_POSTMASK_EN			0x0000

> +#define POSTMASK_EN				BIT(0)

> +#define DISP_POSTMASK_CFG			0x0020

> +#define POSTMASK_RELAY_MODE			BIT(0)

> +#define DISP_POSTMASK_SIZE			0x0030

> +

>  #define DISP_DITHERING				BIT(2)

>  #define DITHER_LSB_ERR_SHIFT_R(x)		(((x) & 0x7) << 28)

>  #define DITHER_OVFLW_BIT_R(x)			(((x) & 0x7) << 24)

> @@ -204,6 +210,32 @@ static void mtk_ufoe_start(struct device *dev)

>  	writel(UFO_BYPASS, priv->regs + DISP_REG_UFO_START);

>  }

>  

> +void mtk_postmask_config(struct device *dev, unsigned int w,

> +			unsigned int h, unsigned int vrefresh,

> +			unsigned int bpc, struct cmdq_pkt *cmdq_pkt)

> +{

> +	struct mtk_ddp_comp_dev *priv = dev_get_drvdata(dev);

> +

> +	mtk_ddp_write(cmdq_pkt, w << 16 | h, &priv->cmdq_reg, priv->regs,

> +		      DISP_POSTMASK_SIZE);

> +	mtk_ddp_write(cmdq_pkt, POSTMASK_RELAY_MODE, &priv->cmdq_reg,

> +		      priv->regs, DISP_POSTMASK_CFG);

> +}

> +

> +void mtk_postmask_start(struct device *dev)

> +{

> +	struct mtk_ddp_comp_dev *priv = dev_get_drvdata(dev);

> +

> +	writel(POSTMASK_EN, priv->regs + DISP_POSTMASK_EN);

> +}

> +

> +void mtk_postmask_stop(struct device *dev)

> +{

> +	struct mtk_ddp_comp_dev *priv = dev_get_drvdata(dev);

> +

> +	writel_relaxed(0x0, priv->regs + DISP_POSTMASK_EN);

> +}

> +

>  static void mtk_aal_config(struct device *dev, unsigned int w,

>  			   unsigned int h, unsigned int vrefresh,

>  			   unsigned int bpc, struct cmdq_pkt *cmdq_pkt)

> @@ -413,6 +445,14 @@ static const struct mtk_ddp_comp_funcs ddp_ovl = {

>  	.bgclr_in_off = mtk_ovl_bgclr_in_off,

>  };

>  

> +static const struct mtk_ddp_comp_funcs ddp_postmask = {

> +	.clk_enable = mtk_ddp_clk_enable,

> +	.clk_disable = mtk_ddp_clk_disable,

> +	.config = mtk_postmask_config,

> +	.start = mtk_postmask_start,

> +	.stop = mtk_postmask_stop,

> +};

> +

>  static const struct mtk_ddp_comp_funcs ddp_rdma = {

>  	.clk_enable = mtk_rdma_clk_enable,

>  	.clk_disable = mtk_rdma_clk_disable,

> @@ -448,6 +488,7 @@ static const char * const mtk_ddp_comp_stem[MTK_DDP_COMP_TYPE_MAX] = {

>  	[MTK_DISP_MUTEX] = "mutex",

>  	[MTK_DISP_OD] = "od",

>  	[MTK_DISP_BLS] = "bls",

> +	[MTK_DISP_POSTMASK] = "postmask",

>  };

>  

>  struct mtk_ddp_comp_match {

> @@ -457,36 +498,37 @@ struct mtk_ddp_comp_match {

>  };

>  

>  static const struct mtk_ddp_comp_match mtk_ddp_matches[DDP_COMPONENT_ID_MAX] = {

> -	[DDP_COMPONENT_AAL0]	= { MTK_DISP_AAL,	0, &ddp_aal },

> -	[DDP_COMPONENT_AAL1]	= { MTK_DISP_AAL,	1, &ddp_aal },

> -	[DDP_COMPONENT_BLS]	= { MTK_DISP_BLS,	0, NULL },

> -	[DDP_COMPONENT_CCORR]	= { MTK_DISP_CCORR,	0, &ddp_ccorr },

> -	[DDP_COMPONENT_COLOR0]	= { MTK_DISP_COLOR,	0, &ddp_color },

> -	[DDP_COMPONENT_COLOR1]	= { MTK_DISP_COLOR,	1, &ddp_color },

> -	[DDP_COMPONENT_DITHER]	= { MTK_DISP_DITHER,	0, &ddp_dither },

> -	[DDP_COMPONENT_DPI0]	= { MTK_DPI,		0, &ddp_dpi },

> -	[DDP_COMPONENT_DPI1]	= { MTK_DPI,		1, &ddp_dpi },

> -	[DDP_COMPONENT_DSI0]	= { MTK_DSI,		0, &ddp_dsi },

> -	[DDP_COMPONENT_DSI1]	= { MTK_DSI,		1, &ddp_dsi },

> -	[DDP_COMPONENT_DSI2]	= { MTK_DSI,		2, &ddp_dsi },

> -	[DDP_COMPONENT_DSI3]	= { MTK_DSI,		3, &ddp_dsi },

> -	[DDP_COMPONENT_GAMMA]	= { MTK_DISP_GAMMA,	0, &ddp_gamma },

> -	[DDP_COMPONENT_OD0]	= { MTK_DISP_OD,	0, &ddp_od },

> -	[DDP_COMPONENT_OD1]	= { MTK_DISP_OD,	1, &ddp_od },

> -	[DDP_COMPONENT_OVL0]	= { MTK_DISP_OVL,	0, &ddp_ovl },

> -	[DDP_COMPONENT_OVL1]	= { MTK_DISP_OVL,	1, &ddp_ovl },

> -	[DDP_COMPONENT_OVL_2L0]	= { MTK_DISP_OVL_2L,	0, &ddp_ovl },

> -	[DDP_COMPONENT_OVL_2L1]	= { MTK_DISP_OVL_2L,	1, &ddp_ovl },

> -	[DDP_COMPONENT_OVL_2L2] = { MTK_DISP_OVL_2L,    2, &ddp_ovl },

> -	[DDP_COMPONENT_PWM0]	= { MTK_DISP_PWM,	0, NULL },

> -	[DDP_COMPONENT_PWM1]	= { MTK_DISP_PWM,	1, NULL },

> -	[DDP_COMPONENT_PWM2]	= { MTK_DISP_PWM,	2, NULL },

> -	[DDP_COMPONENT_RDMA0]	= { MTK_DISP_RDMA,	0, &ddp_rdma },

> -	[DDP_COMPONENT_RDMA1]	= { MTK_DISP_RDMA,	1, &ddp_rdma },

> -	[DDP_COMPONENT_RDMA2]	= { MTK_DISP_RDMA,	2, &ddp_rdma },

> -	[DDP_COMPONENT_UFOE]	= { MTK_DISP_UFOE,	0, &ddp_ufoe },

> -	[DDP_COMPONENT_WDMA0]	= { MTK_DISP_WDMA,	0, NULL },

> -	[DDP_COMPONENT_WDMA1]	= { MTK_DISP_WDMA,	1, NULL },

> +	[DDP_COMPONENT_AAL0]		= { MTK_DISP_AAL,	0, &ddp_aal },

> +	[DDP_COMPONENT_AAL1]		= { MTK_DISP_AAL,	1, &ddp_aal },

> +	[DDP_COMPONENT_BLS]		= { MTK_DISP_BLS,	0, NULL },

> +	[DDP_COMPONENT_CCORR]		= { MTK_DISP_CCORR,	0, &ddp_ccorr },

> +	[DDP_COMPONENT_COLOR0]		= { MTK_DISP_COLOR,	0, &ddp_color },

> +	[DDP_COMPONENT_COLOR1]		= { MTK_DISP_COLOR,	1, &ddp_color },

> +	[DDP_COMPONENT_DITHER]		= { MTK_DISP_DITHER,	0, &ddp_dither },

> +	[DDP_COMPONENT_DPI0]		= { MTK_DPI,		0, &ddp_dpi },

> +	[DDP_COMPONENT_DPI1]		= { MTK_DPI,		1, &ddp_dpi },

> +	[DDP_COMPONENT_DSI0]		= { MTK_DSI,		0, &ddp_dsi },

> +	[DDP_COMPONENT_DSI1]		= { MTK_DSI,		1, &ddp_dsi },

> +	[DDP_COMPONENT_DSI2]		= { MTK_DSI,		2, &ddp_dsi },

> +	[DDP_COMPONENT_DSI3]		= { MTK_DSI,		3, &ddp_dsi },

> +	[DDP_COMPONENT_GAMMA]		= { MTK_DISP_GAMMA,	0, &ddp_gamma },

> +	[DDP_COMPONENT_OD0]		= { MTK_DISP_OD,	0, &ddp_od },

> +	[DDP_COMPONENT_OD1]		= { MTK_DISP_OD,	1, &ddp_od },

> +	[DDP_COMPONENT_OVL0]		= { MTK_DISP_OVL,	0, &ddp_ovl },

> +	[DDP_COMPONENT_OVL1]		= { MTK_DISP_OVL,	1, &ddp_ovl },

> +	[DDP_COMPONENT_OVL_2L0]		= { MTK_DISP_OVL_2L,	0, &ddp_ovl },

> +	[DDP_COMPONENT_OVL_2L1]		= { MTK_DISP_OVL_2L,	1, &ddp_ovl },

> +	[DDP_COMPONENT_OVL_2L2]		= { MTK_DISP_OVL_2L,    2, &ddp_ovl },

> +	[DDP_COMPONENT_POSTMASK0]	= { MTK_DISP_POSTMASK,	0, &ddp_postmask },

> +	[DDP_COMPONENT_PWM0]		= { MTK_DISP_PWM,	0, NULL },

> +	[DDP_COMPONENT_PWM1]		= { MTK_DISP_PWM,	1, NULL },

> +	[DDP_COMPONENT_PWM2]		= { MTK_DISP_PWM,	2, NULL },

> +	[DDP_COMPONENT_RDMA0]		= { MTK_DISP_RDMA,	0, &ddp_rdma },

> +	[DDP_COMPONENT_RDMA1]		= { MTK_DISP_RDMA,	1, &ddp_rdma },

> +	[DDP_COMPONENT_RDMA2]		= { MTK_DISP_RDMA,	2, &ddp_rdma },

> +	[DDP_COMPONENT_UFOE]		= { MTK_DISP_UFOE,	0, &ddp_ufoe },

> +	[DDP_COMPONENT_WDMA0]		= { MTK_DISP_WDMA,	0, NULL },

> +	[DDP_COMPONENT_WDMA1]		= { MTK_DISP_WDMA,	1, NULL },

>  };

>  

>  static bool mtk_drm_find_comp_in_ddp(struct device *dev,

> diff --git a/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.h b/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.h

> index bb914d976cf5d..cd1dec6b4cdf2 100644

> --- a/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.h

> +++ b/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.h

> @@ -30,6 +30,7 @@ enum mtk_ddp_comp_type {

>  	MTK_DISP_UFOE,

>  	MTK_DSI,

>  	MTK_DPI,

> +	MTK_DISP_POSTMASK,

>  	MTK_DISP_PWM,

>  	MTK_DISP_MUTEX,

>  	MTK_DISP_OD,
Guenter Roeck Feb. 9, 2021, 3:32 p.m. UTC | #2
On Tue, Feb 02, 2021 at 04:12:31PM +0800, Hsin-Yi Wang wrote:
> From: Yongqiang Niu <yongqiang.niu@mediatek.com>

> 

> This patch add component POSTMASK.

> 

> Signed-off-by: Yongqiang Niu <yongqiang.niu@mediatek.com>

> Signed-off-by: Hsin-Yi Wang <hsinyi@chromium.org>

> Reviewed-by: CK Hu <ck.hu@mediatek.com>

> ---

[ ... ]
>  

> +void mtk_postmask_config(struct device *dev, unsigned int w,


static

> +			unsigned int h, unsigned int vrefresh,

> +			unsigned int bpc, struct cmdq_pkt *cmdq_pkt)

> +{

> +	struct mtk_ddp_comp_dev *priv = dev_get_drvdata(dev);

> +

> +	mtk_ddp_write(cmdq_pkt, w << 16 | h, &priv->cmdq_reg, priv->regs,

> +		      DISP_POSTMASK_SIZE);

> +	mtk_ddp_write(cmdq_pkt, POSTMASK_RELAY_MODE, &priv->cmdq_reg,

> +		      priv->regs, DISP_POSTMASK_CFG);

> +}

> +

> +void mtk_postmask_start(struct device *dev)


static

> +{

> +	struct mtk_ddp_comp_dev *priv = dev_get_drvdata(dev);

> +

> +	writel(POSTMASK_EN, priv->regs + DISP_POSTMASK_EN);

> +}

> +

> +void mtk_postmask_stop(struct device *dev)


static

> +{

> +	struct mtk_ddp_comp_dev *priv = dev_get_drvdata(dev);

> +

> +	writel_relaxed(0x0, priv->regs + DISP_POSTMASK_EN);

> +}

> +

>  static void mtk_aal_config(struct device *dev, unsigned int w,

>  			   unsigned int h, unsigned int vrefresh,

>  			   unsigned int bpc, struct cmdq_pkt *cmdq_pkt)

> @@ -413,6 +445,14 @@ static const struct mtk_ddp_comp_funcs ddp_ovl = {

>  	.bgclr_in_off = mtk_ovl_bgclr_in_off,

>  };

>  

> +static const struct mtk_ddp_comp_funcs ddp_postmask = {

> +	.clk_enable = mtk_ddp_clk_enable,

> +	.clk_disable = mtk_ddp_clk_disable,

> +	.config = mtk_postmask_config,

> +	.start = mtk_postmask_start,

> +	.stop = mtk_postmask_stop,

> +};

> +

>  static const struct mtk_ddp_comp_funcs ddp_rdma = {

>  	.clk_enable = mtk_rdma_clk_enable,

>  	.clk_disable = mtk_rdma_clk_disable,

> @@ -448,6 +488,7 @@ static const char * const mtk_ddp_comp_stem[MTK_DDP_COMP_TYPE_MAX] = {

>  	[MTK_DISP_MUTEX] = "mutex",

>  	[MTK_DISP_OD] = "od",

>  	[MTK_DISP_BLS] = "bls",

> +	[MTK_DISP_POSTMASK] = "postmask",

>  };

>  

>  struct mtk_ddp_comp_match {

> @@ -457,36 +498,37 @@ struct mtk_ddp_comp_match {

>  };

>  

>  static const struct mtk_ddp_comp_match mtk_ddp_matches[DDP_COMPONENT_ID_MAX] = {

> -	[DDP_COMPONENT_AAL0]	= { MTK_DISP_AAL,	0, &ddp_aal },

> -	[DDP_COMPONENT_AAL1]	= { MTK_DISP_AAL,	1, &ddp_aal },

> -	[DDP_COMPONENT_BLS]	= { MTK_DISP_BLS,	0, NULL },

> -	[DDP_COMPONENT_CCORR]	= { MTK_DISP_CCORR,	0, &ddp_ccorr },

> -	[DDP_COMPONENT_COLOR0]	= { MTK_DISP_COLOR,	0, &ddp_color },

> -	[DDP_COMPONENT_COLOR1]	= { MTK_DISP_COLOR,	1, &ddp_color },

> -	[DDP_COMPONENT_DITHER]	= { MTK_DISP_DITHER,	0, &ddp_dither },

> -	[DDP_COMPONENT_DPI0]	= { MTK_DPI,		0, &ddp_dpi },

> -	[DDP_COMPONENT_DPI1]	= { MTK_DPI,		1, &ddp_dpi },

> -	[DDP_COMPONENT_DSI0]	= { MTK_DSI,		0, &ddp_dsi },

> -	[DDP_COMPONENT_DSI1]	= { MTK_DSI,		1, &ddp_dsi },

> -	[DDP_COMPONENT_DSI2]	= { MTK_DSI,		2, &ddp_dsi },

> -	[DDP_COMPONENT_DSI3]	= { MTK_DSI,		3, &ddp_dsi },

> -	[DDP_COMPONENT_GAMMA]	= { MTK_DISP_GAMMA,	0, &ddp_gamma },

> -	[DDP_COMPONENT_OD0]	= { MTK_DISP_OD,	0, &ddp_od },

> -	[DDP_COMPONENT_OD1]	= { MTK_DISP_OD,	1, &ddp_od },

> -	[DDP_COMPONENT_OVL0]	= { MTK_DISP_OVL,	0, &ddp_ovl },

> -	[DDP_COMPONENT_OVL1]	= { MTK_DISP_OVL,	1, &ddp_ovl },

> -	[DDP_COMPONENT_OVL_2L0]	= { MTK_DISP_OVL_2L,	0, &ddp_ovl },

> -	[DDP_COMPONENT_OVL_2L1]	= { MTK_DISP_OVL_2L,	1, &ddp_ovl },

> -	[DDP_COMPONENT_OVL_2L2] = { MTK_DISP_OVL_2L,    2, &ddp_ovl },

> -	[DDP_COMPONENT_PWM0]	= { MTK_DISP_PWM,	0, NULL },

> -	[DDP_COMPONENT_PWM1]	= { MTK_DISP_PWM,	1, NULL },

> -	[DDP_COMPONENT_PWM2]	= { MTK_DISP_PWM,	2, NULL },

> -	[DDP_COMPONENT_RDMA0]	= { MTK_DISP_RDMA,	0, &ddp_rdma },

> -	[DDP_COMPONENT_RDMA1]	= { MTK_DISP_RDMA,	1, &ddp_rdma },

> -	[DDP_COMPONENT_RDMA2]	= { MTK_DISP_RDMA,	2, &ddp_rdma },

> -	[DDP_COMPONENT_UFOE]	= { MTK_DISP_UFOE,	0, &ddp_ufoe },

> -	[DDP_COMPONENT_WDMA0]	= { MTK_DISP_WDMA,	0, NULL },

> -	[DDP_COMPONENT_WDMA1]	= { MTK_DISP_WDMA,	1, NULL },

> +	[DDP_COMPONENT_AAL0]		= { MTK_DISP_AAL,	0, &ddp_aal },

> +	[DDP_COMPONENT_AAL1]		= { MTK_DISP_AAL,	1, &ddp_aal },

> +	[DDP_COMPONENT_BLS]		= { MTK_DISP_BLS,	0, NULL },

> +	[DDP_COMPONENT_CCORR]		= { MTK_DISP_CCORR,	0, &ddp_ccorr },

> +	[DDP_COMPONENT_COLOR0]		= { MTK_DISP_COLOR,	0, &ddp_color },

> +	[DDP_COMPONENT_COLOR1]		= { MTK_DISP_COLOR,	1, &ddp_color },

> +	[DDP_COMPONENT_DITHER]		= { MTK_DISP_DITHER,	0, &ddp_dither },

> +	[DDP_COMPONENT_DPI0]		= { MTK_DPI,		0, &ddp_dpi },

> +	[DDP_COMPONENT_DPI1]		= { MTK_DPI,		1, &ddp_dpi },

> +	[DDP_COMPONENT_DSI0]		= { MTK_DSI,		0, &ddp_dsi },

> +	[DDP_COMPONENT_DSI1]		= { MTK_DSI,		1, &ddp_dsi },

> +	[DDP_COMPONENT_DSI2]		= { MTK_DSI,		2, &ddp_dsi },

> +	[DDP_COMPONENT_DSI3]		= { MTK_DSI,		3, &ddp_dsi },

> +	[DDP_COMPONENT_GAMMA]		= { MTK_DISP_GAMMA,	0, &ddp_gamma },

> +	[DDP_COMPONENT_OD0]		= { MTK_DISP_OD,	0, &ddp_od },

> +	[DDP_COMPONENT_OD1]		= { MTK_DISP_OD,	1, &ddp_od },

> +	[DDP_COMPONENT_OVL0]		= { MTK_DISP_OVL,	0, &ddp_ovl },

> +	[DDP_COMPONENT_OVL1]		= { MTK_DISP_OVL,	1, &ddp_ovl },

> +	[DDP_COMPONENT_OVL_2L0]		= { MTK_DISP_OVL_2L,	0, &ddp_ovl },

> +	[DDP_COMPONENT_OVL_2L1]		= { MTK_DISP_OVL_2L,	1, &ddp_ovl },

> +	[DDP_COMPONENT_OVL_2L2]		= { MTK_DISP_OVL_2L,    2, &ddp_ovl },

> +	[DDP_COMPONENT_POSTMASK0]	= { MTK_DISP_POSTMASK,	0, &ddp_postmask },

> +	[DDP_COMPONENT_PWM0]		= { MTK_DISP_PWM,	0, NULL },

> +	[DDP_COMPONENT_PWM1]		= { MTK_DISP_PWM,	1, NULL },

> +	[DDP_COMPONENT_PWM2]		= { MTK_DISP_PWM,	2, NULL },

> +	[DDP_COMPONENT_RDMA0]		= { MTK_DISP_RDMA,	0, &ddp_rdma },

> +	[DDP_COMPONENT_RDMA1]		= { MTK_DISP_RDMA,	1, &ddp_rdma },

> +	[DDP_COMPONENT_RDMA2]		= { MTK_DISP_RDMA,	2, &ddp_rdma },

> +	[DDP_COMPONENT_UFOE]		= { MTK_DISP_UFOE,	0, &ddp_ufoe },

> +	[DDP_COMPONENT_WDMA0]		= { MTK_DISP_WDMA,	0, NULL },

> +	[DDP_COMPONENT_WDMA1]		= { MTK_DISP_WDMA,	1, NULL },

>  };

>  

>  static bool mtk_drm_find_comp_in_ddp(struct device *dev,

> diff --git a/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.h b/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.h

> index bb914d976cf5d..cd1dec6b4cdf2 100644

> --- a/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.h

> +++ b/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.h

> @@ -30,6 +30,7 @@ enum mtk_ddp_comp_type {

>  	MTK_DISP_UFOE,

>  	MTK_DSI,

>  	MTK_DPI,

> +	MTK_DISP_POSTMASK,

>  	MTK_DISP_PWM,

>  	MTK_DISP_MUTEX,

>  	MTK_DISP_OD,
diff mbox series

Patch

diff --git a/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.c b/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.c
index b6c4e73031ca6..0a84ae53eb72a 100644
--- a/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.c
+++ b/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.c
@@ -64,6 +64,12 @@ 
 
 #define AAL_EN					BIT(0)
 
+#define DISP_POSTMASK_EN			0x0000
+#define POSTMASK_EN				BIT(0)
+#define DISP_POSTMASK_CFG			0x0020
+#define POSTMASK_RELAY_MODE			BIT(0)
+#define DISP_POSTMASK_SIZE			0x0030
+
 #define DISP_DITHERING				BIT(2)
 #define DITHER_LSB_ERR_SHIFT_R(x)		(((x) & 0x7) << 28)
 #define DITHER_OVFLW_BIT_R(x)			(((x) & 0x7) << 24)
@@ -204,6 +210,32 @@  static void mtk_ufoe_start(struct device *dev)
 	writel(UFO_BYPASS, priv->regs + DISP_REG_UFO_START);
 }
 
+void mtk_postmask_config(struct device *dev, unsigned int w,
+			unsigned int h, unsigned int vrefresh,
+			unsigned int bpc, struct cmdq_pkt *cmdq_pkt)
+{
+	struct mtk_ddp_comp_dev *priv = dev_get_drvdata(dev);
+
+	mtk_ddp_write(cmdq_pkt, w << 16 | h, &priv->cmdq_reg, priv->regs,
+		      DISP_POSTMASK_SIZE);
+	mtk_ddp_write(cmdq_pkt, POSTMASK_RELAY_MODE, &priv->cmdq_reg,
+		      priv->regs, DISP_POSTMASK_CFG);
+}
+
+void mtk_postmask_start(struct device *dev)
+{
+	struct mtk_ddp_comp_dev *priv = dev_get_drvdata(dev);
+
+	writel(POSTMASK_EN, priv->regs + DISP_POSTMASK_EN);
+}
+
+void mtk_postmask_stop(struct device *dev)
+{
+	struct mtk_ddp_comp_dev *priv = dev_get_drvdata(dev);
+
+	writel_relaxed(0x0, priv->regs + DISP_POSTMASK_EN);
+}
+
 static void mtk_aal_config(struct device *dev, unsigned int w,
 			   unsigned int h, unsigned int vrefresh,
 			   unsigned int bpc, struct cmdq_pkt *cmdq_pkt)
@@ -413,6 +445,14 @@  static const struct mtk_ddp_comp_funcs ddp_ovl = {
 	.bgclr_in_off = mtk_ovl_bgclr_in_off,
 };
 
+static const struct mtk_ddp_comp_funcs ddp_postmask = {
+	.clk_enable = mtk_ddp_clk_enable,
+	.clk_disable = mtk_ddp_clk_disable,
+	.config = mtk_postmask_config,
+	.start = mtk_postmask_start,
+	.stop = mtk_postmask_stop,
+};
+
 static const struct mtk_ddp_comp_funcs ddp_rdma = {
 	.clk_enable = mtk_rdma_clk_enable,
 	.clk_disable = mtk_rdma_clk_disable,
@@ -448,6 +488,7 @@  static const char * const mtk_ddp_comp_stem[MTK_DDP_COMP_TYPE_MAX] = {
 	[MTK_DISP_MUTEX] = "mutex",
 	[MTK_DISP_OD] = "od",
 	[MTK_DISP_BLS] = "bls",
+	[MTK_DISP_POSTMASK] = "postmask",
 };
 
 struct mtk_ddp_comp_match {
@@ -457,36 +498,37 @@  struct mtk_ddp_comp_match {
 };
 
 static const struct mtk_ddp_comp_match mtk_ddp_matches[DDP_COMPONENT_ID_MAX] = {
-	[DDP_COMPONENT_AAL0]	= { MTK_DISP_AAL,	0, &ddp_aal },
-	[DDP_COMPONENT_AAL1]	= { MTK_DISP_AAL,	1, &ddp_aal },
-	[DDP_COMPONENT_BLS]	= { MTK_DISP_BLS,	0, NULL },
-	[DDP_COMPONENT_CCORR]	= { MTK_DISP_CCORR,	0, &ddp_ccorr },
-	[DDP_COMPONENT_COLOR0]	= { MTK_DISP_COLOR,	0, &ddp_color },
-	[DDP_COMPONENT_COLOR1]	= { MTK_DISP_COLOR,	1, &ddp_color },
-	[DDP_COMPONENT_DITHER]	= { MTK_DISP_DITHER,	0, &ddp_dither },
-	[DDP_COMPONENT_DPI0]	= { MTK_DPI,		0, &ddp_dpi },
-	[DDP_COMPONENT_DPI1]	= { MTK_DPI,		1, &ddp_dpi },
-	[DDP_COMPONENT_DSI0]	= { MTK_DSI,		0, &ddp_dsi },
-	[DDP_COMPONENT_DSI1]	= { MTK_DSI,		1, &ddp_dsi },
-	[DDP_COMPONENT_DSI2]	= { MTK_DSI,		2, &ddp_dsi },
-	[DDP_COMPONENT_DSI3]	= { MTK_DSI,		3, &ddp_dsi },
-	[DDP_COMPONENT_GAMMA]	= { MTK_DISP_GAMMA,	0, &ddp_gamma },
-	[DDP_COMPONENT_OD0]	= { MTK_DISP_OD,	0, &ddp_od },
-	[DDP_COMPONENT_OD1]	= { MTK_DISP_OD,	1, &ddp_od },
-	[DDP_COMPONENT_OVL0]	= { MTK_DISP_OVL,	0, &ddp_ovl },
-	[DDP_COMPONENT_OVL1]	= { MTK_DISP_OVL,	1, &ddp_ovl },
-	[DDP_COMPONENT_OVL_2L0]	= { MTK_DISP_OVL_2L,	0, &ddp_ovl },
-	[DDP_COMPONENT_OVL_2L1]	= { MTK_DISP_OVL_2L,	1, &ddp_ovl },
-	[DDP_COMPONENT_OVL_2L2] = { MTK_DISP_OVL_2L,    2, &ddp_ovl },
-	[DDP_COMPONENT_PWM0]	= { MTK_DISP_PWM,	0, NULL },
-	[DDP_COMPONENT_PWM1]	= { MTK_DISP_PWM,	1, NULL },
-	[DDP_COMPONENT_PWM2]	= { MTK_DISP_PWM,	2, NULL },
-	[DDP_COMPONENT_RDMA0]	= { MTK_DISP_RDMA,	0, &ddp_rdma },
-	[DDP_COMPONENT_RDMA1]	= { MTK_DISP_RDMA,	1, &ddp_rdma },
-	[DDP_COMPONENT_RDMA2]	= { MTK_DISP_RDMA,	2, &ddp_rdma },
-	[DDP_COMPONENT_UFOE]	= { MTK_DISP_UFOE,	0, &ddp_ufoe },
-	[DDP_COMPONENT_WDMA0]	= { MTK_DISP_WDMA,	0, NULL },
-	[DDP_COMPONENT_WDMA1]	= { MTK_DISP_WDMA,	1, NULL },
+	[DDP_COMPONENT_AAL0]		= { MTK_DISP_AAL,	0, &ddp_aal },
+	[DDP_COMPONENT_AAL1]		= { MTK_DISP_AAL,	1, &ddp_aal },
+	[DDP_COMPONENT_BLS]		= { MTK_DISP_BLS,	0, NULL },
+	[DDP_COMPONENT_CCORR]		= { MTK_DISP_CCORR,	0, &ddp_ccorr },
+	[DDP_COMPONENT_COLOR0]		= { MTK_DISP_COLOR,	0, &ddp_color },
+	[DDP_COMPONENT_COLOR1]		= { MTK_DISP_COLOR,	1, &ddp_color },
+	[DDP_COMPONENT_DITHER]		= { MTK_DISP_DITHER,	0, &ddp_dither },
+	[DDP_COMPONENT_DPI0]		= { MTK_DPI,		0, &ddp_dpi },
+	[DDP_COMPONENT_DPI1]		= { MTK_DPI,		1, &ddp_dpi },
+	[DDP_COMPONENT_DSI0]		= { MTK_DSI,		0, &ddp_dsi },
+	[DDP_COMPONENT_DSI1]		= { MTK_DSI,		1, &ddp_dsi },
+	[DDP_COMPONENT_DSI2]		= { MTK_DSI,		2, &ddp_dsi },
+	[DDP_COMPONENT_DSI3]		= { MTK_DSI,		3, &ddp_dsi },
+	[DDP_COMPONENT_GAMMA]		= { MTK_DISP_GAMMA,	0, &ddp_gamma },
+	[DDP_COMPONENT_OD0]		= { MTK_DISP_OD,	0, &ddp_od },
+	[DDP_COMPONENT_OD1]		= { MTK_DISP_OD,	1, &ddp_od },
+	[DDP_COMPONENT_OVL0]		= { MTK_DISP_OVL,	0, &ddp_ovl },
+	[DDP_COMPONENT_OVL1]		= { MTK_DISP_OVL,	1, &ddp_ovl },
+	[DDP_COMPONENT_OVL_2L0]		= { MTK_DISP_OVL_2L,	0, &ddp_ovl },
+	[DDP_COMPONENT_OVL_2L1]		= { MTK_DISP_OVL_2L,	1, &ddp_ovl },
+	[DDP_COMPONENT_OVL_2L2]		= { MTK_DISP_OVL_2L,    2, &ddp_ovl },
+	[DDP_COMPONENT_POSTMASK0]	= { MTK_DISP_POSTMASK,	0, &ddp_postmask },
+	[DDP_COMPONENT_PWM0]		= { MTK_DISP_PWM,	0, NULL },
+	[DDP_COMPONENT_PWM1]		= { MTK_DISP_PWM,	1, NULL },
+	[DDP_COMPONENT_PWM2]		= { MTK_DISP_PWM,	2, NULL },
+	[DDP_COMPONENT_RDMA0]		= { MTK_DISP_RDMA,	0, &ddp_rdma },
+	[DDP_COMPONENT_RDMA1]		= { MTK_DISP_RDMA,	1, &ddp_rdma },
+	[DDP_COMPONENT_RDMA2]		= { MTK_DISP_RDMA,	2, &ddp_rdma },
+	[DDP_COMPONENT_UFOE]		= { MTK_DISP_UFOE,	0, &ddp_ufoe },
+	[DDP_COMPONENT_WDMA0]		= { MTK_DISP_WDMA,	0, NULL },
+	[DDP_COMPONENT_WDMA1]		= { MTK_DISP_WDMA,	1, NULL },
 };
 
 static bool mtk_drm_find_comp_in_ddp(struct device *dev,
diff --git a/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.h b/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.h
index bb914d976cf5d..cd1dec6b4cdf2 100644
--- a/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.h
+++ b/drivers/gpu/drm/mediatek/mtk_drm_ddp_comp.h
@@ -30,6 +30,7 @@  enum mtk_ddp_comp_type {
 	MTK_DISP_UFOE,
 	MTK_DSI,
 	MTK_DPI,
+	MTK_DISP_POSTMASK,
 	MTK_DISP_PWM,
 	MTK_DISP_MUTEX,
 	MTK_DISP_OD,