From mboxrd@z Thu Jan  1 00:00:00 1970
Return-Path: <linux-kernel-owner@kernel.org>
X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on
	aws-us-west-2-korg-lkml-1.web.codeaurora.org
Received: from vger.kernel.org (vger.kernel.org [23.128.96.18])
	by smtp.lore.kernel.org (Postfix) with ESMTP id 0119FC6FA85
	for <linux-kernel@archiver.kernel.org>; Fri,  2 Sep 2022 07:18:10 +0000 (UTC)
Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand
        id S234804AbiIBHSJ (ORCPT <rfc822;linux-kernel@archiver.kernel.org>);
        Fri, 2 Sep 2022 03:18:09 -0400
Received: from lindbergh.monkeyblade.net ([23.128.96.19]:39922 "EHLO
        lindbergh.monkeyblade.net" rhost-flags-OK-OK-OK-OK) by vger.kernel.org
        with ESMTP id S230295AbiIBHSG (ORCPT
        <rfc822;linux-kernel@vger.kernel.org>);
        Fri, 2 Sep 2022 03:18:06 -0400
Received: from mailgw02.mediatek.com (unknown [210.61.82.184])
        by lindbergh.monkeyblade.net (Postfix) with ESMTPS id 5CC1459261;
        Fri,  2 Sep 2022 00:18:01 -0700 (PDT)
X-UUID: 473db498448c449c97c006dc1223d7af-20220902
DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=mediatek.com; s=dk;
        h=Content-Transfer-Encoding:MIME-Version:Content-Type:References:In-Reply-To:Date:CC:To:From:Subject:Message-ID; bh=vuMnDXLjiZR93EtnRLPjN/Tyc6TLF2EKEZgCQGOrQeo=;
        b=azMryCHM7kxKFqTj/zIluVoDiltiiusNBTevUu++GucjdMSpKI1CfApOKf5LIOZA0V1wmVCeiAQkEYycIZZ6D8y683TckrB53Qo9Pluw8gEYWwp/2LCWCqAKkLNfv/Wdw2VQbAVnd/V2Uv9q4GdckOzDG/r4YgcRCwzolHzhQ1w=;
X-CID-P-RULE: Release_Ham
X-CID-O-INFO: VERSION:1.1.10,REQID:eadd892b-c6e0-4767-8274-3bdda2fa4883,OB:0,L
        OB:0,IP:0,URL:0,TC:0,Content:0,EDM:0,RT:0,SF:45,FILE:0,BULK:0,RULE:Release
        _Ham,ACTION:release,TS:45
X-CID-INFO: VERSION:1.1.10,REQID:eadd892b-c6e0-4767-8274-3bdda2fa4883,OB:0,LOB
        :0,IP:0,URL:0,TC:0,Content:0,EDM:0,RT:0,SF:45,FILE:0,BULK:0,RULE:Release_H
        am,ACTION:release,TS:45
X-CID-META: VersionHash:84eae18,CLOUDID:9d7aec20-1c20-48a5-82a0-25f9c331906d,C
        OID:fc17e03b72cd,Recheck:0,SF:28|17|19|48,TC:nil,Content:0,EDM:-3,IP:nil,U
        RL:0,File:nil,Bulk:nil,QS:nil,BEC:nil,COL:1
X-UUID: 473db498448c449c97c006dc1223d7af-20220902
Received: from mtkmbs10n1.mediatek.inc [(172.21.101.34)] by mailgw02.mediatek.com
        (envelope-from <ck.hu@mediatek.com>)
        (Generic MTA with TLSv1.2 ECDHE-RSA-AES256-GCM-SHA384 256/256)
        with ESMTP id 1177418876; Fri, 02 Sep 2022 15:17:52 +0800
Received: from mtkmbs11n2.mediatek.inc (172.21.101.187) by
 mtkmbs11n1.mediatek.inc (172.21.101.185) with Microsoft SMTP Server
 (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id
 15.2.792.15; Fri, 2 Sep 2022 15:17:50 +0800
Received: from mtksdccf07 (172.21.84.99) by mtkmbs11n2.mediatek.inc
 (172.21.101.73) with Microsoft SMTP Server id 15.2.792.15 via Frontend
 Transport; Fri, 2 Sep 2022 15:17:50 +0800
Message-ID: <db7096538187ac22abc62279bec2db1a3d8b2ffc.camel@mediatek.com>
Subject: Re: [PATCH v17 03/10] drm/mediatek: Add MT8195 Embedded DisplayPort
 driver
From:   CK Hu <ck.hu@mediatek.com>
To:     Bo-Chen Chen <rex-bc.chen@mediatek.com>, <chunkuang.hu@kernel.org>,
        <p.zabel@pengutronix.de>, <daniel@ffwll.ch>, <robh+dt@kernel.org>,
        <krzysztof.kozlowski+dt@linaro.org>, <mripard@kernel.org>,
        <tzimmermann@suse.de>, <matthias.bgg@gmail.com>, <deller@gmx.de>,
        <airlied@linux.ie>
CC:     <msp@baylibre.com>, <granquet@baylibre.com>,
        <jitao.shi@mediatek.com>, <wenst@chromium.org>,
        <angelogioacchino.delregno@collabora.com>,
        <liangxu.xu@mediatek.com>, <dri-devel@lists.freedesktop.org>,
        <linux-mediatek@lists.infradead.org>, <devicetree@vger.kernel.org>,
        <linux-kernel@vger.kernel.org>,
        <linux-arm-kernel@lists.infradead.org>,
        <linux-fbdev@vger.kernel.org>,
        <Project_Global_Chrome_Upstream_Group@mediatek.com>
Date:   Fri, 2 Sep 2022 15:17:50 +0800
In-Reply-To: <20220901044149.16782-4-rex-bc.chen@mediatek.com>
References: <20220901044149.16782-1-rex-bc.chen@mediatek.com>
         <20220901044149.16782-4-rex-bc.chen@mediatek.com>
Content-Type: text/plain; charset="UTF-8"
X-Mailer: Evolution 3.28.5-0ubuntu0.18.04.2 
MIME-Version: 1.0
Content-Transfer-Encoding: 7bit
X-MTK:  N
Precedence: bulk
List-ID: <linux-kernel.vger.kernel.org>
X-Mailing-List: linux-kernel@vger.kernel.org

Hi, Bo-Chen:

On Thu, 2022-09-01 at 12:41 +0800, Bo-Chen Chen wrote:
> From: Markus Schneider-Pargmann <msp@baylibre.com>
> 
> 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.

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

> 
> This driver is based on an initial version by
> Jitao shi <jitao.shi@mediatek.com>
> 
> Signed-off-by: Markus Schneider-Pargmann <msp@baylibre.com>
> Signed-off-by: Guillaume Ranquet <granquet@baylibre.com>
> Signed-off-by: Bo-Chen Chen <rex-bc.chen@mediatek.com>
> ---
>  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_MA
> SK);
> +	}
> +}
> +
> +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_ES
> I0,
> +					&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@mediatek.com>");
> +MODULE_AUTHOR("Markus Schneider-Pargmann <msp@baylibre.com>");
> +MODULE_AUTHOR("Bo-Chen Chen <rex-bc.chen@mediatek.com>");
> +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_FIF
> O_CNT_RESET_SEL_DP_ENC1_P0 | \
> +							 VIDEO_STABLE_C
> NT_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_TIME
> OUT_IRQ_AUX_TX_P0 | \
> +							 AUX_RX_DATA_RE
> CV_IRQ_AUX_TX_P0 | \
> +							 AUX_RX_ADDR_RE
> CV_IRQ_AUX_TX_P0 | \
> +							 AUX_RX_CMD_REC
> V_IRQ_AUX_TX_P0 | \
> +							 AUX_RX_MCCS_RE
> CV_COMPLETE_IRQ_AUX_TX_P0 | \
> +							 AUX_RX_EDID_RE
> CV_COMPLETE_IRQ_AUX_TX_P0 | \
> +							 AUX_RX_AUX_REC
> V_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_*/


From mboxrd@z Thu Jan  1 00:00:00 1970
Return-Path: <dri-devel-bounces@lists.freedesktop.org>
X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on
	aws-us-west-2-korg-lkml-1.web.codeaurora.org
Received: from gabe.freedesktop.org (gabe.freedesktop.org [131.252.210.177])
	(using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits))
	(No client certificate requested)
	by smtp.lore.kernel.org (Postfix) with ESMTPS id D39FAC6FA83
	for <dri-devel@archiver.kernel.org>; Fri,  2 Sep 2022 07:18:10 +0000 (UTC)
Received: from gabe.freedesktop.org (localhost [127.0.0.1])
	by gabe.freedesktop.org (Postfix) with ESMTP id CC4BA10E781;
	Fri,  2 Sep 2022 07:18:08 +0000 (UTC)
Received: from mailgw02.mediatek.com (unknown [210.61.82.184])
 by gabe.freedesktop.org (Postfix) with ESMTPS id E111A10E781
 for <dri-devel@lists.freedesktop.org>; Fri,  2 Sep 2022 07:18:03 +0000 (UTC)
X-UUID: 473db498448c449c97c006dc1223d7af-20220902
DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=mediatek.com;
 s=dk; 
 h=Content-Transfer-Encoding:MIME-Version:Content-Type:References:In-Reply-To:Date:CC:To:From:Subject:Message-ID;
 bh=vuMnDXLjiZR93EtnRLPjN/Tyc6TLF2EKEZgCQGOrQeo=; 
 b=azMryCHM7kxKFqTj/zIluVoDiltiiusNBTevUu++GucjdMSpKI1CfApOKf5LIOZA0V1wmVCeiAQkEYycIZZ6D8y683TckrB53Qo9Pluw8gEYWwp/2LCWCqAKkLNfv/Wdw2VQbAVnd/V2Uv9q4GdckOzDG/r4YgcRCwzolHzhQ1w=;
X-CID-P-RULE: Release_Ham
X-CID-O-INFO: VERSION:1.1.10, REQID:eadd892b-c6e0-4767-8274-3bdda2fa4883, OB:0,
 L
 OB:0,IP:0,URL:0,TC:0,Content:0,EDM:0,RT:0,SF:45,FILE:0,BULK:0,RULE:Release
 _Ham,ACTION:release,TS:45
X-CID-INFO: VERSION:1.1.10, REQID:eadd892b-c6e0-4767-8274-3bdda2fa4883, OB:0,
 LOB
 :0,IP:0,URL:0,TC:0,Content:0,EDM:0,RT:0,SF:45,FILE:0,BULK:0,RULE:Release_H
 am,ACTION:release,TS:45
X-CID-META: VersionHash:84eae18, CLOUDID:9d7aec20-1c20-48a5-82a0-25f9c331906d,
 C
 OID:fc17e03b72cd,Recheck:0,SF:28|17|19|48,TC:nil,Content:0,EDM:-3,IP:nil,U
 RL:0,File:nil,Bulk:nil,QS:nil,BEC:nil,COL:1
X-UUID: 473db498448c449c97c006dc1223d7af-20220902
Received: from mtkmbs10n1.mediatek.inc [(172.21.101.34)] by
 mailgw02.mediatek.com (envelope-from <ck.hu@mediatek.com>)
 (Generic MTA with TLSv1.2 ECDHE-RSA-AES256-GCM-SHA384 256/256)
 with ESMTP id 1177418876; Fri, 02 Sep 2022 15:17:52 +0800
Received: from mtkmbs11n2.mediatek.inc (172.21.101.187) by
 mtkmbs11n1.mediatek.inc (172.21.101.185) with Microsoft SMTP Server
 (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id
 15.2.792.15; Fri, 2 Sep 2022 15:17:50 +0800
Received: from mtksdccf07 (172.21.84.99) by mtkmbs11n2.mediatek.inc
 (172.21.101.73) with Microsoft SMTP Server id 15.2.792.15 via Frontend
 Transport; Fri, 2 Sep 2022 15:17:50 +0800
Message-ID: <db7096538187ac22abc62279bec2db1a3d8b2ffc.camel@mediatek.com>
Subject: Re: [PATCH v17 03/10] drm/mediatek: Add MT8195 Embedded DisplayPort
 driver
From: CK Hu <ck.hu@mediatek.com>
To: Bo-Chen Chen <rex-bc.chen@mediatek.com>, <chunkuang.hu@kernel.org>,
 <p.zabel@pengutronix.de>, <daniel@ffwll.ch>, <robh+dt@kernel.org>,
 <krzysztof.kozlowski+dt@linaro.org>, <mripard@kernel.org>,
 <tzimmermann@suse.de>, <matthias.bgg@gmail.com>, <deller@gmx.de>,
 <airlied@linux.ie>
Date: Fri, 2 Sep 2022 15:17:50 +0800
In-Reply-To: <20220901044149.16782-4-rex-bc.chen@mediatek.com>
References: <20220901044149.16782-1-rex-bc.chen@mediatek.com>
 <20220901044149.16782-4-rex-bc.chen@mediatek.com>
Content-Type: text/plain; charset="UTF-8"
X-Mailer: Evolution 3.28.5-0ubuntu0.18.04.2 
MIME-Version: 1.0
Content-Transfer-Encoding: 7bit
X-MTK: N
X-BeenThere: dri-devel@lists.freedesktop.org
X-Mailman-Version: 2.1.29
Precedence: list
List-Id: Direct Rendering Infrastructure - Development
 <dri-devel.lists.freedesktop.org>
List-Unsubscribe: <https://lists.freedesktop.org/mailman/options/dri-devel>,
 <mailto:dri-devel-request@lists.freedesktop.org?subject=unsubscribe>
List-Archive: <https://lists.freedesktop.org/archives/dri-devel>
List-Post: <mailto:dri-devel@lists.freedesktop.org>
List-Help: <mailto:dri-devel-request@lists.freedesktop.org?subject=help>
List-Subscribe: <https://lists.freedesktop.org/mailman/listinfo/dri-devel>,
 <mailto:dri-devel-request@lists.freedesktop.org?subject=subscribe>
Cc: devicetree@vger.kernel.org, linux-fbdev@vger.kernel.org,
 granquet@baylibre.com, jitao.shi@mediatek.com, liangxu.xu@mediatek.com,
 linux-kernel@vger.kernel.org, dri-devel@lists.freedesktop.org,
 msp@baylibre.com, Project_Global_Chrome_Upstream_Group@mediatek.com,
 linux-mediatek@lists.infradead.org, wenst@chromium.org,
 linux-arm-kernel@lists.infradead.org, angelogioacchino.delregno@collabora.com
Errors-To: dri-devel-bounces@lists.freedesktop.org
Sender: "dri-devel" <dri-devel-bounces@lists.freedesktop.org>

Hi, Bo-Chen:

On Thu, 2022-09-01 at 12:41 +0800, Bo-Chen Chen wrote:
> From: Markus Schneider-Pargmann <msp@baylibre.com>
> 
> 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.

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

> 
> This driver is based on an initial version by
> Jitao shi <jitao.shi@mediatek.com>
> 
> Signed-off-by: Markus Schneider-Pargmann <msp@baylibre.com>
> Signed-off-by: Guillaume Ranquet <granquet@baylibre.com>
> Signed-off-by: Bo-Chen Chen <rex-bc.chen@mediatek.com>
> ---
>  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_MA
> SK);
> +	}
> +}
> +
> +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_ES
> I0,
> +					&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@mediatek.com>");
> +MODULE_AUTHOR("Markus Schneider-Pargmann <msp@baylibre.com>");
> +MODULE_AUTHOR("Bo-Chen Chen <rex-bc.chen@mediatek.com>");
> +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_FIF
> O_CNT_RESET_SEL_DP_ENC1_P0 | \
> +							 VIDEO_STABLE_C
> NT_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_TIME
> OUT_IRQ_AUX_TX_P0 | \
> +							 AUX_RX_DATA_RE
> CV_IRQ_AUX_TX_P0 | \
> +							 AUX_RX_ADDR_RE
> CV_IRQ_AUX_TX_P0 | \
> +							 AUX_RX_CMD_REC
> V_IRQ_AUX_TX_P0 | \
> +							 AUX_RX_MCCS_RE
> CV_COMPLETE_IRQ_AUX_TX_P0 | \
> +							 AUX_RX_EDID_RE
> CV_COMPLETE_IRQ_AUX_TX_P0 | \
> +							 AUX_RX_AUX_REC
> V_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_*/


From mboxrd@z Thu Jan  1 00:00:00 1970
Return-Path: <linux-arm-kernel-bounces+linux-arm-kernel=archiver.kernel.org@lists.infradead.org>
X-Spam-Checker-Version: SpamAssassin 3.4.0 (2014-02-07) on
	aws-us-west-2-korg-lkml-1.web.codeaurora.org
Received: from bombadil.infradead.org (bombadil.infradead.org [198.137.202.133])
	(using TLSv1.2 with cipher ECDHE-RSA-AES256-GCM-SHA384 (256/256 bits))
	(No client certificate requested)
	by smtp.lore.kernel.org (Postfix) with ESMTPS id 049E4ECAAA1
	for <linux-arm-kernel@archiver.kernel.org>; Fri,  2 Sep 2022 08:16:30 +0000 (UTC)
DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed;
	d=lists.infradead.org; s=bombadil.20210309; h=Sender:
	Content-Transfer-Encoding:Content-Type:List-Subscribe:List-Help:List-Post:
	List-Archive:List-Unsubscribe:List-Id:MIME-Version:References:In-Reply-To:
	Date:CC:To:From:Subject:Message-ID:Reply-To:Content-ID:Content-Description:
	Resent-Date:Resent-From:Resent-Sender:Resent-To:Resent-Cc:Resent-Message-ID:
	List-Owner; bh=5SK0//5alasQIm4Du6DUgrDyf49FFKyp//vRu+3BfeA=; b=oNhPzSJBRa87Ep
	mO++HPxrHiU+84dNCSjcizOF+mvdj4jYRBU//I/Xbuy+UdtDbv93Vbd1TaLsizCoOaBuy9bxtfGgw
	oJ2gx4gQAdBhCdmZSKjmQJ1MUA9ROa81j4nMPj11Th/fhMNpAICo5GMrakgimQEHmA3HHPYHgnDg/
	OZw70oY+pmqUyjvy+2mXXpArI8x7TWg6BI+iYvZ4hP7XrFSMxxA/BHqRvaZphOfj65C0ZqUVhSnH+
	bsrG4BaDbcAY4DbA6mSPV8uFiJjV0xoUN02G8nUKhdtiF76Vhr7DNaDz9aLRP0cYY3YAi/Rq0BG/k
	KjOxYOsQM1nakBDE4dlQ==;
Received: from localhost ([::1] helo=bombadil.infradead.org)
	by bombadil.infradead.org with esmtp (Exim 4.94.2 #2 (Red Hat Linux))
	id 1oU1pF-001i26-U0; Fri, 02 Sep 2022 08:14:54 +0000
Received: from mailgw02.mediatek.com ([216.200.240.185])
	by bombadil.infradead.org with esmtps (Exim 4.94.2 #2 (Red Hat Linux))
	id 1oU1nj-001gbw-9T; Fri, 02 Sep 2022 08:13:26 +0000
X-UUID: 72b9ba60101240b99ea30dcd2f353017-20220902
DKIM-Signature: v=1; a=rsa-sha256; q=dns/txt; c=relaxed/relaxed; d=mediatek.com; s=dk;
	h=Content-Transfer-Encoding:MIME-Version:Content-Type:References:In-Reply-To:Date:CC:To:From:Subject:Message-ID; bh=vuMnDXLjiZR93EtnRLPjN/Tyc6TLF2EKEZgCQGOrQeo=;
	b=azMryCHM7kxKFqTj/zIluVoDiltiiusNBTevUu++GucjdMSpKI1CfApOKf5LIOZA0V1wmVCeiAQkEYycIZZ6D8y683TckrB53Qo9Pluw8gEYWwp/2LCWCqAKkLNfv/Wdw2VQbAVnd/V2Uv9q4GdckOzDG/r4YgcRCwzolHzhQ1w=;
X-CID-P-RULE: Release_Ham
X-CID-O-INFO: VERSION:1.1.10,REQID:5e3b28d3-6311-4876-a4eb-dd57f6ce161f,OB:0,L
	OB:0,IP:0,URL:0,TC:0,Content:0,EDM:0,RT:0,SF:0,FILE:0,BULK:0,RULE:Release_
	Ham,ACTION:release,TS:0
X-CID-META: VersionHash:84eae18,CLOUDID:033b6556-e800-47dc-8adf-0c936acf4f1b,C
	OID:IGNORED,Recheck:0,SF:nil,TC:nil,Content:0,EDM:-3,IP:nil,URL:0,File:nil
	,Bulk:nil,QS:nil,BEC:nil,COL:1
X-UUID: 72b9ba60101240b99ea30dcd2f353017-20220902
Received: from mtkmbs11n1.mediatek.inc [(172.21.101.185)] by mailgw02.mediatek.com
	(envelope-from <ck.hu@mediatek.com>)
	(musrelay.mediatek.com ESMTP with TLSv1.2 ECDHE-RSA-AES256-GCM-SHA384 256/256)
	with ESMTP id 460504685; Fri, 02 Sep 2022 01:08:25 -0700
Received: from mtkmbs11n2.mediatek.inc (172.21.101.187) by
 mtkmbs11n1.mediatek.inc (172.21.101.185) with Microsoft SMTP Server
 (version=TLS1_2, cipher=TLS_ECDHE_RSA_WITH_AES_256_GCM_SHA384) id
 15.2.792.15; Fri, 2 Sep 2022 15:17:50 +0800
Received: from mtksdccf07 (172.21.84.99) by mtkmbs11n2.mediatek.inc
 (172.21.101.73) with Microsoft SMTP Server id 15.2.792.15 via Frontend
 Transport; Fri, 2 Sep 2022 15:17:50 +0800
Message-ID: <db7096538187ac22abc62279bec2db1a3d8b2ffc.camel@mediatek.com>
Subject: Re: [PATCH v17 03/10] drm/mediatek: Add MT8195 Embedded DisplayPort
 driver
From: CK Hu <ck.hu@mediatek.com>
To: Bo-Chen Chen <rex-bc.chen@mediatek.com>, <chunkuang.hu@kernel.org>,
	<p.zabel@pengutronix.de>, <daniel@ffwll.ch>, <robh+dt@kernel.org>,
	<krzysztof.kozlowski+dt@linaro.org>, <mripard@kernel.org>,
	<tzimmermann@suse.de>, <matthias.bgg@gmail.com>, <deller@gmx.de>,
	<airlied@linux.ie>
CC: <msp@baylibre.com>, <granquet@baylibre.com>, <jitao.shi@mediatek.com>,
	<wenst@chromium.org>, <angelogioacchino.delregno@collabora.com>,
	<liangxu.xu@mediatek.com>, <dri-devel@lists.freedesktop.org>,
	<linux-mediatek@lists.infradead.org>, <devicetree@vger.kernel.org>,
	<linux-kernel@vger.kernel.org>, <linux-arm-kernel@lists.infradead.org>,
	<linux-fbdev@vger.kernel.org>,
	<Project_Global_Chrome_Upstream_Group@mediatek.com>
Date: Fri, 2 Sep 2022 15:17:50 +0800
In-Reply-To: <20220901044149.16782-4-rex-bc.chen@mediatek.com>
References: <20220901044149.16782-1-rex-bc.chen@mediatek.com>
	 <20220901044149.16782-4-rex-bc.chen@mediatek.com>
X-Mailer: Evolution 3.28.5-0ubuntu0.18.04.2 
MIME-Version: 1.0
X-MTK: N
X-CRM114-Version: 20100106-BlameMichelson ( TRE 0.8.0 (BSD) ) MR-646709E3 
X-CRM114-CacheID: sfid-20220902_011319_473870_7AE762ED 
X-CRM114-Status: GOOD (  37.08  )
X-BeenThere: linux-arm-kernel@lists.infradead.org
X-Mailman-Version: 2.1.34
Precedence: list
List-Id: <linux-arm-kernel.lists.infradead.org>
List-Unsubscribe: <http://lists.infradead.org/mailman/options/linux-arm-kernel>,
 <mailto:linux-arm-kernel-request@lists.infradead.org?subject=unsubscribe>
List-Archive: <http://lists.infradead.org/pipermail/linux-arm-kernel/>
List-Post: <mailto:linux-arm-kernel@lists.infradead.org>
List-Help: <mailto:linux-arm-kernel-request@lists.infradead.org?subject=help>
List-Subscribe: <http://lists.infradead.org/mailman/listinfo/linux-arm-kernel>,
 <mailto:linux-arm-kernel-request@lists.infradead.org?subject=subscribe>
Content-Type: text/plain; charset="us-ascii"
Content-Transfer-Encoding: 7bit
Sender: "linux-arm-kernel" <linux-arm-kernel-bounces@lists.infradead.org>
Errors-To: linux-arm-kernel-bounces+linux-arm-kernel=archiver.kernel.org@lists.infradead.org

Hi, Bo-Chen:

On Thu, 2022-09-01 at 12:41 +0800, Bo-Chen Chen wrote:
> From: Markus Schneider-Pargmann <msp@baylibre.com>
> 
> 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.

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

> 
> This driver is based on an initial version by
> Jitao shi <jitao.shi@mediatek.com>
> 
> Signed-off-by: Markus Schneider-Pargmann <msp@baylibre.com>
> Signed-off-by: Guillaume Ranquet <granquet@baylibre.com>
> Signed-off-by: Bo-Chen Chen <rex-bc.chen@mediatek.com>
> ---
>  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_MA
> SK);
> +	}
> +}
> +
> +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_ES
> I0,
> +					&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@mediatek.com>");
> +MODULE_AUTHOR("Markus Schneider-Pargmann <msp@baylibre.com>");
> +MODULE_AUTHOR("Bo-Chen Chen <rex-bc.chen@mediatek.com>");
> +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_FIF
> O_CNT_RESET_SEL_DP_ENC1_P0 | \
> +							 VIDEO_STABLE_C
> NT_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_TIME
> OUT_IRQ_AUX_TX_P0 | \
> +							 AUX_RX_DATA_RE
> CV_IRQ_AUX_TX_P0 | \
> +							 AUX_RX_ADDR_RE
> CV_IRQ_AUX_TX_P0 | \
> +							 AUX_RX_CMD_REC
> V_IRQ_AUX_TX_P0 | \
> +							 AUX_RX_MCCS_RE
> CV_COMPLETE_IRQ_AUX_TX_P0 | \
> +							 AUX_RX_EDID_RE
> CV_COMPLETE_IRQ_AUX_TX_P0 | \
> +							 AUX_RX_AUX_REC
> V_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_*/


_______________________________________________
linux-arm-kernel mailing list
linux-arm-kernel@lists.infradead.org
http://lists.infradead.org/mailman/listinfo/linux-arm-kernel