Add TDSHP component support for MT8196.
TDSHP is a hardware module designed to enhance the sharpness and
clarity of displayed images by analyzing and improving edges and
fine details in frames.

Reviewed-by: CK Hu <ck...@mediatek.com>
Reviewed-by: AngeloGioacchino Del Regno 
<angelogioacchino.delre...@collabora.com>
Signed-off-by: Jay Liu <jay....@mediatek.com>
---
 drivers/gpu/drm/mediatek/mtk_ddp_comp.c | 49 +++++++++++++++++++++++++
 drivers/gpu/drm/mediatek/mtk_ddp_comp.h |  1 +
 drivers/gpu/drm/mediatek/mtk_drm_drv.c  |  2 +
 3 files changed, 52 insertions(+)

diff --git a/drivers/gpu/drm/mediatek/mtk_ddp_comp.c 
b/drivers/gpu/drm/mediatek/mtk_ddp_comp.c
index 850e3b18da61..c63a12c41215 100644
--- a/drivers/gpu/drm/mediatek/mtk_ddp_comp.c
+++ b/drivers/gpu/drm/mediatek/mtk_ddp_comp.c
@@ -57,6 +57,14 @@
 #define POSTMASK_RELAY_MODE                            BIT(0)
 #define DISP_REG_POSTMASK_SIZE                 0x0030
 
+#define DISP_REG_TDSHP_CTRL                    0x0100
+#define DISP_TDSHP_CTRL_EN                     BIT(0)
+#define DISP_REG_TDSHP_CFG                     0x0110
+#define DISP_TDSHP_RELAY_MODE                  BIT(0)
+#define DISP_REG_TDSHP_INPUT_SIZE              0x0120
+#define DISP_REG_TDSHP_OUTPUT_OFFSET           0x0124
+#define DISP_REG_TDSHP_OUTPUT_SIZE             0x0128
+
 #define DISP_REG_UFO_START                     0x0000
 #define UFO_BYPASS                             BIT(2)
 
@@ -261,6 +269,37 @@ static void mtk_postmask_stop(struct device *dev)
        writel_relaxed(0x0, priv->regs + DISP_REG_POSTMASK_EN);
 }
 
+static void mtk_disp_tdshp_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_REG_TDSHP_INPUT_SIZE);
+       mtk_ddp_write(cmdq_pkt, w << 16 | h, &priv->cmdq_reg, priv->regs,
+                     DISP_REG_TDSHP_OUTPUT_SIZE);
+       mtk_ddp_write(cmdq_pkt, 0x0, &priv->cmdq_reg, priv->regs,
+                     DISP_REG_TDSHP_OUTPUT_OFFSET);
+
+       mtk_ddp_write(cmdq_pkt, DISP_TDSHP_RELAY_MODE, &priv->cmdq_reg,
+                     priv->regs, DISP_REG_TDSHP_CFG);
+}
+
+static void mtk_disp_tdshp_start(struct device *dev)
+{
+       struct mtk_ddp_comp_dev *priv = dev_get_drvdata(dev);
+
+       writel(DISP_TDSHP_CTRL_EN, priv->regs + DISP_REG_TDSHP_CTRL);
+}
+
+static void mtk_disp_tdshp_stop(struct device *dev)
+{
+       struct mtk_ddp_comp_dev *priv = dev_get_drvdata(dev);
+
+       writel(0, priv->regs + DISP_REG_TDSHP_CTRL);
+}
+
 static void mtk_ufoe_start(struct device *dev)
 {
        struct mtk_ddp_comp_dev *priv = dev_get_drvdata(dev);
@@ -268,6 +307,14 @@ static void mtk_ufoe_start(struct device *dev)
        writel(UFO_BYPASS, priv->regs + DISP_REG_UFO_START);
 }
 
+static const struct mtk_ddp_comp_funcs ddp_tdshp = {
+       .clk_enable = mtk_ddp_clk_enable,
+       .clk_disable = mtk_ddp_clk_disable,
+       .config = mtk_disp_tdshp_config,
+       .start = mtk_disp_tdshp_start,
+       .stop = mtk_disp_tdshp_stop,
+};
+
 static const struct mtk_ddp_comp_funcs ddp_aal = {
        .clk_enable = mtk_aal_clk_enable,
        .clk_disable = mtk_aal_clk_disable,
@@ -441,6 +488,7 @@ static const char * const 
mtk_ddp_comp_stem[MTK_DDP_COMP_TYPE_MAX] = {
        [MTK_DISP_POSTMASK] = "postmask",
        [MTK_DISP_PWM] = "pwm",
        [MTK_DISP_RDMA] = "rdma",
+       [MTK_DISP_TDSHP] = "tdshp",
        [MTK_DISP_UFOE] = "ufoe",
        [MTK_DISP_WDMA] = "wdma",
        [MTK_DP_INTF] = "dp-intf",
@@ -496,6 +544,7 @@ static const struct mtk_ddp_comp_match 
mtk_ddp_matches[DDP_COMPONENT_DRM_ID_MAX]
        [DDP_COMPONENT_RDMA1]           = { MTK_DISP_RDMA,              1, 
&ddp_rdma },
        [DDP_COMPONENT_RDMA2]           = { MTK_DISP_RDMA,              2, 
&ddp_rdma },
        [DDP_COMPONENT_RDMA4]           = { MTK_DISP_RDMA,              4, 
&ddp_rdma },
+       [DDP_COMPONENT_TDSHP0]          = { MTK_DISP_TDSHP,             0, 
&ddp_tdshp },
        [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 
},
diff --git a/drivers/gpu/drm/mediatek/mtk_ddp_comp.h 
b/drivers/gpu/drm/mediatek/mtk_ddp_comp.h
index 98a701ac4cde..a03fa3385d2f 100644
--- a/drivers/gpu/drm/mediatek/mtk_ddp_comp.h
+++ b/drivers/gpu/drm/mediatek/mtk_ddp_comp.h
@@ -38,6 +38,7 @@ enum mtk_ddp_comp_type {
        MTK_DISP_POSTMASK,
        MTK_DISP_PWM,
        MTK_DISP_RDMA,
+       MTK_DISP_TDSHP,
        MTK_DISP_UFOE,
        MTK_DISP_WDMA,
        MTK_DPI,
diff --git a/drivers/gpu/drm/mediatek/mtk_drm_drv.c 
b/drivers/gpu/drm/mediatek/mtk_drm_drv.c
index d5e6bab36414..042cf03c7a54 100644
--- a/drivers/gpu/drm/mediatek/mtk_drm_drv.c
+++ b/drivers/gpu/drm/mediatek/mtk_drm_drv.c
@@ -812,6 +812,8 @@ static const struct of_device_id mtk_ddp_comp_dt_ids[] = {
          .data = (void *)MTK_DISP_RDMA },
        { .compatible = "mediatek,mt8195-disp-rdma",
          .data = (void *)MTK_DISP_RDMA },
+       { .compatible = "mediatek,mt8196-disp-tdshp",
+         .data = (void *)MTK_DISP_TDSHP },
        { .compatible = "mediatek,mt8173-disp-ufoe",
          .data = (void *)MTK_DISP_UFOE },
        { .compatible = "mediatek,mt8173-disp-wdma",
-- 
2.46.0

Reply via email to