Re: [PATCH v17 03/10] drm/mediatek: Add MT8195 Embedded DisplayPort driver

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

 



Hi, Bo-Chen:

Please help to fix the compile warning:

../drivers/gpu/drm/mediatek/mtk_dp.c: In function ‘mtk_dp_video_mute’:
../drivers/gpu/drm/mediatek/mtk_dp.c:947:23: warning: format ‘%x’
expects argument of type ‘unsigned int’, but argument 4 has type ‘long
unsigned int’ [-Wformat=]
  947 |  dev_dbg(mtk_dp->dev, "smc cmd: 0x%x, p1: 0x%x, ret: 0x%lx-0x%lx\n",
      |                       ^~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
../include/linux/dev_printk.h:129:27: note: in definition of macro ‘dev_printk’
  129 |   _dev_printk(level, dev, fmt, ##__VA_ARGS__);  \
      |                           ^~~
../include/linux/dev_printk.h:163:31: note: in expansion of macro ‘dev_fmt’
  163 |   dev_printk(KERN_DEBUG, dev, dev_fmt(fmt), ##__VA_ARGS__); \
      |                               ^~~~~~~
../drivers/gpu/drm/mediatek/mtk_dp.c:947:2: note: in expansion of
macro ‘dev_dbg’
  947 |  dev_dbg(mtk_dp->dev, "smc cmd: 0x%x, p1: 0x%x, ret: 0x%lx-0x%lx\n",
      |  ^~~~~~~
../drivers/gpu/drm/mediatek/mtk_dp.c:947:36: note: format string is defined here
  947 |  dev_dbg(mtk_dp->dev, "smc cmd: 0x%x, p1: 0x%x, ret: 0x%lx-0x%lx\n",
      |                                   ~^
      |                                    |
      |                                    unsigned int
      |                                   %lx

Regards,
Chun-Kuang.

Bo-Chen Chen <rex-bc.chen@xxxxxxxxxxxx> 於 2022年9月1日 週四 中午12:42寫道:
>
> From: Markus Schneider-Pargmann <msp@xxxxxxxxxxxx>
>
> This patch adds a embedded displayport driver for the MediaTek mt8195 SoC.
>
> It supports the MT8195, the embedded DisplayPort units. It offers
> DisplayPort 1.4 with up to 4 lanes.
>
> The driver creates a child device for the phy. The child device will
> never exist without the parent being active. As they are sharing a
> register range, the parent passes a regmap pointer to the child so that
> both can work with the same register range. The phy driver sets device
> data that is read by the parent to get the phy device that can be used
> to control the phy properties.
>
> This driver is based on an initial version by
> Jitao shi <jitao.shi@xxxxxxxxxxxx>
>
> Signed-off-by: Markus Schneider-Pargmann <msp@xxxxxxxxxxxx>
> Signed-off-by: Guillaume Ranquet <granquet@xxxxxxxxxxxx>
> Signed-off-by: Bo-Chen Chen <rex-bc.chen@xxxxxxxxxxxx>
> ---
>  drivers/gpu/drm/mediatek/Kconfig      |    9 +
>  drivers/gpu/drm/mediatek/Makefile     |    2 +
>  drivers/gpu/drm/mediatek/mtk_dp.c     | 1999 +++++++++++++++++++++++++
>  drivers/gpu/drm/mediatek/mtk_dp_reg.h |  305 ++++
>  4 files changed, 2315 insertions(+)
>  create mode 100644 drivers/gpu/drm/mediatek/mtk_dp.c
>  create mode 100644 drivers/gpu/drm/mediatek/mtk_dp_reg.h
>
> diff --git a/drivers/gpu/drm/mediatek/Kconfig b/drivers/gpu/drm/mediatek/Kconfig
> index 2976d21e9a34..e66f4a3b6be0 100644
> --- a/drivers/gpu/drm/mediatek/Kconfig
> +++ b/drivers/gpu/drm/mediatek/Kconfig
> @@ -21,6 +21,15 @@ config DRM_MEDIATEK
>           This driver provides kernel mode setting and
>           buffer management to userspace.
>
> +config DRM_MEDIATEK_DP
> +       tristate "DRM DPTX Support for MediaTek SoCs"
> +       depends on DRM_MEDIATEK
> +       select PHY_MTK_DP
> +       select DRM_DISPLAY_HELPER
> +       select DRM_DISPLAY_DP_HELPER
> +       help
> +         DRM/KMS Display Port driver for MediaTek SoCs.
> +
>  config DRM_MEDIATEK_HDMI
>         tristate "DRM HDMI Support for Mediatek SoCs"
>         depends on DRM_MEDIATEK
> diff --git a/drivers/gpu/drm/mediatek/Makefile b/drivers/gpu/drm/mediatek/Makefile
> index 6e604a933ed0..3517d1c65cd7 100644
> --- a/drivers/gpu/drm/mediatek/Makefile
> +++ b/drivers/gpu/drm/mediatek/Makefile
> @@ -23,3 +23,5 @@ mediatek-drm-hdmi-objs := mtk_cec.o \
>                           mtk_hdmi_ddc.o
>
>  obj-$(CONFIG_DRM_MEDIATEK_HDMI) += mediatek-drm-hdmi.o
> +
> +obj-$(CONFIG_DRM_MEDIATEK_DP) += mtk_dp.o
> diff --git a/drivers/gpu/drm/mediatek/mtk_dp.c b/drivers/gpu/drm/mediatek/mtk_dp.c
> new file mode 100644
> index 000000000000..e2ec9b02b1aa
> --- /dev/null
> +++ b/drivers/gpu/drm/mediatek/mtk_dp.c
> @@ -0,0 +1,1999 @@
> +// SPDX-License-Identifier: GPL-2.0
> +/*
> + * Copyright (c) 2019-2022 MediaTek Inc.
> + * Copyright (c) 2022 BayLibre
> + */
> +
> +#include <drm/display/drm_dp.h>
> +#include <drm/display/drm_dp_helper.h>
> +#include <drm/drm_atomic_helper.h>
> +#include <drm/drm_bridge.h>
> +#include <drm/drm_crtc.h>
> +#include <drm/drm_edid.h>
> +#include <drm/drm_of.h>
> +#include <drm/drm_panel.h>
> +#include <drm/drm_print.h>
> +#include <drm/drm_probe_helper.h>
> +#include <linux/arm-smccc.h>
> +#include <linux/clk.h>
> +#include <linux/delay.h>
> +#include <linux/errno.h>
> +#include <linux/kernel.h>
> +#include <linux/media-bus-format.h>
> +#include <linux/nvmem-consumer.h>
> +#include <linux/of.h>
> +#include <linux/of_irq.h>
> +#include <linux/of_platform.h>
> +#include <linux/phy/phy.h>
> +#include <linux/platform_device.h>
> +#include <linux/pm_runtime.h>
> +#include <linux/regmap.h>
> +#include <linux/soc/mediatek/mtk_sip_svc.h>
> +#include <video/videomode.h>
> +
> +#include "mtk_dp_reg.h"
> +
> +#define MTK_DP_SIP_CONTROL_AARCH32     MTK_SIP_SMC_CMD(0x523)
> +#define MTK_DP_SIP_ATF_EDP_VIDEO_UNMUTE        (BIT(0) | BIT(5))
> +
> +#define MTK_DP_THREAD_CABLE_STATE_CHG  BIT(0)
> +#define MTK_DP_THREAD_HPD_EVENT                BIT(1)
> +
> +#define MTK_DP_4P1T 4
> +#define MTK_DP_HDE 2
> +#define MTK_DP_PIX_PER_ADDR 2
> +#define MTK_DP_AUX_WAIT_REPLY_COUNT 20
> +#define MTK_DP_TBC_BUF_READ_START_ADDR 0x8
> +#define MTK_DP_TRAIN_VOLTAGE_LEVEL_RETRY 5
> +#define MTK_DP_TRAIN_DOWNSCALE_RETRY 10
> +
> +enum {
> +       MTK_DP_CAL_GLB_BIAS_TRIM = 0,
> +       MTK_DP_CAL_CLKTX_IMPSE,
> +       MTK_DP_CAL_LN_TX_IMPSEL_PMOS_0,
> +       MTK_DP_CAL_LN_TX_IMPSEL_PMOS_1,
> +       MTK_DP_CAL_LN_TX_IMPSEL_PMOS_2,
> +       MTK_DP_CAL_LN_TX_IMPSEL_PMOS_3,
> +       MTK_DP_CAL_LN_TX_IMPSEL_NMOS_0,
> +       MTK_DP_CAL_LN_TX_IMPSEL_NMOS_1,
> +       MTK_DP_CAL_LN_TX_IMPSEL_NMOS_2,
> +       MTK_DP_CAL_LN_TX_IMPSEL_NMOS_3,
> +       MTK_DP_CAL_MAX,
> +};
> +
> +struct mtk_dp_train_info {
> +       bool sink_ssc;
> +       bool cable_plugged_in;
> +       /* link_rate is in multiple of 0.27Gbps */
> +       int link_rate;
> +       int lane_count;
> +       unsigned int channel_eq_pattern;
> +};
> +
> +struct mtk_dp_info {
> +       enum dp_pixelformat format;
> +       struct videomode vm;
> +};
> +
> +struct mtk_dp_efuse_fmt {
> +       unsigned short idx;
> +       unsigned short shift;
> +       unsigned short mask;
> +       unsigned short min_val;
> +       unsigned short max_val;
> +       unsigned short default_val;
> +};
> +
> +struct mtk_dp {
> +       bool enabled;
> +       u8 max_lanes;
> +       u8 max_linkrate;
> +       u8 rx_cap[DP_RECEIVER_CAP_SIZE];
> +       u32 cal_data[MTK_DP_CAL_MAX];
> +       u32 irq_thread_handle;
> +       /* irq_thread_lock is used to protect irq_thread_handle */
> +       spinlock_t irq_thread_lock;
> +
> +       struct device *dev;
> +       struct drm_bridge bridge;
> +       struct drm_bridge *next_bridge;
> +       struct drm_connector *conn;
> +       struct drm_device *drm_dev;
> +       struct drm_dp_aux aux;
> +
> +       struct mtk_dp_info info;
> +       struct mtk_dp_train_info train_info;
> +
> +       struct platform_device *phy_dev;
> +       struct phy *phy;
> +       struct regmap *regs;
> +};
> +
> +static const struct mtk_dp_efuse_fmt mtk_dp_efuse_data[MTK_DP_CAL_MAX] = {
> +       [MTK_DP_CAL_GLB_BIAS_TRIM] = {
> +               .idx = 3,
> +               .shift = 27,
> +               .mask = 0x1f,
> +               .min_val = 1,
> +               .max_val = 0x1e,
> +               .default_val = 0xf,
> +       },
> +       [MTK_DP_CAL_CLKTX_IMPSE] = {
> +               .idx = 0,
> +               .shift = 9,
> +               .mask = 0xf,
> +               .min_val = 1,
> +               .max_val = 0xe,
> +               .default_val = 0x8,
> +       },
> +       [MTK_DP_CAL_LN_TX_IMPSEL_PMOS_0] = {
> +               .idx = 2,
> +               .shift = 28,
> +               .mask = 0xf,
> +               .min_val = 1,
> +               .max_val = 0xe,
> +               .default_val = 0x8,
> +       },
> +       [MTK_DP_CAL_LN_TX_IMPSEL_PMOS_1] = {
> +               .idx = 2,
> +               .shift = 20,
> +               .mask = 0xf,
> +               .min_val = 1,
> +               .max_val = 0xe,
> +               .default_val = 0x8,
> +       },
> +       [MTK_DP_CAL_LN_TX_IMPSEL_PMOS_2] = {
> +               .idx = 2,
> +               .shift = 12,
> +               .mask = 0xf,
> +               .min_val = 1,
> +               .max_val = 0xe,
> +               .default_val = 0x8,
> +       },
> +       [MTK_DP_CAL_LN_TX_IMPSEL_PMOS_3] = {
> +               .idx = 2,
> +               .shift = 4,
> +               .mask = 0xf,
> +               .min_val = 1,
> +               .max_val = 0xe,
> +               .default_val = 0x8,
> +       },
> +       [MTK_DP_CAL_LN_TX_IMPSEL_NMOS_0] = {
> +               .idx = 2,
> +               .shift = 24,
> +               .mask = 0xf,
> +               .min_val = 1,
> +               .max_val = 0xe,
> +               .default_val = 0x8,
> +       },
> +       [MTK_DP_CAL_LN_TX_IMPSEL_NMOS_1] = {
> +               .idx = 2,
> +               .shift = 16,
> +               .mask = 0xf,
> +               .min_val = 1,
> +               .max_val = 0xe,
> +               .default_val = 0x8,
> +       },
> +       [MTK_DP_CAL_LN_TX_IMPSEL_NMOS_2] = {
> +               .idx = 2,
> +               .shift = 8,
> +               .mask = 0xf,
> +               .min_val = 1,
> +               .max_val = 0xe,
> +               .default_val = 0x8,
> +       },
> +       [MTK_DP_CAL_LN_TX_IMPSEL_NMOS_3] = {
> +               .idx = 2,
> +               .shift = 0,
> +               .mask = 0xf,
> +               .min_val = 1,
> +               .max_val = 0xe,
> +               .default_val = 0x8,
> +       },
> +};
> +
> +static struct regmap_config mtk_dp_regmap_config = {
> +       .reg_bits = 32,
> +       .val_bits = 32,
> +       .reg_stride = 4,
> +       .max_register = SEC_OFFSET + 0x90,
> +       .name = "mtk-dp-registers",
> +};
> +
> +static struct mtk_dp *mtk_dp_from_bridge(struct drm_bridge *b)
> +{
> +       return container_of(b, struct mtk_dp, bridge);
> +}
> +
> +static u32 mtk_dp_read(struct mtk_dp *mtk_dp, u32 offset)
> +{
> +       u32 read_val;
> +       int ret;
> +
> +       ret = regmap_read(mtk_dp->regs, offset, &read_val);
> +       if (ret) {
> +               dev_err(mtk_dp->dev, "Failed to read register 0x%x: %d\n",
> +                       offset, ret);
> +               return 0;
> +       }
> +
> +       return read_val;
> +}
> +
> +static int mtk_dp_write(struct mtk_dp *mtk_dp, u32 offset, u32 val)
> +{
> +       int ret = regmap_write(mtk_dp->regs, offset, val);
> +
> +       if (ret)
> +               dev_err(mtk_dp->dev,
> +                       "Failed to write register 0x%x with value 0x%x\n",
> +                       offset, val);
> +       return ret;
> +}
> +
> +static int mtk_dp_update_bits(struct mtk_dp *mtk_dp, u32 offset,
> +                             u32 val, u32 mask)
> +{
> +       int ret = regmap_update_bits(mtk_dp->regs, offset, mask, val);
> +
> +       if (ret)
> +               dev_err(mtk_dp->dev,
> +                       "Failed to update register 0x%x with value 0x%x, mask 0x%x\n",
> +                       offset, val, mask);
> +       return ret;
> +}
> +
> +static void mtk_dp_bulk_16bit_write(struct mtk_dp *mtk_dp, u32 offset, u8 *buf,
> +                                   size_t length)
> +{
> +       int i;
> +
> +       /* 2 bytes per register */
> +       for (i = 0; i < length; i += 2) {
> +               u32 val = buf[i] | (i + 1 < length ? buf[i + 1] << 8 : 0);
> +
> +               if (mtk_dp_write(mtk_dp, offset + i * 2, val))
> +                       return;
> +       }
> +}
> +
> +static void mtk_dp_msa_bypass_enable(struct mtk_dp *mtk_dp, bool enable)
> +{
> +       u32 mask = HTOTAL_SEL_DP_ENC0_P0 | VTOTAL_SEL_DP_ENC0_P0 |
> +                  HSTART_SEL_DP_ENC0_P0 | VSTART_SEL_DP_ENC0_P0 |
> +                  HWIDTH_SEL_DP_ENC0_P0 | VHEIGHT_SEL_DP_ENC0_P0 |
> +                  HSP_SEL_DP_ENC0_P0 | HSW_SEL_DP_ENC0_P0 |
> +                  VSP_SEL_DP_ENC0_P0 | VSW_SEL_DP_ENC0_P0;
> +
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_3030, enable ? 0 : mask, mask);
> +}
> +
> +static void mtk_dp_set_msa(struct mtk_dp *mtk_dp)
> +{
> +       struct drm_display_mode mode;
> +       struct videomode *vm = &mtk_dp->info.vm;
> +
> +       drm_display_mode_from_videomode(vm, &mode);
> +
> +       /* horizontal */
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_3010,
> +                          mode.htotal, HTOTAL_SW_DP_ENC0_P0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_3018,
> +                          vm->hsync_len + vm->hback_porch,
> +                          HSTART_SW_DP_ENC0_P0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_3028,
> +                          vm->hsync_len, HSW_SW_DP_ENC0_P0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_3028,
> +                          0, HSP_SW_DP_ENC0_P0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_3020,
> +                          vm->hactive, HWIDTH_SW_DP_ENC0_P0_MASK);
> +
> +       /* vertical */
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_3014,
> +                          mode.vtotal, VTOTAL_SW_DP_ENC0_P0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_301C,
> +                          vm->vsync_len + vm->vback_porch,
> +                          VSTART_SW_DP_ENC0_P0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_302C,
> +                          vm->vsync_len, VSW_SW_DP_ENC0_P0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_302C,
> +                          0, VSP_SW_DP_ENC0_P0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_3024,
> +                          vm->vactive, VHEIGHT_SW_DP_ENC0_P0_MASK);
> +
> +       /* horizontal */
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_3064,
> +                          vm->hactive, HDE_NUM_LAST_DP_ENC0_P0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_3154,
> +                          mode.htotal, PGEN_HTOTAL_DP_ENC0_P0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_3158,
> +                          vm->hfront_porch,
> +                          PGEN_HSYNC_RISING_DP_ENC0_P0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_315C,
> +                          vm->hsync_len,
> +                          PGEN_HSYNC_PULSE_WIDTH_DP_ENC0_P0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_3160,
> +                          vm->hback_porch + vm->hsync_len,
> +                          PGEN_HFDE_START_DP_ENC0_P0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_3164,
> +                          vm->hactive,
> +                          PGEN_HFDE_ACTIVE_WIDTH_DP_ENC0_P0_MASK);
> +
> +       /* vertical */
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_3168,
> +                          mode.vtotal,
> +                          PGEN_VTOTAL_DP_ENC0_P0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_316C,
> +                          vm->vfront_porch,
> +                          PGEN_VSYNC_RISING_DP_ENC0_P0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_3170,
> +                          vm->vsync_len,
> +                          PGEN_VSYNC_PULSE_WIDTH_DP_ENC0_P0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_3174,
> +                          vm->vback_porch + vm->vsync_len,
> +                          PGEN_VFDE_START_DP_ENC0_P0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_3178,
> +                          vm->vactive,
> +                          PGEN_VFDE_ACTIVE_WIDTH_DP_ENC0_P0_MASK);
> +}
> +
> +static int mtk_dp_set_color_format(struct mtk_dp *mtk_dp,
> +                                  enum dp_pixelformat color_format)
> +{
> +       u32 val;
> +
> +       /* update MISC0 */
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_3034,
> +                          color_format << DP_TEST_COLOR_FORMAT_SHIFT,
> +                          DP_TEST_COLOR_FORMAT_MASK);
> +
> +       switch (color_format) {
> +       case DP_PIXELFORMAT_YUV422:
> +               val = PIXEL_ENCODE_FORMAT_DP_ENC0_P0_YCBCR422;
> +               break;
> +       case DP_PIXELFORMAT_RGB:
> +               val = PIXEL_ENCODE_FORMAT_DP_ENC0_P0_RGB;
> +               break;
> +       default:
> +               drm_warn(mtk_dp->drm_dev, "Unsupported color format: %d\n",
> +                        color_format);
> +               return -EINVAL;
> +       }
> +
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_303C,
> +                          val, PIXEL_ENCODE_FORMAT_DP_ENC0_P0_MASK);
> +       return 0;
> +}
> +
> +static void mtk_dp_set_color_depth(struct mtk_dp *mtk_dp)
> +{
> +       /* Only support 8 bits currently */
> +       /* Update MISC0 */
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_3034,
> +                          DP_MSA_MISC_8_BPC, DP_TEST_BIT_DEPTH_MASK);
> +
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_303C,
> +                          VIDEO_COLOR_DEPTH_DP_ENC0_P0_8BIT,
> +                          VIDEO_COLOR_DEPTH_DP_ENC0_P0_MASK);
> +}
> +
> +static void mtk_dp_config_mn_mode(struct mtk_dp *mtk_dp)
> +{
> +       /* 0: hw mode, 1: sw mode */
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_3004,
> +                          0, VIDEO_M_CODE_SEL_DP_ENC0_P0_MASK);
> +}
> +
> +static void mtk_dp_set_sram_read_start(struct mtk_dp *mtk_dp, u32 val)
> +{
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_303C,
> +                          val, SRAM_START_READ_THRD_DP_ENC0_P0_MASK);
> +}
> +
> +static void mtk_dp_setup_encoder(struct mtk_dp *mtk_dp)
> +{
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_303C,
> +                          VIDEO_MN_GEN_EN_DP_ENC0_P0,
> +                          VIDEO_MN_GEN_EN_DP_ENC0_P0);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_3040,
> +                          SDP_DOWN_CNT_DP_ENC0_P0_VAL,
> +                          SDP_DOWN_CNT_INIT_DP_ENC0_P0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC1_P0_3364,
> +                          SDP_DOWN_CNT_IN_HBLANK_DP_ENC1_P0_VAL,
> +                          SDP_DOWN_CNT_INIT_IN_HBLANK_DP_ENC1_P0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC1_P0_3300,
> +                          VIDEO_AFIFO_RDY_SEL_DP_ENC1_P0_VAL << 8,
> +                          VIDEO_AFIFO_RDY_SEL_DP_ENC1_P0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC1_P0_3364,
> +                          FIFO_READ_START_POINT_DP_ENC1_P0_VAL << 12,
> +                          FIFO_READ_START_POINT_DP_ENC1_P0_MASK);
> +       mtk_dp_write(mtk_dp, MTK_DP_ENC1_P0_3368, DP_ENC1_P0_3368_VAL);
> +}
> +
> +static void mtk_dp_pg_enable(struct mtk_dp *mtk_dp, bool enable)
> +{
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_3038,
> +                          enable ? VIDEO_SOURCE_SEL_DP_ENC0_P0_MASK : 0,
> +                          VIDEO_SOURCE_SEL_DP_ENC0_P0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_31B0,
> +                          PGEN_PATTERN_SEL_VAL << 4, PGEN_PATTERN_SEL_MASK);
> +}
> +
> +static void mtk_dp_aux_irq_clear(struct mtk_dp *mtk_dp)
> +{
> +       mtk_dp_write(mtk_dp, MTK_DP_AUX_P0_3640, DP_AUX_P0_3640_VAL);
> +}
> +
> +static void mtk_dp_aux_set_cmd(struct mtk_dp *mtk_dp, u8 cmd, u32 addr)
> +{
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_AUX_P0_3644,
> +                          cmd, MCU_REQUEST_COMMAND_AUX_TX_P0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_AUX_P0_3648,
> +                          addr, MCU_REQUEST_ADDRESS_LSB_AUX_TX_P0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_AUX_P0_364C,
> +                          addr >> 16, MCU_REQUEST_ADDRESS_MSB_AUX_TX_P0_MASK);
> +}
> +
> +static void mtk_dp_aux_clear_fifo(struct mtk_dp *mtk_dp)
> +{
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_AUX_P0_3650,
> +                          MCU_ACK_TRAN_COMPLETE_AUX_TX_P0,
> +                          MCU_ACK_TRAN_COMPLETE_AUX_TX_P0 |
> +                          PHY_FIFO_RST_AUX_TX_P0_MASK |
> +                          MCU_REQ_DATA_NUM_AUX_TX_P0_MASK);
> +}
> +
> +static void mtk_dp_aux_request_ready(struct mtk_dp *mtk_dp)
> +{
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_AUX_P0_3630,
> +                          AUX_TX_REQUEST_READY_AUX_TX_P0,
> +                          AUX_TX_REQUEST_READY_AUX_TX_P0);
> +}
> +
> +static void mtk_dp_aux_fill_write_fifo(struct mtk_dp *mtk_dp, u8 *buf,
> +                                      size_t length)
> +{
> +       mtk_dp_bulk_16bit_write(mtk_dp, MTK_DP_AUX_P0_3708, buf, length);
> +}
> +
> +static void mtk_dp_aux_read_rx_fifo(struct mtk_dp *mtk_dp, u8 *buf,
> +                                   size_t length, int read_delay)
> +{
> +       int read_pos;
> +
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_AUX_P0_3620,
> +                          0, AUX_RD_MODE_AUX_TX_P0_MASK);
> +
> +       for (read_pos = 0; read_pos < length; read_pos++) {
> +               mtk_dp_update_bits(mtk_dp, MTK_DP_AUX_P0_3620,
> +                                  AUX_RX_FIFO_READ_PULSE_TX_P0,
> +                                  AUX_RX_FIFO_READ_PULSE_TX_P0);
> +
> +               /* Hardware needs time to update the data */
> +               usleep_range(read_delay, read_delay * 2);
> +               buf[read_pos] = (u8)(mtk_dp_read(mtk_dp, MTK_DP_AUX_P0_3620) &
> +                                    AUX_RX_FIFO_READ_DATA_AUX_TX_P0_MASK);
> +       }
> +}
> +
> +static void mtk_dp_aux_set_length(struct mtk_dp *mtk_dp, size_t length)
> +{
> +       if (length > 0) {
> +               mtk_dp_update_bits(mtk_dp, MTK_DP_AUX_P0_3650,
> +                                  (length - 1) << 12,
> +                                  MCU_REQ_DATA_NUM_AUX_TX_P0_MASK);
> +               mtk_dp_update_bits(mtk_dp, MTK_DP_AUX_P0_362C,
> +                                  0,
> +                                  AUX_NO_LENGTH_AUX_TX_P0 |
> +                                  AUX_TX_AUXTX_OV_EN_AUX_TX_P0_MASK |
> +                                  AUX_RESERVED_RW_0_AUX_TX_P0_MASK);
> +       } else {
> +               mtk_dp_update_bits(mtk_dp, MTK_DP_AUX_P0_362C,
> +                                  AUX_NO_LENGTH_AUX_TX_P0,
> +                                  AUX_NO_LENGTH_AUX_TX_P0 |
> +                                  AUX_TX_AUXTX_OV_EN_AUX_TX_P0_MASK |
> +                                  AUX_RESERVED_RW_0_AUX_TX_P0_MASK);
> +       }
> +}
> +
> +static int mtk_dp_aux_wait_for_completion(struct mtk_dp *mtk_dp, bool is_read)
> +{
> +       int wait_reply = MTK_DP_AUX_WAIT_REPLY_COUNT;
> +
> +       while (--wait_reply) {
> +               u32 aux_irq_status;
> +
> +               if (is_read) {
> +                       u32 fifo_status = mtk_dp_read(mtk_dp, MTK_DP_AUX_P0_3618);
> +
> +                       if (fifo_status &
> +                           (AUX_RX_FIFO_WRITE_POINTER_AUX_TX_P0_MASK |
> +                            AUX_RX_FIFO_FULL_AUX_TX_P0_MASK)) {
> +                               return 0;
> +                       }
> +               }
> +
> +               aux_irq_status = mtk_dp_read(mtk_dp, MTK_DP_AUX_P0_3640);
> +               if (aux_irq_status & AUX_RX_AUX_RECV_COMPLETE_IRQ_AUX_TX_P0)
> +                       return 0;
> +
> +               if (aux_irq_status & AUX_400US_TIMEOUT_IRQ_AUX_TX_P0)
> +                       return -ETIMEDOUT;
> +
> +               /* Give the hardware a chance to reach completion before retrying */
> +               usleep_range(100, 500);
> +       }
> +
> +       return -ETIMEDOUT;
> +}
> +
> +static int mtk_dp_aux_do_transfer(struct mtk_dp *mtk_dp, bool is_read, u8 cmd,
> +                                 u32 addr, u8 *buf, size_t length)
> +{
> +       int ret;
> +       u32 reply_cmd;
> +
> +       if (is_read && (length > DP_AUX_MAX_PAYLOAD_BYTES ||
> +                       (cmd == DP_AUX_NATIVE_READ && !length)))
> +               return -EINVAL;
> +
> +       if (!is_read)
> +               mtk_dp_update_bits(mtk_dp, MTK_DP_AUX_P0_3704,
> +                                  AUX_TX_FIFO_NEW_MODE_EN_AUX_TX_P0,
> +                                  AUX_TX_FIFO_NEW_MODE_EN_AUX_TX_P0);
> +
> +       /* We need to clear fifo and irq before sending commands to the sink device. */
> +       mtk_dp_aux_clear_fifo(mtk_dp);
> +       mtk_dp_aux_irq_clear(mtk_dp);
> +
> +       mtk_dp_aux_set_cmd(mtk_dp, cmd, addr);
> +       mtk_dp_aux_set_length(mtk_dp, length);
> +
> +       if (!is_read) {
> +               if (length)
> +                       mtk_dp_aux_fill_write_fifo(mtk_dp, buf, length);
> +
> +               mtk_dp_update_bits(mtk_dp, MTK_DP_AUX_P0_3704,
> +                                  AUX_TX_FIFO_WDATA_NEW_MODE_T_AUX_TX_P0_MASK,
> +                                  AUX_TX_FIFO_WDATA_NEW_MODE_T_AUX_TX_P0_MASK);
> +       }
> +
> +       mtk_dp_aux_request_ready(mtk_dp);
> +
> +       /* Wait for feedback from sink device. */
> +       ret = mtk_dp_aux_wait_for_completion(mtk_dp, is_read);
> +
> +       reply_cmd = mtk_dp_read(mtk_dp, MTK_DP_AUX_P0_3624) &
> +                   AUX_RX_REPLY_COMMAND_AUX_TX_P0_MASK;
> +
> +       if (ret || reply_cmd) {
> +               u32 phy_status = mtk_dp_read(mtk_dp, MTK_DP_AUX_P0_3628) &
> +                                AUX_RX_PHY_STATE_AUX_TX_P0_MASK;
> +               if (phy_status != AUX_RX_PHY_STATE_AUX_TX_P0_RX_IDLE) {
> +                       drm_err(mtk_dp->drm_dev,
> +                               "AUX Rx Aux hang, need SW reset\n");
> +                       return -EIO;
> +               }
> +
> +               return -ETIMEDOUT;
> +       }
> +
> +       if (!length) {
> +               mtk_dp_update_bits(mtk_dp, MTK_DP_AUX_P0_362C,
> +                                  0,
> +                                  AUX_NO_LENGTH_AUX_TX_P0 |
> +                                  AUX_TX_AUXTX_OV_EN_AUX_TX_P0_MASK |
> +                                  AUX_RESERVED_RW_0_AUX_TX_P0_MASK);
> +       } else if (is_read) {
> +               int read_delay;
> +
> +               if (cmd == (DP_AUX_I2C_READ | DP_AUX_I2C_MOT) ||
> +                   cmd == DP_AUX_I2C_READ)
> +                       read_delay = 500;
> +               else
> +                       read_delay = 100;
> +
> +               mtk_dp_aux_read_rx_fifo(mtk_dp, buf, length, read_delay);
> +       }
> +
> +       return 0;
> +}
> +
> +static void mtk_dp_set_swing_pre_emphasis(struct mtk_dp *mtk_dp, int lane_num,
> +                                         int swing_val, int preemphasis)
> +{
> +       u32 lane_shift = lane_num * DP_TX1_VOLT_SWING_SHIFT;
> +
> +       dev_dbg(mtk_dp->dev,
> +               "link training: swing_val = 0x%x, pre-emphasis = 0x%x\n",
> +               swing_val, preemphasis);
> +
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_TOP_SWING_EMP,
> +                          swing_val << (DP_TX0_VOLT_SWING_SHIFT + lane_shift),
> +                          DP_TX0_VOLT_SWING_MASK << lane_shift);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_TOP_SWING_EMP,
> +                          preemphasis << (DP_TX0_PRE_EMPH_SHIFT + lane_shift),
> +                          DP_TX0_PRE_EMPH_MASK << lane_shift);
> +}
> +
> +static void mtk_dp_reset_swing_pre_emphasis(struct mtk_dp *mtk_dp)
> +{
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_TOP_SWING_EMP,
> +                          0,
> +                          DP_TX0_VOLT_SWING_MASK |
> +                          DP_TX1_VOLT_SWING_MASK |
> +                          DP_TX2_VOLT_SWING_MASK |
> +                          DP_TX3_VOLT_SWING_MASK |
> +                          DP_TX0_PRE_EMPH_MASK |
> +                          DP_TX1_PRE_EMPH_MASK |
> +                          DP_TX2_PRE_EMPH_MASK |
> +                          DP_TX3_PRE_EMPH_MASK);
> +}
> +
> +static u32 mtk_dp_swirq_get_clear(struct mtk_dp *mtk_dp)
> +{
> +       u32 irq_status = mtk_dp_read(mtk_dp, MTK_DP_TRANS_P0_35D0) &
> +                        SW_IRQ_FINAL_STATUS_DP_TRANS_P0_MASK;
> +
> +       if (irq_status) {
> +               mtk_dp_update_bits(mtk_dp, MTK_DP_TRANS_P0_35C8,
> +                                  irq_status, SW_IRQ_CLR_DP_TRANS_P0_MASK);
> +               mtk_dp_update_bits(mtk_dp, MTK_DP_TRANS_P0_35C8,
> +                                  0, SW_IRQ_CLR_DP_TRANS_P0_MASK);
> +       }
> +
> +       return irq_status;
> +}
> +
> +static u32 mtk_dp_hwirq_get_clear(struct mtk_dp *mtk_dp)
> +{
> +       u32 irq_status = (mtk_dp_read(mtk_dp, MTK_DP_TRANS_P0_3418) &
> +                         IRQ_STATUS_DP_TRANS_P0_MASK) >> 12;
> +
> +       if (irq_status) {
> +               mtk_dp_update_bits(mtk_dp, MTK_DP_TRANS_P0_3418,
> +                                  irq_status, IRQ_CLR_DP_TRANS_P0_MASK);
> +               mtk_dp_update_bits(mtk_dp, MTK_DP_TRANS_P0_3418,
> +                                  0, IRQ_CLR_DP_TRANS_P0_MASK);
> +       }
> +
> +       return irq_status;
> +}
> +
> +static void mtk_dp_hwirq_enable(struct mtk_dp *mtk_dp, bool enable)
> +{
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_TRANS_P0_3418,
> +                          enable ? 0 :
> +                          IRQ_MASK_DP_TRANS_P0_DISC_IRQ |
> +                          IRQ_MASK_DP_TRANS_P0_CONN_IRQ |
> +                          IRQ_MASK_DP_TRANS_P0_INT_IRQ,
> +                          IRQ_MASK_DP_TRANS_P0_MASK);
> +}
> +
> +static void mtk_dp_initialize_settings(struct mtk_dp *mtk_dp)
> +{
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_TRANS_P0_342C,
> +                          XTAL_FREQ_DP_TRANS_P0_DEFAULT,
> +                          XTAL_FREQ_DP_TRANS_P0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_TRANS_P0_3540,
> +                          FEC_CLOCK_EN_MODE_DP_TRANS_P0,
> +                          FEC_CLOCK_EN_MODE_DP_TRANS_P0);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_31EC,
> +                          AUDIO_CH_SRC_SEL_DP_ENC0_P0,
> +                          AUDIO_CH_SRC_SEL_DP_ENC0_P0);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_304C,
> +                          0, SDP_VSYNC_RISING_MASK_DP_ENC0_P0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_TOP_IRQ_MASK,
> +                          IRQ_MASK_AUX_TOP_IRQ, IRQ_MASK_AUX_TOP_IRQ);
> +}
> +
> +static void mtk_dp_initialize_hpd_detect_settings(struct mtk_dp *mtk_dp)
> +{
> +       u32 val;
> +       /* Debounce threshold */
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_TRANS_P0_3410,
> +                          8, HPD_DEB_THD_DP_TRANS_P0_MASK);
> +
> +       val = (HPD_INT_THD_DP_TRANS_P0_LOWER_500US |
> +              HPD_INT_THD_DP_TRANS_P0_UPPER_1100US) << 4;
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_TRANS_P0_3410,
> +                          val, HPD_INT_THD_DP_TRANS_P0_MASK);
> +
> +       /*
> +        * Connect threshold 1.5ms + 5 x 0.1ms = 2ms
> +        * Disconnect threshold 1.5ms + 5 x 0.1ms = 2ms
> +        */
> +       val = (5 << 8) | (5 << 12);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_TRANS_P0_3410,
> +                          val,
> +                          HPD_DISC_THD_DP_TRANS_P0_MASK |
> +                          HPD_CONN_THD_DP_TRANS_P0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_TRANS_P0_3430,
> +                          HPD_INT_THD_ECO_DP_TRANS_P0_HIGH_BOUND_EXT,
> +                          HPD_INT_THD_ECO_DP_TRANS_P0_MASK);
> +}
> +
> +static void mtk_dp_initialize_aux_settings(struct mtk_dp *mtk_dp)
> +{
> +       /* modify timeout threshold = 0x1595 */
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_AUX_P0_360C,
> +                          AUX_TIMEOUT_THR_AUX_TX_P0_VAL,
> +                          AUX_TIMEOUT_THR_AUX_TX_P0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_AUX_P0_3658,
> +                          0, AUX_TX_OV_EN_AUX_TX_P0_MASK);
> +       /* 25 for 26M */
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_AUX_P0_3634,
> +                          AUX_TX_OVER_SAMPLE_RATE_FOR_26M << 8,
> +                          AUX_TX_OVER_SAMPLE_RATE_AUX_TX_P0_MASK);
> +       /* 13 for 26M */
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_AUX_P0_3614,
> +                          AUX_RX_UI_CNT_THR_AUX_FOR_26M,
> +                          AUX_RX_UI_CNT_THR_AUX_TX_P0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_AUX_P0_37C8,
> +                          MTK_ATOP_EN_AUX_TX_P0,
> +                          MTK_ATOP_EN_AUX_TX_P0);
> +}
> +
> +static void mtk_dp_initialize_digital_settings(struct mtk_dp *mtk_dp)
> +{
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_304C,
> +                          0, VBID_VIDEO_MUTE_DP_ENC0_P0_MASK);
> +
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC1_P0_3368,
> +                          BS2BS_MODE_DP_ENC1_P0_VAL << 12,
> +                          BS2BS_MODE_DP_ENC1_P0_MASK);
> +
> +       /* dp tx encoder reset all sw */
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_3004,
> +                          DP_TX_ENCODER_4P_RESET_SW_DP_ENC0_P0,
> +                          DP_TX_ENCODER_4P_RESET_SW_DP_ENC0_P0);
> +
> +       /* Wait for sw reset to complete */
> +       usleep_range(1000, 5000);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_3004,
> +                          0, DP_TX_ENCODER_4P_RESET_SW_DP_ENC0_P0);
> +}
> +
> +static void mtk_dp_digital_sw_reset(struct mtk_dp *mtk_dp)
> +{
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_TRANS_P0_340C,
> +                          DP_TX_TRANSMITTER_4P_RESET_SW_DP_TRANS_P0,
> +                          DP_TX_TRANSMITTER_4P_RESET_SW_DP_TRANS_P0);
> +
> +       /* Wait for sw reset to complete */
> +       usleep_range(1000, 5000);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_TRANS_P0_340C,
> +                          0, DP_TX_TRANSMITTER_4P_RESET_SW_DP_TRANS_P0);
> +}
> +
> +static void mtk_dp_set_lanes(struct mtk_dp *mtk_dp, int lanes)
> +{
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_TRANS_P0_35F0,
> +                          lanes == 0 ? 0 : DP_TRANS_DUMMY_RW_0,
> +                          DP_TRANS_DUMMY_RW_0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_3000,
> +                          lanes, LANE_NUM_DP_ENC0_P0_MASK);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_TRANS_P0_34A4,
> +                          lanes << 2, LANE_NUM_DP_TRANS_P0_MASK);
> +}
> +
> +static void mtk_dp_get_calibration_data(struct mtk_dp *mtk_dp)
> +{
> +       const struct mtk_dp_efuse_fmt *fmt;
> +       struct device *dev = mtk_dp->dev;
> +       struct nvmem_cell *cell;
> +       u32 *cal_data = mtk_dp->cal_data;
> +       u32 *buf;
> +       int i;
> +       size_t len;
> +
> +       cell = nvmem_cell_get(dev, "dp_calibration_data");
> +       if (IS_ERR(cell)) {
> +               dev_warn(dev, "Failed to get nvmem cell dp_calibration_data\n");
> +               goto use_default_val;
> +       }
> +
> +       buf = (u32 *)nvmem_cell_read(cell, &len);
> +       nvmem_cell_put(cell);
> +
> +       if (IS_ERR(buf) || ((len / sizeof(u32)) != 4)) {
> +               dev_warn(dev, "Failed to read nvmem_cell_read\n");
> +
> +               if (!IS_ERR(buf))
> +                       kfree(buf);
> +
> +               goto use_default_val;
> +       }
> +
> +       for (i = 0; i < MTK_DP_CAL_MAX; i++) {
> +               fmt = &mtk_dp_efuse_data[i];
> +               cal_data[i] = (buf[fmt->idx] >> fmt->shift) & fmt->mask;
> +
> +               if (cal_data[i] < fmt->min_val || cal_data[i] > fmt->max_val) {
> +                       dev_warn(mtk_dp->dev, "Invalid efuse data, idx = %d\n", i);
> +                       kfree(buf);
> +                       goto use_default_val;
> +               }
> +       }
> +       kfree(buf);
> +
> +       return;
> +
> +use_default_val:
> +       dev_warn(mtk_dp->dev, "Use default calibration data\n");
> +       for (i = 0; i < MTK_DP_CAL_MAX; i++)
> +               cal_data[i] = mtk_dp_efuse_data[i].default_val;
> +}
> +
> +static void mtk_dp_set_calibration_data(struct mtk_dp *mtk_dp)
> +{
> +       u32 *cal_data = mtk_dp->cal_data;
> +
> +       mtk_dp_update_bits(mtk_dp, DP_PHY_GLB_DPAUX_TX,
> +                          cal_data[MTK_DP_CAL_CLKTX_IMPSE] << 20,
> +                          RG_CKM_PT0_CKTX_IMPSEL);
> +       mtk_dp_update_bits(mtk_dp, DP_PHY_GLB_BIAS_GEN_00,
> +                          cal_data[MTK_DP_CAL_GLB_BIAS_TRIM] << 16,
> +                          RG_XTP_GLB_BIAS_INTR_CTRL);
> +       mtk_dp_update_bits(mtk_dp, DP_PHY_LANE_TX_0,
> +                          cal_data[MTK_DP_CAL_LN_TX_IMPSEL_PMOS_0] << 12,
> +                          RG_XTP_LN0_TX_IMPSEL_PMOS);
> +       mtk_dp_update_bits(mtk_dp, DP_PHY_LANE_TX_0,
> +                          cal_data[MTK_DP_CAL_LN_TX_IMPSEL_NMOS_0] << 16,
> +                          RG_XTP_LN0_TX_IMPSEL_NMOS);
> +       mtk_dp_update_bits(mtk_dp, DP_PHY_LANE_TX_1,
> +                          cal_data[MTK_DP_CAL_LN_TX_IMPSEL_PMOS_1] << 12,
> +                          RG_XTP_LN1_TX_IMPSEL_PMOS);
> +       mtk_dp_update_bits(mtk_dp, DP_PHY_LANE_TX_1,
> +                          cal_data[MTK_DP_CAL_LN_TX_IMPSEL_NMOS_1] << 16,
> +                          RG_XTP_LN1_TX_IMPSEL_NMOS);
> +       mtk_dp_update_bits(mtk_dp, DP_PHY_LANE_TX_2,
> +                          cal_data[MTK_DP_CAL_LN_TX_IMPSEL_PMOS_2] << 12,
> +                          RG_XTP_LN2_TX_IMPSEL_PMOS);
> +       mtk_dp_update_bits(mtk_dp, DP_PHY_LANE_TX_2,
> +                          cal_data[MTK_DP_CAL_LN_TX_IMPSEL_NMOS_2] << 16,
> +                          RG_XTP_LN2_TX_IMPSEL_NMOS);
> +       mtk_dp_update_bits(mtk_dp, DP_PHY_LANE_TX_3,
> +                          cal_data[MTK_DP_CAL_LN_TX_IMPSEL_PMOS_3] << 12,
> +                          RG_XTP_LN3_TX_IMPSEL_PMOS);
> +       mtk_dp_update_bits(mtk_dp, DP_PHY_LANE_TX_3,
> +                          cal_data[MTK_DP_CAL_LN_TX_IMPSEL_NMOS_3] << 16,
> +                          RG_XTP_LN3_TX_IMPSEL_NMOS);
> +}
> +
> +static int mtk_dp_phy_configure(struct mtk_dp *mtk_dp,
> +                               u32 link_rate, int lane_count)
> +{
> +       int ret;
> +       union phy_configure_opts phy_opts = {
> +               .dp = {
> +                       .link_rate = drm_dp_bw_code_to_link_rate(link_rate) / 100,
> +                       .set_rate = 1,
> +                       .lanes = lane_count,
> +                       .set_lanes = 1,
> +                       .ssc = mtk_dp->train_info.sink_ssc,
> +               }
> +       };
> +
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_TOP_PWR_STATE, DP_PWR_STATE_BANDGAP,
> +                          DP_PWR_STATE_MASK);
> +
> +       ret = phy_configure(mtk_dp->phy, &phy_opts);
> +       if (ret)
> +               return ret;
> +
> +       mtk_dp_set_calibration_data(mtk_dp);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_TOP_PWR_STATE,
> +                          DP_PWR_STATE_BANDGAP_TPLL_LANE, DP_PWR_STATE_MASK);
> +
> +       return 0;
> +}
> +
> +static void mtk_dp_set_idle_pattern(struct mtk_dp *mtk_dp, bool enable)
> +{
> +       u32 val = POST_MISC_DATA_LANE0_OV_DP_TRANS_P0_MASK |
> +                 POST_MISC_DATA_LANE1_OV_DP_TRANS_P0_MASK |
> +                 POST_MISC_DATA_LANE2_OV_DP_TRANS_P0_MASK |
> +                 POST_MISC_DATA_LANE3_OV_DP_TRANS_P0_MASK;
> +
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_TRANS_P0_3580,
> +                          enable ? val : 0, val);
> +}
> +
> +static void mtk_dp_train_set_pattern(struct mtk_dp *mtk_dp, int pattern)
> +{
> +       /* TPS1 */
> +       if (pattern == 1)
> +               mtk_dp_set_idle_pattern(mtk_dp, false);
> +
> +       mtk_dp_update_bits(mtk_dp,
> +                          MTK_DP_TRANS_P0_3400,
> +                          pattern ? BIT(pattern - 1) << 12 : 0,
> +                          PATTERN1_EN_DP_TRANS_P0_MASK |
> +                          PATTERN2_EN_DP_TRANS_P0_MASK |
> +                          PATTERN3_EN_DP_TRANS_P0_MASK |
> +                          PATTERN4_EN_DP_TRANS_P0_MASK);
> +}
> +
> +static void mtk_dp_set_enhanced_frame_mode(struct mtk_dp *mtk_dp)
> +{
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_3000,
> +                          ENHANCED_FRAME_EN_DP_ENC0_P0,
> +                          ENHANCED_FRAME_EN_DP_ENC0_P0);
> +}
> +
> +static void mtk_dp_training_set_scramble(struct mtk_dp *mtk_dp, bool enable)
> +{
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_TRANS_P0_3404,
> +                          enable ? DP_SCR_EN_DP_TRANS_P0_MASK : 0,
> +                          DP_SCR_EN_DP_TRANS_P0_MASK);
> +}
> +
> +static void mtk_dp_video_mute(struct mtk_dp *mtk_dp, bool enable)
> +{
> +       struct arm_smccc_res res;
> +       u32 val = VIDEO_MUTE_SEL_DP_ENC0_P0 |
> +                 (enable ? VIDEO_MUTE_SW_DP_ENC0_P0 : 0);
> +
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_ENC0_P0_3000,
> +                          val,
> +                          VIDEO_MUTE_SEL_DP_ENC0_P0 |
> +                          VIDEO_MUTE_SW_DP_ENC0_P0);
> +
> +       arm_smccc_smc(MTK_DP_SIP_CONTROL_AARCH32,
> +                     MTK_DP_SIP_ATF_EDP_VIDEO_UNMUTE, enable,
> +                     0, 0, 0, 0, 0, &res);
> +
> +       dev_dbg(mtk_dp->dev, "smc cmd: 0x%x, p1: 0x%x, ret: 0x%lx-0x%lx\n",
> +               MTK_DP_SIP_ATF_EDP_VIDEO_UNMUTE, enable, res.a0, res.a1);
> +}
> +
> +static void mtk_dp_power_enable(struct mtk_dp *mtk_dp)
> +{
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_TOP_RESET_AND_PROBE,
> +                          0, SW_RST_B_PHYD);
> +
> +       /* Wait for power enable */
> +       usleep_range(10, 200);
> +
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_TOP_RESET_AND_PROBE,
> +                          SW_RST_B_PHYD, SW_RST_B_PHYD);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_TOP_PWR_STATE,
> +                          DP_PWR_STATE_BANDGAP_TPLL, DP_PWR_STATE_MASK);
> +       mtk_dp_write(mtk_dp, MTK_DP_1040,
> +                    RG_DPAUX_RX_VALID_DEGLITCH_EN | RG_XTP_GLB_CKDET_EN |
> +                    RG_DPAUX_RX_EN);
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_0034, 0, DA_CKM_CKTX0_EN_FORCE_EN);
> +}
> +
> +static void mtk_dp_power_disable(struct mtk_dp *mtk_dp)
> +{
> +       mtk_dp_write(mtk_dp, MTK_DP_TOP_PWR_STATE, 0);
> +
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_0034,
> +                          DA_CKM_CKTX0_EN_FORCE_EN, DA_CKM_CKTX0_EN_FORCE_EN);
> +
> +       /* Disable RX */
> +       mtk_dp_write(mtk_dp, MTK_DP_1040, 0);
> +       mtk_dp_write(mtk_dp, MTK_DP_TOP_MEM_PD,
> +                    0x550 | FUSE_SEL | MEM_ISO_EN);
> +}
> +
> +static void mtk_dp_initialize_priv_data(struct mtk_dp *mtk_dp)
> +{
> +       mtk_dp->train_info.link_rate = DP_LINK_BW_5_4;
> +       mtk_dp->train_info.lane_count = mtk_dp->max_lanes;
> +       mtk_dp->train_info.cable_plugged_in = false;
> +
> +       mtk_dp->info.format = DP_PIXELFORMAT_RGB;
> +       memset(&mtk_dp->info.vm, 0, sizeof(struct videomode));
> +}
> +
> +static void mtk_dp_setup_tu(struct mtk_dp *mtk_dp)
> +{
> +       u32 sram_read_start = min_t(u32, MTK_DP_TBC_BUF_READ_START_ADDR,
> +                                   mtk_dp->info.vm.hactive /
> +                                   mtk_dp->train_info.lane_count /
> +                                   MTK_DP_4P1T / MTK_DP_HDE /
> +                                   MTK_DP_PIX_PER_ADDR);
> +       mtk_dp_set_sram_read_start(mtk_dp, sram_read_start);
> +       mtk_dp_setup_encoder(mtk_dp);
> +}
> +
> +static void mtk_dp_set_tx_out(struct mtk_dp *mtk_dp)
> +{
> +       mtk_dp_setup_tu(mtk_dp);
> +}
> +
> +static void mtk_dp_train_update_swing_pre(struct mtk_dp *mtk_dp, int lanes,
> +                                         u8 dpcd_adjust_req[2])
> +{
> +       int lane;
> +
> +       for (lane = 0; lane < lanes; ++lane) {
> +               u8 val;
> +               u8 swing;
> +               u8 preemphasis;
> +               int index = lane / 2;
> +               int shift = lane % 2 ? DP_ADJUST_VOLTAGE_SWING_LANE1_SHIFT : 0;
> +
> +               swing = (dpcd_adjust_req[index] >> shift) &
> +                       DP_ADJUST_VOLTAGE_SWING_LANE0_MASK;
> +               preemphasis = ((dpcd_adjust_req[index] >> shift) &
> +                              DP_ADJUST_PRE_EMPHASIS_LANE0_MASK) >>
> +                             DP_ADJUST_PRE_EMPHASIS_LANE0_SHIFT;
> +               val = swing << DP_TRAIN_VOLTAGE_SWING_SHIFT |
> +                     preemphasis << DP_TRAIN_PRE_EMPHASIS_SHIFT;
> +
> +               if (swing == DP_TRAIN_VOLTAGE_SWING_LEVEL_3)
> +                       val |= DP_TRAIN_MAX_SWING_REACHED;
> +               if (preemphasis == 3)
> +                       val |= DP_TRAIN_MAX_PRE_EMPHASIS_REACHED;
> +
> +               mtk_dp_set_swing_pre_emphasis(mtk_dp, lane, swing, preemphasis);
> +               drm_dp_dpcd_writeb(&mtk_dp->aux, DP_TRAINING_LANE0_SET + lane,
> +                                  val);
> +       }
> +}
> +
> +static void mtk_dp_pattern(struct mtk_dp *mtk_dp, bool is_tps1)
> +{
> +       int pattern;
> +       unsigned int aux_offset;
> +
> +       if (is_tps1) {
> +               pattern = 1;
> +               aux_offset = DP_LINK_SCRAMBLING_DISABLE | DP_TRAINING_PATTERN_1;
> +       } else {
> +               aux_offset = mtk_dp->train_info.channel_eq_pattern;
> +
> +               switch (mtk_dp->train_info.channel_eq_pattern) {
> +               case DP_TRAINING_PATTERN_4:
> +                       pattern = 4;
> +                       break;
> +               case DP_TRAINING_PATTERN_3:
> +                       pattern = 3;
> +                       aux_offset |= DP_LINK_SCRAMBLING_DISABLE;
> +                       break;
> +               case DP_TRAINING_PATTERN_2:
> +               default:
> +                       pattern = 2;
> +                       aux_offset |= DP_LINK_SCRAMBLING_DISABLE;
> +                       break;
> +               }
> +       }
> +
> +       mtk_dp_train_set_pattern(mtk_dp, pattern);
> +       drm_dp_dpcd_writeb(&mtk_dp->aux, DP_TRAINING_PATTERN_SET, aux_offset);
> +}
> +
> +static int mtk_dp_train_setting(struct mtk_dp *mtk_dp, u8 target_link_rate,
> +                               u8 target_lane_count)
> +{
> +       int ret;
> +
> +       drm_dp_dpcd_writeb(&mtk_dp->aux, DP_LINK_BW_SET, target_link_rate);
> +       drm_dp_dpcd_writeb(&mtk_dp->aux, DP_LANE_COUNT_SET,
> +                          target_lane_count | DP_LANE_COUNT_ENHANCED_FRAME_EN);
> +
> +       if (mtk_dp->train_info.sink_ssc)
> +               drm_dp_dpcd_writeb(&mtk_dp->aux, DP_DOWNSPREAD_CTRL,
> +                                  DP_SPREAD_AMP_0_5);
> +
> +       mtk_dp_set_lanes(mtk_dp, target_lane_count / 2);
> +       ret = mtk_dp_phy_configure(mtk_dp, target_link_rate, target_lane_count);
> +       if (ret)
> +               return ret;
> +
> +       dev_dbg(mtk_dp->dev,
> +               "Link train target_link_rate = 0x%x, target_lane_count = 0x%x\n",
> +               target_link_rate, target_lane_count);
> +
> +       return 0;
> +}
> +
> +static int mtk_dp_train_cr(struct mtk_dp *mtk_dp, u8 target_lane_count)
> +{
> +       u8 lane_adjust[2] = {};
> +       u8 link_status[DP_LINK_STATUS_SIZE] = {};
> +       u8 prev_lane_adjust = 0xff;
> +       int train_retries = 0;
> +       int voltage_retries = 0;
> +
> +       mtk_dp_pattern(mtk_dp, true);
> +
> +       /* In DP spec 1.4, the retry count of CR is defined as 10. */
> +       do {
> +               train_retries++;
> +               if (!mtk_dp->train_info.cable_plugged_in) {
> +                       mtk_dp_train_set_pattern(mtk_dp, 0);
> +                       return -ENODEV;
> +               }
> +
> +               drm_dp_dpcd_read(&mtk_dp->aux, DP_ADJUST_REQUEST_LANE0_1,
> +                                lane_adjust, sizeof(lane_adjust));
> +               mtk_dp_train_update_swing_pre(mtk_dp, target_lane_count,
> +                                             lane_adjust);
> +
> +               drm_dp_link_train_clock_recovery_delay(&mtk_dp->aux,
> +                                                      mtk_dp->rx_cap);
> +
> +               /* check link status from sink device */
> +               drm_dp_dpcd_read_link_status(&mtk_dp->aux, link_status);
> +               if (drm_dp_clock_recovery_ok(link_status,
> +                                            target_lane_count)) {
> +                       dev_dbg(mtk_dp->dev, "Link train CR pass\n");
> +                       return 0;
> +               }
> +
> +               /*
> +                * In DP spec 1.4, if current voltage level is the same
> +                * with previous voltage level, we need to retry 5 times.
> +                */
> +               if (prev_lane_adjust == link_status[4]) {
> +                       voltage_retries++;
> +                       /*
> +                        * Condition of CR fail:
> +                        * 1. Failed to pass CR using the same voltage
> +                        *    level over five times.
> +                        * 2. Failed to pass CR when the current voltage
> +                        *    level is the same with previous voltage
> +                        *    level and reach max voltage level (3).
> +                        */
> +                       if (voltage_retries > MTK_DP_TRAIN_VOLTAGE_LEVEL_RETRY ||
> +                           (prev_lane_adjust & DP_ADJUST_VOLTAGE_SWING_LANE0_MASK) == 3) {
> +                               dev_dbg(mtk_dp->dev, "Link train CR fail\n");
> +                               break;
> +                       }
> +               } else {
> +                       /*
> +                        * If the voltage level is changed, we need to
> +                        * re-calculate this retry count.
> +                        */
> +                       voltage_retries = 0;
> +               }
> +               prev_lane_adjust = link_status[4];
> +       } while (train_retries < MTK_DP_TRAIN_DOWNSCALE_RETRY);
> +
> +       /* Failed to train CR, and disable pattern. */
> +       drm_dp_dpcd_writeb(&mtk_dp->aux, DP_TRAINING_PATTERN_SET,
> +                          DP_TRAINING_PATTERN_DISABLE);
> +       mtk_dp_train_set_pattern(mtk_dp, 0);
> +
> +       return -ETIMEDOUT;
> +}
> +
> +static int mtk_dp_train_eq(struct mtk_dp *mtk_dp, u8 target_lane_count)
> +{
> +       u8 lane_adjust[2] = {};
> +       u8 link_status[DP_LINK_STATUS_SIZE] = {};
> +       int train_retries = 0;
> +
> +       mtk_dp_pattern(mtk_dp, false);
> +
> +       do {
> +               train_retries++;
> +               if (!mtk_dp->train_info.cable_plugged_in) {
> +                       mtk_dp_train_set_pattern(mtk_dp, 0);
> +                       return -ENODEV;
> +               }
> +
> +               drm_dp_dpcd_read(&mtk_dp->aux, DP_ADJUST_REQUEST_LANE0_1,
> +                                lane_adjust, sizeof(lane_adjust));
> +               mtk_dp_train_update_swing_pre(mtk_dp, target_lane_count,
> +                                             lane_adjust);
> +
> +               drm_dp_link_train_channel_eq_delay(&mtk_dp->aux,
> +                                                  mtk_dp->rx_cap);
> +
> +               /* check link status from sink device */
> +               drm_dp_dpcd_read_link_status(&mtk_dp->aux, link_status);
> +               if (drm_dp_channel_eq_ok(link_status, target_lane_count)) {
> +                       dev_dbg(mtk_dp->dev, "Link train EQ pass\n");
> +
> +                       /* Training done, and disable pattern. */
> +                       drm_dp_dpcd_writeb(&mtk_dp->aux, DP_TRAINING_PATTERN_SET,
> +                                          DP_TRAINING_PATTERN_DISABLE);
> +                       mtk_dp_train_set_pattern(mtk_dp, 0);
> +                       return 0;
> +               }
> +               dev_dbg(mtk_dp->dev, "Link train EQ fail\n");
> +       } while (train_retries < MTK_DP_TRAIN_DOWNSCALE_RETRY);
> +
> +       /* Failed to train EQ, and disable pattern. */
> +       drm_dp_dpcd_writeb(&mtk_dp->aux, DP_TRAINING_PATTERN_SET,
> +                          DP_TRAINING_PATTERN_DISABLE);
> +       mtk_dp_train_set_pattern(mtk_dp, 0);
> +
> +       return -ETIMEDOUT;
> +}
> +
> +static int mtk_dp_parse_capabilities(struct mtk_dp *mtk_dp)
> +{
> +       u8 val;
> +       ssize_t ret;
> +
> +       drm_dp_read_dpcd_caps(&mtk_dp->aux, mtk_dp->rx_cap);
> +
> +       if (drm_dp_tps4_supported(mtk_dp->rx_cap))
> +               mtk_dp->train_info.channel_eq_pattern = DP_TRAINING_PATTERN_4;
> +       else if (drm_dp_tps3_supported(mtk_dp->rx_cap))
> +               mtk_dp->train_info.channel_eq_pattern = DP_TRAINING_PATTERN_3;
> +       else
> +               mtk_dp->train_info.channel_eq_pattern = DP_TRAINING_PATTERN_2;
> +
> +       mtk_dp->train_info.sink_ssc = drm_dp_max_downspread(mtk_dp->rx_cap);
> +
> +       ret = drm_dp_dpcd_readb(&mtk_dp->aux, DP_MSTM_CAP, &val);
> +       if (ret < 1) {
> +               drm_err(mtk_dp->drm_dev, "Read mstm cap failed\n");
> +               return ret == 0 ? -EIO : ret;
> +       }
> +
> +       if (val & DP_MST_CAP) {
> +               /* Clear DP_DEVICE_SERVICE_IRQ_VECTOR_ESI0 */
> +               ret = drm_dp_dpcd_readb(&mtk_dp->aux,
> +                                       DP_DEVICE_SERVICE_IRQ_VECTOR_ESI0,
> +                                       &val);
> +               if (ret < 1) {
> +                       drm_err(mtk_dp->drm_dev, "Read irq vector failed\n");
> +                       return ret == 0 ? -EIO : ret;
> +               }
> +
> +               if (val)
> +                       drm_dp_dpcd_writeb(&mtk_dp->aux,
> +                                          DP_DEVICE_SERVICE_IRQ_VECTOR_ESI0,
> +                                          val);
> +       }
> +
> +       return 0;
> +}
> +
> +static void mtk_dp_train_change_mode(struct mtk_dp *mtk_dp)
> +{
> +       phy_reset(mtk_dp->phy);
> +       mtk_dp_reset_swing_pre_emphasis(mtk_dp);
> +}
> +
> +static int mtk_dp_training(struct mtk_dp *mtk_dp)
> +{
> +       int ret;
> +       u8 lane_count, link_rate, train_limit, max_link_rate;
> +
> +       link_rate = min_t(u8, mtk_dp->max_linkrate,
> +                         mtk_dp->rx_cap[DP_MAX_LINK_RATE]);
> +       max_link_rate = link_rate;
> +       lane_count = min_t(u8, mtk_dp->max_lanes,
> +                          drm_dp_max_lane_count(mtk_dp->rx_cap));
> +
> +       /*
> +        * TPS are generated by the hardware pattern generator. From the
> +        * hardware setting we need to disable this scramble setting before
> +        * use the TPS pattern generator.
> +        */
> +       mtk_dp_training_set_scramble(mtk_dp, false);
> +
> +       for (train_limit = 6; train_limit > 0; train_limit--) {
> +               mtk_dp_train_change_mode(mtk_dp);
> +
> +               ret = mtk_dp_train_setting(mtk_dp, link_rate, lane_count);
> +               if (ret)
> +                       return ret;
> +
> +               ret = mtk_dp_train_cr(mtk_dp, lane_count);
> +               if (ret == -ENODEV) {
> +                       return ret;
> +               } else if (ret) {
> +                       /* reduce link rate */
> +                       switch (link_rate) {
> +                       case DP_LINK_BW_1_62:
> +                               lane_count = lane_count / 2;
> +                               link_rate = max_link_rate;
> +                               if (lane_count == 0)
> +                                       return -EIO;
> +                               break;
> +                       case DP_LINK_BW_2_7:
> +                               link_rate = DP_LINK_BW_1_62;
> +                               break;
> +                       case DP_LINK_BW_5_4:
> +                               link_rate = DP_LINK_BW_2_7;
> +                               break;
> +                       case DP_LINK_BW_8_1:
> +                               link_rate = DP_LINK_BW_5_4;
> +                               break;
> +                       default:
> +                               return -EINVAL;
> +                       };
> +                       continue;
> +               }
> +
> +               ret = mtk_dp_train_eq(mtk_dp, lane_count);
> +               if (ret == -ENODEV) {
> +                       return ret;
> +               } else if (ret) {
> +                       /* reduce lane count */
> +                       if (lane_count == 0)
> +                               return -EIO;
> +                       lane_count /= 2;
> +                       continue;
> +               }
> +
> +               /* if we can run to this, training is done. */
> +               break;
> +       }
> +
> +       if (train_limit == 0)
> +               return -ETIMEDOUT;
> +
> +       mtk_dp->train_info.link_rate = link_rate;
> +       mtk_dp->train_info.lane_count = lane_count;
> +
> +       /*
> +        * After training done, we need to output normal stream instead of TPS,
> +        * so we need to enable scramble.
> +        */
> +       mtk_dp_training_set_scramble(mtk_dp, true);
> +       mtk_dp_set_enhanced_frame_mode(mtk_dp);
> +
> +       return 0;
> +}
> +
> +static void mtk_dp_video_enable(struct mtk_dp *mtk_dp, bool enable)
> +{
> +       /* the mute sequence is different between enable and disable */
> +       if (enable) {
> +               mtk_dp_msa_bypass_enable(mtk_dp, false);
> +               mtk_dp_pg_enable(mtk_dp, false);
> +               mtk_dp_set_tx_out(mtk_dp);
> +               mtk_dp_video_mute(mtk_dp, false);
> +       } else {
> +               mtk_dp_video_mute(mtk_dp, true);
> +               mtk_dp_pg_enable(mtk_dp, true);
> +               mtk_dp_msa_bypass_enable(mtk_dp, true);
> +       }
> +}
> +
> +static int mtk_dp_video_config(struct mtk_dp *mtk_dp)
> +{
> +       mtk_dp_config_mn_mode(mtk_dp);
> +       mtk_dp_set_msa(mtk_dp);
> +       mtk_dp_set_color_depth(mtk_dp);
> +       return mtk_dp_set_color_format(mtk_dp, mtk_dp->info.format);
> +}
> +
> +static void mtk_dp_init_port(struct mtk_dp *mtk_dp)
> +{
> +       mtk_dp_set_idle_pattern(mtk_dp, true);
> +       mtk_dp_initialize_priv_data(mtk_dp);
> +
> +       mtk_dp_initialize_settings(mtk_dp);
> +       mtk_dp_initialize_aux_settings(mtk_dp);
> +       mtk_dp_initialize_digital_settings(mtk_dp);
> +
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_AUX_P0_3690,
> +                          RX_REPLY_COMPLETE_MODE_AUX_TX_P0,
> +                          RX_REPLY_COMPLETE_MODE_AUX_TX_P0);
> +       mtk_dp_initialize_hpd_detect_settings(mtk_dp);
> +
> +       mtk_dp_digital_sw_reset(mtk_dp);
> +}
> +
> +static irqreturn_t mtk_dp_hpd_event_thread(int hpd, void *dev)
> +{
> +       struct mtk_dp *mtk_dp = dev;
> +       unsigned long flags;
> +       u32 status;
> +
> +       spin_lock_irqsave(&mtk_dp->irq_thread_lock, flags);
> +       status = mtk_dp->irq_thread_handle;
> +       mtk_dp->irq_thread_handle = 0;
> +       spin_unlock_irqrestore(&mtk_dp->irq_thread_lock, flags);
> +
> +       if (status & MTK_DP_THREAD_CABLE_STATE_CHG)
> +               drm_helper_hpd_irq_event(mtk_dp->bridge.dev);
> +
> +       if (status & MTK_DP_THREAD_HPD_EVENT)
> +               dev_dbg(mtk_dp->dev, "Receive IRQ from sink devices\n");
> +
> +       return IRQ_HANDLED;
> +}
> +
> +static irqreturn_t mtk_dp_hpd_event(int hpd, void *dev)
> +{
> +       struct mtk_dp *mtk_dp = dev;
> +       bool cable_sta_chg = false;
> +       unsigned long flags;
> +       u32 irq_status = mtk_dp_swirq_get_clear(mtk_dp) |
> +                        mtk_dp_hwirq_get_clear(mtk_dp);
> +
> +       if (!irq_status)
> +               return IRQ_HANDLED;
> +
> +       spin_lock_irqsave(&mtk_dp->irq_thread_lock, flags);
> +
> +       if (irq_status & MTK_DP_HPD_INTERRUPT)
> +               mtk_dp->irq_thread_handle |= MTK_DP_THREAD_HPD_EVENT;
> +
> +       /* Cable state is changed. */
> +       if (irq_status != MTK_DP_HPD_INTERRUPT) {
> +               mtk_dp->irq_thread_handle |= MTK_DP_THREAD_CABLE_STATE_CHG;
> +               cable_sta_chg = true;
> +       }
> +
> +       spin_unlock_irqrestore(&mtk_dp->irq_thread_lock, flags);
> +
> +       if (cable_sta_chg) {
> +               if (!!(mtk_dp_read(mtk_dp, MTK_DP_TRANS_P0_3414) &
> +                      HPD_DB_DP_TRANS_P0_MASK))
> +                       mtk_dp->train_info.cable_plugged_in = true;
> +               else
> +                       mtk_dp->train_info.cable_plugged_in = false;
> +       }
> +
> +       return IRQ_WAKE_THREAD;
> +}
> +
> +static int mtk_dp_dt_parse(struct mtk_dp *mtk_dp,
> +                          struct platform_device *pdev)
> +{
> +       struct device_node *endpoint;
> +       struct device *dev = &pdev->dev;
> +       int ret;
> +       void __iomem *base;
> +       u32 linkrate;
> +       int len;
> +
> +       base = devm_platform_ioremap_resource(pdev, 0);
> +       if (IS_ERR(base))
> +               return PTR_ERR(base);
> +
> +       mtk_dp->regs = devm_regmap_init_mmio(dev, base, &mtk_dp_regmap_config);
> +       if (IS_ERR(mtk_dp->regs))
> +               return PTR_ERR(mtk_dp->regs);
> +
> +       endpoint = of_graph_get_endpoint_by_regs(pdev->dev.of_node, 1, -1);
> +       len = of_property_count_elems_of_size(endpoint,
> +                                             "data-lanes", sizeof(u32));
> +       if (len < 0 || len > 4 || len == 3) {
> +               dev_err(dev, "invalid data lane size: %d\n", len);
> +               return -EINVAL;
> +       }
> +
> +       mtk_dp->max_lanes = len;
> +
> +       ret = device_property_read_u32(dev, "max-linkrate-mhz", &linkrate);
> +       if (ret) {
> +               dev_err(dev, "failed to read max linkrate: %d\n", ret);
> +               return ret;
> +       }
> +
> +       mtk_dp->max_linkrate = drm_dp_link_rate_to_bw_code(linkrate * 100);
> +
> +       return 0;
> +}
> +
> +static struct edid *mtk_dp_get_edid(struct drm_bridge *bridge,
> +                                   struct drm_connector *connector)
> +{
> +       struct mtk_dp *mtk_dp = mtk_dp_from_bridge(bridge);
> +       bool enabled = mtk_dp->enabled;
> +       struct edid *new_edid = NULL;
> +
> +       if (!enabled) {
> +               drm_bridge_chain_pre_enable(bridge);
> +
> +               /* power on aux */
> +               mtk_dp_update_bits(mtk_dp, MTK_DP_TOP_PWR_STATE,
> +                                  DP_PWR_STATE_BANDGAP_TPLL_LANE,
> +                                  DP_PWR_STATE_MASK);
> +
> +               /* power on panel */
> +               drm_dp_dpcd_writeb(&mtk_dp->aux, DP_SET_POWER, DP_SET_POWER_D0);
> +               usleep_range(2000, 5000);
> +       }
> +
> +       new_edid = drm_get_edid(connector, &mtk_dp->aux.ddc);
> +
> +       /*
> +        * Parse capability here to let atomic_get_input_bus_fmts and
> +        * mode_valid use the capability to calculate sink bitrates.
> +        */
> +       if (mtk_dp_parse_capabilities(mtk_dp)) {
> +               drm_err(mtk_dp->drm_dev, "Can't parse capabilities\n");
> +               new_edid = NULL;
> +       }
> +
> +       if (!enabled) {
> +               /* power off panel */
> +               drm_dp_dpcd_writeb(&mtk_dp->aux, DP_SET_POWER, DP_SET_POWER_D3);
> +               usleep_range(2000, 3000);
> +
> +               /* power off aux */
> +               mtk_dp_update_bits(mtk_dp, MTK_DP_TOP_PWR_STATE,
> +                                  DP_PWR_STATE_BANDGAP_TPLL,
> +                                  DP_PWR_STATE_MASK);
> +
> +               drm_bridge_chain_post_disable(bridge);
> +       }
> +
> +       return new_edid;
> +}
> +
> +static ssize_t mtk_dp_aux_transfer(struct drm_dp_aux *mtk_aux,
> +                                  struct drm_dp_aux_msg *msg)
> +{
> +       struct mtk_dp *mtk_dp;
> +       bool is_read;
> +       u8 request;
> +       size_t accessed_bytes = 0;
> +       int ret;
> +
> +       mtk_dp = container_of(mtk_aux, struct mtk_dp, aux);
> +
> +       if (!mtk_dp->train_info.cable_plugged_in) {
> +               ret = -EAGAIN;
> +               goto err;
> +       }
> +
> +       switch (msg->request) {
> +       case DP_AUX_I2C_MOT:
> +       case DP_AUX_I2C_WRITE:
> +       case DP_AUX_NATIVE_WRITE:
> +       case DP_AUX_I2C_WRITE_STATUS_UPDATE:
> +       case DP_AUX_I2C_WRITE_STATUS_UPDATE | DP_AUX_I2C_MOT:
> +               request = msg->request & ~DP_AUX_I2C_WRITE_STATUS_UPDATE;
> +               is_read = false;
> +               break;
> +       case DP_AUX_I2C_READ:
> +       case DP_AUX_NATIVE_READ:
> +       case DP_AUX_I2C_READ | DP_AUX_I2C_MOT:
> +               request = msg->request;
> +               is_read = true;
> +               break;
> +       default:
> +               drm_err(mtk_aux->drm_dev, "invalid aux cmd = %d\n",
> +                       msg->request);
> +               ret = -EINVAL;
> +               goto err;
> +       }
> +
> +       do {
> +               size_t to_access = min_t(size_t, DP_AUX_MAX_PAYLOAD_BYTES,
> +                                        msg->size - accessed_bytes);
> +
> +               ret = mtk_dp_aux_do_transfer(mtk_dp, is_read, request,
> +                                            msg->address + accessed_bytes,
> +                                            msg->buffer + accessed_bytes,
> +                                            to_access);
> +
> +               if (ret) {
> +                       drm_info(mtk_dp->drm_dev,
> +                                "Failed to do AUX transfer: %d\n", ret);
> +                       goto err;
> +               }
> +               accessed_bytes += to_access;
> +       } while (accessed_bytes < msg->size);
> +
> +       msg->reply = DP_AUX_NATIVE_REPLY_ACK | DP_AUX_I2C_REPLY_ACK;
> +       return msg->size;
> +err:
> +       msg->reply = DP_AUX_NATIVE_REPLY_NACK | DP_AUX_I2C_REPLY_NACK;
> +       return ret;
> +}
> +
> +static int mtk_dp_poweron(struct mtk_dp *mtk_dp)
> +{
> +       int ret;
> +
> +       ret = phy_init(mtk_dp->phy);
> +       if (ret) {
> +               dev_err(mtk_dp->dev, "Failed to initialize phy: %d\n", ret);
> +               return ret;
> +       }
> +
> +       mtk_dp_init_port(mtk_dp);
> +       mtk_dp_power_enable(mtk_dp);
> +
> +       return 0;
> +}
> +
> +static void mtk_dp_poweroff(struct mtk_dp *mtk_dp)
> +{
> +       mtk_dp_power_disable(mtk_dp);
> +       phy_exit(mtk_dp->phy);
> +}
> +
> +static int mtk_dp_bridge_attach(struct drm_bridge *bridge,
> +                               enum drm_bridge_attach_flags flags)
> +{
> +       struct mtk_dp *mtk_dp = mtk_dp_from_bridge(bridge);
> +       int ret;
> +
> +       if (!(flags & DRM_BRIDGE_ATTACH_NO_CONNECTOR)) {
> +               dev_err(mtk_dp->dev, "Driver does not provide a connector!");
> +               return -EINVAL;
> +       }
> +
> +       mtk_dp->aux.drm_dev = bridge->dev;
> +       ret = drm_dp_aux_register(&mtk_dp->aux);
> +       if (ret) {
> +               dev_err(mtk_dp->dev,
> +                       "failed to register DP AUX channel: %d\n", ret);
> +               return ret;
> +       }
> +
> +       ret = mtk_dp_poweron(mtk_dp);
> +       if (ret)
> +               goto err_aux_register;
> +
> +       if (mtk_dp->next_bridge) {
> +               ret = drm_bridge_attach(bridge->encoder, mtk_dp->next_bridge,
> +                                       &mtk_dp->bridge, flags);
> +               if (ret) {
> +                       drm_warn(mtk_dp->drm_dev,
> +                                "Failed to attach external bridge: %d\n", ret);
> +                       goto err_bridge_attach;
> +               }
> +       }
> +
> +       mtk_dp->drm_dev = bridge->dev;
> +
> +       mtk_dp_hwirq_enable(mtk_dp, true);
> +
> +       return 0;
> +
> +err_bridge_attach:
> +       mtk_dp_poweroff(mtk_dp);
> +err_aux_register:
> +       drm_dp_aux_unregister(&mtk_dp->aux);
> +       return ret;
> +}
> +
> +static void mtk_dp_bridge_detach(struct drm_bridge *bridge)
> +{
> +       struct mtk_dp *mtk_dp = mtk_dp_from_bridge(bridge);
> +
> +       mtk_dp_hwirq_enable(mtk_dp, false);
> +       mtk_dp->drm_dev = NULL;
> +       mtk_dp_poweroff(mtk_dp);
> +       drm_dp_aux_unregister(&mtk_dp->aux);
> +}
> +
> +static void mtk_dp_bridge_atomic_enable(struct drm_bridge *bridge,
> +                                       struct drm_bridge_state *old_state)
> +{
> +       struct mtk_dp *mtk_dp = mtk_dp_from_bridge(bridge);
> +       int ret;
> +
> +       mtk_dp->conn = drm_atomic_get_new_connector_for_encoder(old_state->base.state,
> +                                                               bridge->encoder);
> +       if (!mtk_dp->conn) {
> +               drm_err(mtk_dp->drm_dev,
> +                       "Can't enable bridge as connector is missing\n");
> +               return;
> +       }
> +
> +       /* power on aux */
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_TOP_PWR_STATE,
> +                          DP_PWR_STATE_BANDGAP_TPLL_LANE,
> +                          DP_PWR_STATE_MASK);
> +
> +       if (mtk_dp->train_info.cable_plugged_in) {
> +               drm_dp_dpcd_writeb(&mtk_dp->aux, DP_SET_POWER, DP_SET_POWER_D0);
> +               usleep_range(2000, 5000);
> +       }
> +
> +       /* Training */
> +       ret = mtk_dp_training(mtk_dp);
> +       if (ret) {
> +               drm_err(mtk_dp->drm_dev, "Training failed, %d\n", ret);
> +               goto power_off_aux;
> +       }
> +
> +       ret = mtk_dp_video_config(mtk_dp);
> +       if (ret)
> +               goto power_off_aux;
> +
> +       mtk_dp_video_enable(mtk_dp, true);
> +
> +       mtk_dp->enabled = true;
> +
> +       return;
> +power_off_aux:
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_TOP_PWR_STATE,
> +                          DP_PWR_STATE_BANDGAP_TPLL,
> +                          DP_PWR_STATE_MASK);
> +}
> +
> +static void mtk_dp_bridge_atomic_disable(struct drm_bridge *bridge,
> +                                        struct drm_bridge_state *old_state)
> +{
> +       struct mtk_dp *mtk_dp = mtk_dp_from_bridge(bridge);
> +
> +       mtk_dp->enabled = false;
> +       mtk_dp_video_enable(mtk_dp, false);
> +
> +       if (mtk_dp->train_info.cable_plugged_in) {
> +               drm_dp_dpcd_writeb(&mtk_dp->aux, DP_SET_POWER, DP_SET_POWER_D3);
> +               usleep_range(2000, 3000);
> +       }
> +
> +       /* power off aux */
> +       mtk_dp_update_bits(mtk_dp, MTK_DP_TOP_PWR_STATE,
> +                          DP_PWR_STATE_BANDGAP_TPLL,
> +                          DP_PWR_STATE_MASK);
> +
> +       /* Ensure the sink is muted */
> +       msleep(20);
> +}
> +
> +static enum drm_mode_status
> +mtk_dp_bridge_mode_valid(struct drm_bridge *bridge,
> +                        const struct drm_display_info *info,
> +                        const struct drm_display_mode *mode)
> +{
> +       struct mtk_dp *mtk_dp = mtk_dp_from_bridge(bridge);
> +       u32 bpp = info->color_formats & DRM_COLOR_FORMAT_YCBCR422 ? 16 : 24;
> +       u32 rate = min_t(u32, drm_dp_max_link_rate(mtk_dp->rx_cap) *
> +                             drm_dp_max_lane_count(mtk_dp->rx_cap),
> +                        drm_dp_bw_code_to_link_rate(mtk_dp->max_linkrate) *
> +                        mtk_dp->max_lanes);
> +
> +       if (rate < mode->clock * bpp / 8)
> +               return MODE_CLOCK_HIGH;
> +
> +       return MODE_OK;
> +}
> +
> +static u32 *mtk_dp_bridge_atomic_get_output_bus_fmts(struct drm_bridge *bridge,
> +                                                    struct drm_bridge_state *bridge_state,
> +                                                    struct drm_crtc_state *crtc_state,
> +                                                    struct drm_connector_state *conn_state,
> +                                                    unsigned int *num_output_fmts)
> +{
> +       u32 *output_fmts;
> +
> +       *num_output_fmts = 0;
> +       output_fmts = kmalloc(sizeof(*output_fmts), GFP_KERNEL);
> +       if (!output_fmts)
> +               return NULL;
> +       *num_output_fmts = 1;
> +       output_fmts[0] = MEDIA_BUS_FMT_FIXED;
> +       return output_fmts;
> +}
> +
> +static const u32 mt8195_input_fmts[] = {
> +       MEDIA_BUS_FMT_RGB888_1X24,
> +       MEDIA_BUS_FMT_YUV8_1X24,
> +       MEDIA_BUS_FMT_YUYV8_1X16,
> +};
> +
> +static u32 *mtk_dp_bridge_atomic_get_input_bus_fmts(struct drm_bridge *bridge,
> +                                                   struct drm_bridge_state *bridge_state,
> +                                                   struct drm_crtc_state *crtc_state,
> +                                                   struct drm_connector_state *conn_state,
> +                                                   u32 output_fmt,
> +                                                   unsigned int *num_input_fmts)
> +{
> +       u32 *input_fmts;
> +       struct mtk_dp *mtk_dp = mtk_dp_from_bridge(bridge);
> +       struct drm_display_mode *mode = &crtc_state->adjusted_mode;
> +       struct drm_display_info *display_info =
> +               &conn_state->connector->display_info;
> +       u32 rate = min_t(u32, drm_dp_max_link_rate(mtk_dp->rx_cap) *
> +                             drm_dp_max_lane_count(mtk_dp->rx_cap),
> +                        drm_dp_bw_code_to_link_rate(mtk_dp->max_linkrate) *
> +                        mtk_dp->max_lanes);
> +
> +       *num_input_fmts = 0;
> +
> +       /*
> +        * If the linkrate is smaller than datarate of RGB888, larger than
> +        * datarate of YUV422 and sink device supports YUV422, we output YUV422
> +        * format. Use this condition, we can support more resolution.
> +        */
> +       if ((rate < (mode->clock * 24 / 8)) &&
> +           (rate > (mode->clock * 16 / 8)) &&
> +           (display_info->color_formats & DRM_COLOR_FORMAT_YCBCR422)) {
> +               input_fmts = kcalloc(1, sizeof(*input_fmts), GFP_KERNEL);
> +               if (!input_fmts)
> +                       return NULL;
> +               *num_input_fmts = 1;
> +               input_fmts[0] = MEDIA_BUS_FMT_YUYV8_1X16;
> +       } else {
> +               input_fmts = kcalloc(ARRAY_SIZE(mt8195_input_fmts),
> +                                    sizeof(*input_fmts),
> +                                    GFP_KERNEL);
> +               if (!input_fmts)
> +                       return NULL;
> +
> +               *num_input_fmts = ARRAY_SIZE(mt8195_input_fmts);
> +               memcpy(input_fmts, mt8195_input_fmts, sizeof(mt8195_input_fmts));
> +       }
> +
> +       return input_fmts;
> +}
> +
> +static int mtk_dp_bridge_atomic_check(struct drm_bridge *bridge,
> +                                     struct drm_bridge_state *bridge_state,
> +                                     struct drm_crtc_state *crtc_state,
> +                                     struct drm_connector_state *conn_state)
> +{
> +       struct mtk_dp *mtk_dp = mtk_dp_from_bridge(bridge);
> +       struct drm_crtc *crtc = conn_state->crtc;
> +       unsigned int input_bus_format;
> +
> +       input_bus_format = bridge_state->input_bus_cfg.format;
> +
> +       dev_dbg(mtk_dp->dev, "input format 0x%04x, output format 0x%04x\n",
> +               bridge_state->input_bus_cfg.format,
> +                bridge_state->output_bus_cfg.format);
> +
> +       if (input_bus_format == MEDIA_BUS_FMT_YUYV8_1X16)
> +               mtk_dp->info.format = DP_PIXELFORMAT_YUV422;
> +       else
> +               mtk_dp->info.format = DP_PIXELFORMAT_RGB;
> +
> +       if (!crtc) {
> +               drm_err(mtk_dp->drm_dev,
> +                       "Can't enable bridge as connector state doesn't have a crtc\n");
> +               return -EINVAL;
> +       }
> +
> +       drm_display_mode_to_videomode(&crtc_state->adjusted_mode, &mtk_dp->info.vm);
> +
> +       return 0;
> +}
> +
> +static const struct drm_bridge_funcs mtk_dp_bridge_funcs = {
> +       .atomic_check = mtk_dp_bridge_atomic_check,
> +       .atomic_duplicate_state = drm_atomic_helper_bridge_duplicate_state,
> +       .atomic_destroy_state = drm_atomic_helper_bridge_destroy_state,
> +       .atomic_get_output_bus_fmts = mtk_dp_bridge_atomic_get_output_bus_fmts,
> +       .atomic_get_input_bus_fmts = mtk_dp_bridge_atomic_get_input_bus_fmts,
> +       .atomic_reset = drm_atomic_helper_bridge_reset,
> +       .attach = mtk_dp_bridge_attach,
> +       .detach = mtk_dp_bridge_detach,
> +       .atomic_enable = mtk_dp_bridge_atomic_enable,
> +       .atomic_disable = mtk_dp_bridge_atomic_disable,
> +       .mode_valid = mtk_dp_bridge_mode_valid,
> +       .get_edid = mtk_dp_get_edid,
> +};
> +
> +static int mtk_dp_probe(struct platform_device *pdev)
> +{
> +       struct mtk_dp *mtk_dp;
> +       struct device *dev = &pdev->dev;
> +       int ret, irq_num;
> +
> +       mtk_dp = devm_kzalloc(dev, sizeof(*mtk_dp), GFP_KERNEL);
> +       if (!mtk_dp)
> +               return -ENOMEM;
> +
> +       mtk_dp->dev = dev;
> +
> +       irq_num = platform_get_irq(pdev, 0);
> +       if (irq_num < 0)
> +               return dev_err_probe(dev, irq_num,
> +                                    "failed to request dp irq resource\n");
> +
> +       mtk_dp->next_bridge = devm_drm_of_get_bridge(dev, dev->of_node, 1, 0);
> +       if (IS_ERR(mtk_dp->next_bridge))
> +               return dev_err_probe(dev, PTR_ERR(mtk_dp->next_bridge),
> +                                    "Failed to get bridge\n");
> +
> +       ret = mtk_dp_dt_parse(mtk_dp, pdev);
> +       if (ret)
> +               return dev_err_probe(dev, ret, "Failed to parse dt\n");
> +
> +       drm_dp_aux_init(&mtk_dp->aux);
> +       mtk_dp->aux.name = "aux_mtk_dp";
> +       mtk_dp->aux.transfer = mtk_dp_aux_transfer;
> +
> +       spin_lock_init(&mtk_dp->irq_thread_lock);
> +
> +       ret = devm_request_threaded_irq(dev, irq_num, mtk_dp_hpd_event,
> +                                       mtk_dp_hpd_event_thread,
> +                                       IRQ_TYPE_LEVEL_HIGH, dev_name(dev),
> +                                       mtk_dp);
> +       if (ret)
> +               return dev_err_probe(dev, ret,
> +                                    "failed to request mediatek dptx irq\n");
> +
> +       platform_set_drvdata(pdev, mtk_dp);
> +
> +       mtk_dp->phy_dev = platform_device_register_data(dev, "mediatek-dp-phy",
> +                                                       PLATFORM_DEVID_AUTO,
> +                                                       &mtk_dp->regs,
> +                                                       sizeof(struct regmap *));
> +       if (IS_ERR(mtk_dp->phy_dev))
> +               return dev_err_probe(dev, PTR_ERR(mtk_dp->phy_dev),
> +                                    "Failed to create device mediatek-dp-phy\n");
> +
> +       mtk_dp_get_calibration_data(mtk_dp);
> +
> +       mtk_dp->phy = devm_phy_get(&mtk_dp->phy_dev->dev, "dp");
> +
> +       if (IS_ERR(mtk_dp->phy)) {
> +               platform_device_unregister(mtk_dp->phy_dev);
> +               return dev_err_probe(dev, PTR_ERR(mtk_dp->phy),
> +                                    "Failed to get phy\n");
> +       }
> +
> +       mtk_dp->bridge.funcs = &mtk_dp_bridge_funcs;
> +       mtk_dp->bridge.of_node = dev->of_node;
> +
> +       mtk_dp->bridge.ops =
> +               DRM_BRIDGE_OP_DETECT | DRM_BRIDGE_OP_EDID | DRM_BRIDGE_OP_HPD;
> +       mtk_dp->bridge.type = DRM_MODE_CONNECTOR_eDP;
> +
> +       drm_bridge_add(&mtk_dp->bridge);
> +
> +       pm_runtime_enable(dev);
> +       pm_runtime_get_sync(dev);
> +
> +       return 0;
> +}
> +
> +static int mtk_dp_remove(struct platform_device *pdev)
> +{
> +       struct mtk_dp *mtk_dp = platform_get_drvdata(pdev);
> +
> +       pm_runtime_put(&pdev->dev);
> +       pm_runtime_disable(&pdev->dev);
> +       drm_bridge_remove(&mtk_dp->bridge);
> +       platform_device_unregister(mtk_dp->phy_dev);
> +
> +       return 0;
> +}
> +
> +#ifdef CONFIG_PM_SLEEP
> +static int mtk_dp_suspend(struct device *dev)
> +{
> +       struct mtk_dp *mtk_dp = dev_get_drvdata(dev);
> +
> +       mtk_dp_power_disable(mtk_dp);
> +       mtk_dp_hwirq_enable(mtk_dp, false);
> +       pm_runtime_put_sync(dev);
> +
> +       return 0;
> +}
> +
> +static int mtk_dp_resume(struct device *dev)
> +{
> +       struct mtk_dp *mtk_dp = dev_get_drvdata(dev);
> +
> +       pm_runtime_get_sync(dev);
> +       mtk_dp_init_port(mtk_dp);
> +       mtk_dp_hwirq_enable(mtk_dp, true);
> +       mtk_dp_power_enable(mtk_dp);
> +
> +       return 0;
> +}
> +#endif
> +
> +static SIMPLE_DEV_PM_OPS(mtk_dp_pm_ops, mtk_dp_suspend, mtk_dp_resume);
> +
> +static const struct of_device_id mtk_dp_of_match[] = {
> +       { .compatible = "mediatek,mt8195-edp-tx" },
> +       {},
> +};
> +MODULE_DEVICE_TABLE(of, mtk_dp_of_match);
> +
> +struct platform_driver mtk_dp_driver = {
> +       .probe = mtk_dp_probe,
> +       .remove = mtk_dp_remove,
> +       .driver = {
> +               .name = "mediatek-drm-dp",
> +               .of_match_table = mtk_dp_of_match,
> +               .pm = &mtk_dp_pm_ops,
> +       },
> +};
> +
> +module_platform_driver(mtk_dp_driver);
> +
> +MODULE_AUTHOR("Jitao Shi <jitao.shi@xxxxxxxxxxxx>");
> +MODULE_AUTHOR("Markus Schneider-Pargmann <msp@xxxxxxxxxxxx>");
> +MODULE_AUTHOR("Bo-Chen Chen <rex-bc.chen@xxxxxxxxxxxx>");
> +MODULE_DESCRIPTION("MediaTek DisplayPort Driver");
> +MODULE_LICENSE("GPL");
> diff --git a/drivers/gpu/drm/mediatek/mtk_dp_reg.h b/drivers/gpu/drm/mediatek/mtk_dp_reg.h
> new file mode 100644
> index 000000000000..3f01ba44871f
> --- /dev/null
> +++ b/drivers/gpu/drm/mediatek/mtk_dp_reg.h
> @@ -0,0 +1,305 @@
> +/* SPDX-License-Identifier: GPL-2.0 */
> +/*
> + * Copyright (c) 2019-2022 MediaTek Inc.
> + * Copyright (c) 2022 BayLibre
> + */
> +#ifndef _MTK_DP_REG_H_
> +#define _MTK_DP_REG_H_
> +
> +#define SEC_OFFSET     0x4000
> +
> +#define MTK_DP_HPD_DISCONNECT          BIT(1)
> +#define MTK_DP_HPD_CONNECT             BIT(2)
> +#define MTK_DP_HPD_INTERRUPT           BIT(3)
> +
> +/* offset: 0x0 */
> +#define DP_PHY_GLB_BIAS_GEN_00         0x0
> +#define RG_XTP_GLB_BIAS_INTR_CTRL              GENMASK(20, 16)
> +#define DP_PHY_GLB_DPAUX_TX            0x8
> +#define RG_CKM_PT0_CKTX_IMPSEL                 GENMASK(23, 20)
> +#define MTK_DP_0034                    0x34
> +#define DA_XTP_GLB_CKDET_EN_FORCE_VAL          BIT(15)
> +#define DA_XTP_GLB_CKDET_EN_FORCE_EN           BIT(14)
> +#define DA_CKM_INTCKTX_EN_FORCE_VAL            BIT(13)
> +#define DA_CKM_INTCKTX_EN_FORCE_EN             BIT(12)
> +#define DA_CKM_CKTX0_EN_FORCE_VAL              BIT(11)
> +#define DA_CKM_CKTX0_EN_FORCE_EN               BIT(10)
> +#define DA_CKM_XTAL_CK_FORCE_VAL               BIT(9)
> +#define DA_CKM_XTAL_CK_FORCE_EN                        BIT(8)
> +#define DA_CKM_BIAS_LPF_EN_FORCE_VAL           BIT(7)
> +#define DA_CKM_BIAS_LPF_EN_FORCE_EN            BIT(6)
> +#define DA_CKM_BIAS_EN_FORCE_VAL               BIT(5)
> +#define DA_CKM_BIAS_EN_FORCE_EN                        BIT(4)
> +#define DA_XTP_GLB_AVD10_ON_FORCE_VAL          BIT(3)
> +#define DA_XTP_GLB_AVD10_ON_FORCE              BIT(2)
> +#define DA_XTP_GLB_LDO_EN_FORCE_VAL            BIT(1)
> +#define DA_XTP_GLB_LDO_EN_FORCE_EN             BIT(0)
> +#define DP_PHY_LANE_TX_0               0x104
> +#define RG_XTP_LN0_TX_IMPSEL_PMOS              GENMASK(15, 12)
> +#define RG_XTP_LN0_TX_IMPSEL_NMOS              GENMASK(19, 16)
> +#define DP_PHY_LANE_TX_1               0x204
> +#define RG_XTP_LN1_TX_IMPSEL_PMOS              GENMASK(15, 12)
> +#define RG_XTP_LN1_TX_IMPSEL_NMOS              GENMASK(19, 16)
> +#define DP_PHY_LANE_TX_2               0x304
> +#define RG_XTP_LN2_TX_IMPSEL_PMOS              GENMASK(15, 12)
> +#define RG_XTP_LN2_TX_IMPSEL_NMOS              GENMASK(19, 16)
> +#define DP_PHY_LANE_TX_3               0x404
> +#define RG_XTP_LN3_TX_IMPSEL_PMOS              GENMASK(15, 12)
> +#define RG_XTP_LN3_TX_IMPSEL_NMOS              GENMASK(19, 16)
> +#define MTK_DP_1040                    0x1040
> +#define RG_DPAUX_RX_VALID_DEGLITCH_EN          BIT(2)
> +#define RG_XTP_GLB_CKDET_EN                    BIT(1)
> +#define RG_DPAUX_RX_EN                         BIT(0)
> +
> +/* offset: TOP_OFFSET (0x2000) */
> +#define MTK_DP_TOP_PWR_STATE           0x2000
> +#define DP_PWR_STATE_MASK                      GENMASK(1, 0)
> +#define DP_PWR_STATE_BANDGAP                   BIT(0)
> +#define DP_PWR_STATE_BANDGAP_TPLL              BIT(1)
> +#define DP_PWR_STATE_BANDGAP_TPLL_LANE         GENMASK(1, 0)
> +#define MTK_DP_TOP_SWING_EMP           0x2004
> +#define DP_TX0_VOLT_SWING_MASK                 GENMASK(1, 0)
> +#define DP_TX0_VOLT_SWING_SHIFT                        0
> +#define DP_TX0_PRE_EMPH_MASK                   GENMASK(3, 2)
> +#define DP_TX0_PRE_EMPH_SHIFT                  2
> +#define DP_TX1_VOLT_SWING_MASK                 GENMASK(9, 8)
> +#define DP_TX1_VOLT_SWING_SHIFT                        8
> +#define DP_TX1_PRE_EMPH_MASK                   GENMASK(11, 10)
> +#define DP_TX2_VOLT_SWING_MASK                 GENMASK(17, 16)
> +#define DP_TX2_PRE_EMPH_MASK                   GENMASK(19, 18)
> +#define DP_TX3_VOLT_SWING_MASK                 GENMASK(25, 24)
> +#define DP_TX3_PRE_EMPH_MASK                   GENMASK(27, 26)
> +#define MTK_DP_TOP_RESET_AND_PROBE     0x2020
> +#define SW_RST_B_PHYD                          BIT(4)
> +#define MTK_DP_TOP_IRQ_MASK            0x202c
> +#define IRQ_MASK_AUX_TOP_IRQ                   BIT(2)
> +#define MTK_DP_TOP_MEM_PD              0x2038
> +#define MEM_ISO_EN                             BIT(0)
> +#define FUSE_SEL                               BIT(2)
> +
> +/* offset: ENC0_OFFSET (0x3000) */
> +#define MTK_DP_ENC0_P0_3000                    0x3000
> +#define LANE_NUM_DP_ENC0_P0_MASK                       GENMASK(1, 0)
> +#define VIDEO_MUTE_SW_DP_ENC0_P0                       BIT(2)
> +#define VIDEO_MUTE_SEL_DP_ENC0_P0                      BIT(3)
> +#define ENHANCED_FRAME_EN_DP_ENC0_P0                   BIT(4)
> +#define MTK_DP_ENC0_P0_3004                    0x3004
> +#define VIDEO_M_CODE_SEL_DP_ENC0_P0_MASK               BIT(8)
> +#define DP_TX_ENCODER_4P_RESET_SW_DP_ENC0_P0           BIT(9)
> +#define MTK_DP_ENC0_P0_3010                    0x3010
> +#define HTOTAL_SW_DP_ENC0_P0_MASK                      GENMASK(15, 0)
> +#define MTK_DP_ENC0_P0_3014                    0x3014
> +#define VTOTAL_SW_DP_ENC0_P0_MASK                      GENMASK(15, 0)
> +#define MTK_DP_ENC0_P0_3018                    0x3018
> +#define HSTART_SW_DP_ENC0_P0_MASK                      GENMASK(15, 0)
> +#define MTK_DP_ENC0_P0_301C                    0x301c
> +#define VSTART_SW_DP_ENC0_P0_MASK                      GENMASK(15, 0)
> +#define MTK_DP_ENC0_P0_3020                    0x3020
> +#define HWIDTH_SW_DP_ENC0_P0_MASK                      GENMASK(15, 0)
> +#define MTK_DP_ENC0_P0_3024                    0x3024
> +#define VHEIGHT_SW_DP_ENC0_P0_MASK                     GENMASK(15, 0)
> +#define MTK_DP_ENC0_P0_3028                    0x3028
> +#define HSW_SW_DP_ENC0_P0_MASK                         GENMASK(14, 0)
> +#define HSP_SW_DP_ENC0_P0_MASK                         BIT(15)
> +#define MTK_DP_ENC0_P0_302C                    0x302c
> +#define VSW_SW_DP_ENC0_P0_MASK                         GENMASK(14, 0)
> +#define VSP_SW_DP_ENC0_P0_MASK                         BIT(15)
> +#define MTK_DP_ENC0_P0_3030                    0x3030
> +#define HTOTAL_SEL_DP_ENC0_P0                          BIT(0)
> +#define VTOTAL_SEL_DP_ENC0_P0                          BIT(1)
> +#define HSTART_SEL_DP_ENC0_P0                          BIT(2)
> +#define VSTART_SEL_DP_ENC0_P0                          BIT(3)
> +#define HWIDTH_SEL_DP_ENC0_P0                          BIT(4)
> +#define VHEIGHT_SEL_DP_ENC0_P0                         BIT(5)
> +#define HSP_SEL_DP_ENC0_P0                             BIT(6)
> +#define HSW_SEL_DP_ENC0_P0                             BIT(7)
> +#define VSP_SEL_DP_ENC0_P0                             BIT(8)
> +#define VSW_SEL_DP_ENC0_P0                             BIT(9)
> +#define MTK_DP_ENC0_P0_3034                    0x3034
> +#define MTK_DP_ENC0_P0_3038                    0x3038
> +#define VIDEO_SOURCE_SEL_DP_ENC0_P0_MASK               BIT(11)
> +#define MTK_DP_ENC0_P0_303C                    0x303c
> +#define SRAM_START_READ_THRD_DP_ENC0_P0_MASK           GENMASK(5, 0)
> +#define VIDEO_COLOR_DEPTH_DP_ENC0_P0_MASK              GENMASK(10, 8)
> +#define VIDEO_COLOR_DEPTH_DP_ENC0_P0_16BIT             (0 << 8)
> +#define VIDEO_COLOR_DEPTH_DP_ENC0_P0_12BIT             (1 << 8)
> +#define VIDEO_COLOR_DEPTH_DP_ENC0_P0_10BIT             (2 << 8)
> +#define VIDEO_COLOR_DEPTH_DP_ENC0_P0_8BIT              (3 << 8)
> +#define VIDEO_COLOR_DEPTH_DP_ENC0_P0_6BIT              (4 << 8)
> +#define PIXEL_ENCODE_FORMAT_DP_ENC0_P0_MASK            GENMASK(14, 12)
> +#define PIXEL_ENCODE_FORMAT_DP_ENC0_P0_RGB             (0 << 12)
> +#define PIXEL_ENCODE_FORMAT_DP_ENC0_P0_YCBCR422                (1 << 12)
> +#define PIXEL_ENCODE_FORMAT_DP_ENC0_P0_YCBCR420                (2 << 12)
> +#define VIDEO_MN_GEN_EN_DP_ENC0_P0                     BIT(15)
> +#define MTK_DP_ENC0_P0_3040                    0x3040
> +#define SDP_DOWN_CNT_DP_ENC0_P0_VAL                    0x20
> +#define SDP_DOWN_CNT_INIT_DP_ENC0_P0_MASK              GENMASK(11, 0)
> +#define MTK_DP_ENC0_P0_304C                    0x304c
> +#define VBID_VIDEO_MUTE_DP_ENC0_P0_MASK                        BIT(2)
> +#define SDP_VSYNC_RISING_MASK_DP_ENC0_P0_MASK          BIT(8)
> +#define MTK_DP_ENC0_P0_3064                    0x3064
> +#define HDE_NUM_LAST_DP_ENC0_P0_MASK                   GENMASK(15, 0)
> +#define MTK_DP_ENC0_P0_3154                    0x3154
> +#define PGEN_HTOTAL_DP_ENC0_P0_MASK                    GENMASK(13, 0)
> +#define MTK_DP_ENC0_P0_3158                    0x3158
> +#define PGEN_HSYNC_RISING_DP_ENC0_P0_MASK              GENMASK(13, 0)
> +#define MTK_DP_ENC0_P0_315C                    0x315c
> +#define PGEN_HSYNC_PULSE_WIDTH_DP_ENC0_P0_MASK         GENMASK(13, 0)
> +#define MTK_DP_ENC0_P0_3160                    0x3160
> +#define PGEN_HFDE_START_DP_ENC0_P0_MASK                        GENMASK(13, 0)
> +#define MTK_DP_ENC0_P0_3164                    0x3164
> +#define PGEN_HFDE_ACTIVE_WIDTH_DP_ENC0_P0_MASK         GENMASK(13, 0)
> +#define MTK_DP_ENC0_P0_3168                    0x3168
> +#define PGEN_VTOTAL_DP_ENC0_P0_MASK                    GENMASK(12, 0)
> +#define MTK_DP_ENC0_P0_316C                    0x316c
> +#define PGEN_VSYNC_RISING_DP_ENC0_P0_MASK              GENMASK(12, 0)
> +#define MTK_DP_ENC0_P0_3170                    0x3170
> +#define PGEN_VSYNC_PULSE_WIDTH_DP_ENC0_P0_MASK         GENMASK(12, 0)
> +#define MTK_DP_ENC0_P0_3174                    0x3174
> +#define PGEN_VFDE_START_DP_ENC0_P0_MASK                        GENMASK(12, 0)
> +#define MTK_DP_ENC0_P0_3178                    0x3178
> +#define PGEN_VFDE_ACTIVE_WIDTH_DP_ENC0_P0_MASK         GENMASK(12, 0)
> +#define MTK_DP_ENC0_P0_31B0                    0x31b0
> +#define PGEN_PATTERN_SEL_VAL                           4
> +#define PGEN_PATTERN_SEL_MASK                          GENMASK(6, 4)
> +#define MTK_DP_ENC0_P0_31EC                    0x31ec
> +#define AUDIO_CH_SRC_SEL_DP_ENC0_P0                    BIT(4)
> +#define ISRC1_HB3_DP_ENC0_P0_MASK                      GENMASK(15, 8)
> +
> +/* offset: ENC1_OFFSET (0x3200) */
> +#define MTK_DP_ENC1_P0_3300                    0x3300
> +#define VIDEO_AFIFO_RDY_SEL_DP_ENC1_P0_VAL             2
> +#define VIDEO_AFIFO_RDY_SEL_DP_ENC1_P0_MASK            GENMASK(9, 8)
> +#define MTK_DP_ENC1_P0_3364                    0x3364
> +#define SDP_DOWN_CNT_IN_HBLANK_DP_ENC1_P0_VAL          0x20
> +#define SDP_DOWN_CNT_INIT_IN_HBLANK_DP_ENC1_P0_MASK    GENMASK(11, 0)
> +#define FIFO_READ_START_POINT_DP_ENC1_P0_VAL           4
> +#define FIFO_READ_START_POINT_DP_ENC1_P0_MASK          GENMASK(15, 12)
> +#define MTK_DP_ENC1_P0_3368                    0x3368
> +#define VIDEO_SRAM_FIFO_CNT_RESET_SEL_DP_ENC1_P0       BIT(0)
> +#define VIDEO_STABLE_CNT_THRD_DP_ENC1_P0               BIT(4)
> +#define SDP_DP13_EN_DP_ENC1_P0                         BIT(8)
> +#define BS2BS_MODE_DP_ENC1_P0                          BIT(12)
> +#define BS2BS_MODE_DP_ENC1_P0_MASK                     GENMASK(13, 12)
> +#define BS2BS_MODE_DP_ENC1_P0_VAL                      1
> +#define DP_ENC1_P0_3368_VAL                            (VIDEO_SRAM_FIFO_CNT_RESET_SEL_DP_ENC1_P0 | \
> +                                                        VIDEO_STABLE_CNT_THRD_DP_ENC1_P0 | \
> +                                                        SDP_DP13_EN_DP_ENC1_P0 | \
> +                                                        BS2BS_MODE_DP_ENC1_P0)
> +
> +/* offset: TRANS_OFFSET (0x3400) */
> +#define MTK_DP_TRANS_P0_3400                           0x3400
> +#define PATTERN1_EN_DP_TRANS_P0_MASK                           BIT(12)
> +#define PATTERN2_EN_DP_TRANS_P0_MASK                           BIT(13)
> +#define PATTERN3_EN_DP_TRANS_P0_MASK                           BIT(14)
> +#define PATTERN4_EN_DP_TRANS_P0_MASK                           BIT(15)
> +#define MTK_DP_TRANS_P0_3404                           0x3404
> +#define DP_SCR_EN_DP_TRANS_P0_MASK                             BIT(0)
> +#define MTK_DP_TRANS_P0_340C                           0x340c
> +#define DP_TX_TRANSMITTER_4P_RESET_SW_DP_TRANS_P0              BIT(13)
> +#define MTK_DP_TRANS_P0_3410                           0x3410
> +#define HPD_DEB_THD_DP_TRANS_P0_MASK                           GENMASK(3, 0)
> +#define HPD_INT_THD_DP_TRANS_P0_MASK                           GENMASK(7, 4)
> +#define HPD_INT_THD_DP_TRANS_P0_LOWER_500US                    (2 << 4)
> +#define HPD_INT_THD_DP_TRANS_P0_UPPER_1100US                   (2 << 6)
> +#define HPD_DISC_THD_DP_TRANS_P0_MASK                          GENMASK(11, 8)
> +#define HPD_CONN_THD_DP_TRANS_P0_MASK                          GENMASK(15, 12)
> +#define MTK_DP_TRANS_P0_3414                           0x3414
> +#define HPD_DB_DP_TRANS_P0_MASK                                        BIT(2)
> +#define MTK_DP_TRANS_P0_3418                           0x3418
> +#define IRQ_CLR_DP_TRANS_P0_MASK                               GENMASK(3, 0)
> +#define IRQ_MASK_DP_TRANS_P0_MASK                              GENMASK(7, 4)
> +#define IRQ_MASK_DP_TRANS_P0_DISC_IRQ                          (BIT(1) << 4)
> +#define IRQ_MASK_DP_TRANS_P0_CONN_IRQ                          (BIT(2) << 4)
> +#define IRQ_MASK_DP_TRANS_P0_INT_IRQ                           (BIT(3) << 4)
> +#define IRQ_STATUS_DP_TRANS_P0_MASK                            GENMASK(15, 12)
> +#define MTK_DP_TRANS_P0_342C                           0x342c
> +#define XTAL_FREQ_DP_TRANS_P0_DEFAULT                          (BIT(0) | BIT(3) | BIT(5) | BIT(6))
> +#define XTAL_FREQ_DP_TRANS_P0_MASK                             GENMASK(7, 0)
> +#define MTK_DP_TRANS_P0_3430                           0x3430
> +#define HPD_INT_THD_ECO_DP_TRANS_P0_MASK                       GENMASK(1, 0)
> +#define HPD_INT_THD_ECO_DP_TRANS_P0_HIGH_BOUND_EXT             BIT(1)
> +#define MTK_DP_TRANS_P0_34A4                           0x34a4
> +#define LANE_NUM_DP_TRANS_P0_MASK                              GENMASK(3, 2)
> +#define MTK_DP_TRANS_P0_3540                           0x3540
> +#define FEC_EN_DP_TRANS_P0_MASK                                        BIT(0)
> +#define FEC_CLOCK_EN_MODE_DP_TRANS_P0                          BIT(3)
> +#define MTK_DP_TRANS_P0_3580                           0x3580
> +#define POST_MISC_DATA_LANE0_OV_DP_TRANS_P0_MASK               BIT(8)
> +#define POST_MISC_DATA_LANE1_OV_DP_TRANS_P0_MASK               BIT(9)
> +#define POST_MISC_DATA_LANE2_OV_DP_TRANS_P0_MASK               BIT(10)
> +#define POST_MISC_DATA_LANE3_OV_DP_TRANS_P0_MASK               BIT(11)
> +#define MTK_DP_TRANS_P0_35C8                           0x35c8
> +#define SW_IRQ_CLR_DP_TRANS_P0_MASK                            GENMASK(15, 0)
> +#define SW_IRQ_STATUS_DP_TRANS_P0_MASK                         GENMASK(15, 0)
> +#define MTK_DP_TRANS_P0_35D0                           0x35d0
> +#define SW_IRQ_FINAL_STATUS_DP_TRANS_P0_MASK                   GENMASK(15, 0)
> +#define MTK_DP_TRANS_P0_35F0                           0x35f0
> +#define DP_TRANS_DUMMY_RW_0                                    BIT(3)
> +#define DP_TRANS_DUMMY_RW_0_MASK                               GENMASK(3, 2)
> +
> +/* offset: AUX_OFFSET (0x3600) */
> +#define MTK_DP_AUX_P0_360C                     0x360c
> +#define AUX_TIMEOUT_THR_AUX_TX_P0_MASK                 GENMASK(12, 0)
> +#define AUX_TIMEOUT_THR_AUX_TX_P0_VAL                  0x1595
> +#define MTK_DP_AUX_P0_3614                     0x3614
> +#define AUX_RX_UI_CNT_THR_AUX_TX_P0_MASK               GENMASK(6, 0)
> +#define AUX_RX_UI_CNT_THR_AUX_FOR_26M                  13
> +#define MTK_DP_AUX_P0_3618                     0x3618
> +#define AUX_RX_FIFO_FULL_AUX_TX_P0_MASK                        BIT(9)
> +#define AUX_RX_FIFO_WRITE_POINTER_AUX_TX_P0_MASK       GENMASK(3, 0)
> +#define MTK_DP_AUX_P0_3620                     0x3620
> +#define AUX_RD_MODE_AUX_TX_P0_MASK                     BIT(9)
> +#define AUX_RX_FIFO_READ_PULSE_TX_P0                   BIT(8)
> +#define AUX_RX_FIFO_READ_DATA_AUX_TX_P0_MASK           GENMASK(7, 0)
> +#define MTK_DP_AUX_P0_3624                     0x3624
> +#define AUX_RX_REPLY_COMMAND_AUX_TX_P0_MASK            GENMASK(3, 0)
> +#define MTK_DP_AUX_P0_3628                     0x3628
> +#define AUX_RX_PHY_STATE_AUX_TX_P0_MASK                        GENMASK(9, 0)
> +#define AUX_RX_PHY_STATE_AUX_TX_P0_RX_IDLE             BIT(0)
> +#define MTK_DP_AUX_P0_362C                     0x362c
> +#define AUX_NO_LENGTH_AUX_TX_P0                                BIT(0)
> +#define AUX_TX_AUXTX_OV_EN_AUX_TX_P0_MASK              BIT(1)
> +#define AUX_RESERVED_RW_0_AUX_TX_P0_MASK               GENMASK(15, 2)
> +#define MTK_DP_AUX_P0_3630                     0x3630
> +#define AUX_TX_REQUEST_READY_AUX_TX_P0                 BIT(3)
> +#define MTK_DP_AUX_P0_3634                     0x3634
> +#define AUX_TX_OVER_SAMPLE_RATE_AUX_TX_P0_MASK         GENMASK(15, 8)
> +#define AUX_TX_OVER_SAMPLE_RATE_FOR_26M                        25
> +#define MTK_DP_AUX_P0_3640                     0x3640
> +#define AUX_RX_AUX_RECV_COMPLETE_IRQ_AUX_TX_P0         BIT(6)
> +#define AUX_RX_EDID_RECV_COMPLETE_IRQ_AUX_TX_P0                BIT(5)
> +#define AUX_RX_MCCS_RECV_COMPLETE_IRQ_AUX_TX_P0                BIT(4)
> +#define AUX_RX_CMD_RECV_IRQ_AUX_TX_P0                  BIT(3)
> +#define AUX_RX_ADDR_RECV_IRQ_AUX_TX_P0                 BIT(2)
> +#define AUX_RX_DATA_RECV_IRQ_AUX_TX_P0                 BIT(1)
> +#define AUX_400US_TIMEOUT_IRQ_AUX_TX_P0                        BIT(0)
> +#define DP_AUX_P0_3640_VAL                             (AUX_400US_TIMEOUT_IRQ_AUX_TX_P0 | \
> +                                                        AUX_RX_DATA_RECV_IRQ_AUX_TX_P0 | \
> +                                                        AUX_RX_ADDR_RECV_IRQ_AUX_TX_P0 | \
> +                                                        AUX_RX_CMD_RECV_IRQ_AUX_TX_P0 | \
> +                                                        AUX_RX_MCCS_RECV_COMPLETE_IRQ_AUX_TX_P0 | \
> +                                                        AUX_RX_EDID_RECV_COMPLETE_IRQ_AUX_TX_P0 | \
> +                                                        AUX_RX_AUX_RECV_COMPLETE_IRQ_AUX_TX_P0)
> +#define MTK_DP_AUX_P0_3644                     0x3644
> +#define MCU_REQUEST_COMMAND_AUX_TX_P0_MASK             GENMASK(3, 0)
> +#define MTK_DP_AUX_P0_3648                     0x3648
> +#define MCU_REQUEST_ADDRESS_LSB_AUX_TX_P0_MASK         GENMASK(15, 0)
> +#define MTK_DP_AUX_P0_364C                     0x364c
> +#define MCU_REQUEST_ADDRESS_MSB_AUX_TX_P0_MASK         GENMASK(3, 0)
> +#define MTK_DP_AUX_P0_3650                     0x3650
> +#define MCU_REQ_DATA_NUM_AUX_TX_P0_MASK                        GENMASK(15, 12)
> +#define PHY_FIFO_RST_AUX_TX_P0_MASK                    BIT(9)
> +#define MCU_ACK_TRAN_COMPLETE_AUX_TX_P0                        BIT(8)
> +#define MTK_DP_AUX_P0_3658                     0x3658
> +#define AUX_TX_OV_EN_AUX_TX_P0_MASK                    BIT(0)
> +#define MTK_DP_AUX_P0_3690                     0x3690
> +#define RX_REPLY_COMPLETE_MODE_AUX_TX_P0               BIT(8)
> +#define MTK_DP_AUX_P0_3704                     0x3704
> +#define AUX_TX_FIFO_WDATA_NEW_MODE_T_AUX_TX_P0_MASK    BIT(1)
> +#define AUX_TX_FIFO_NEW_MODE_EN_AUX_TX_P0              BIT(2)
> +#define MTK_DP_AUX_P0_3708                     0x3708
> +#define MTK_DP_AUX_P0_37C8                     0x37c8
> +#define MTK_ATOP_EN_AUX_TX_P0                          BIT(0)
> +
> +#endif /*_MTK_DP_REG_H_*/
> --
> 2.18.0
>




[Index of Archives]     [Linux DRI Users]     [Linux Intel Graphics]     [Linux USB Devel]     [Video for Linux]     [Linux Audio Users]     [Yosemite News]     [Linux Kernel]     [Linux SCSI]     [XFree86]     [Linux USB Devel]     [Video for Linux]     [Linux Audio Users]     [Linux Kernel]     [Linux SCSI]     [XFree86]
  Powered by Linux