From 7095b3b3b28031708ab74a65c32e84e231bc9d27 Mon Sep 17 00:00:00 2001
From: Sandor Yu <Sandor.yu@nxp.com>
Date: Wed, 11 Sep 2019 17:18:29 +0800
Subject: [PATCH] drm: imx: add imx8mq hdmi support

add struct imx_mhdp_device for imx specific.
add imx8mq hdmi support.
move imx8qm specific functions to plat_data
uniform variable name.

Signed-off-by: Sandor Yu <Sandor.yu@nxp.com>
---
 drivers/gpu/drm/imx/Makefile            |   2 +-
 drivers/gpu/drm/imx/cdn-mhdp-dp-phy.c   |   8 +-
 drivers/gpu/drm/imx/cdn-mhdp-hdmi-phy.c |   7 +-
 drivers/gpu/drm/imx/cdn-mhdp-imx8mq.c   | 163 ------------
 drivers/gpu/drm/imx/cdn-mhdp-imx8qm.c   | 437 ++++++++++----------------------
 drivers/gpu/drm/imx/cdn-mhdp-imxdrv.c   | 202 +++++++++++++++
 drivers/gpu/drm/imx/cdn-mhdp-phy.h      |  12 +-
 drivers/gpu/drm/imx/cdns-mhdp-imx.h     |  80 ++++++
 8 files changed, 421 insertions(+), 490 deletions(-)
 delete mode 100644 drivers/gpu/drm/imx/cdn-mhdp-imx8mq.c
 create mode 100644 drivers/gpu/drm/imx/cdn-mhdp-imxdrv.c
 create mode 100644 drivers/gpu/drm/imx/cdns-mhdp-imx.h

--- a/drivers/gpu/drm/imx/Makefile
+++ b/drivers/gpu/drm/imx/Makefile
@@ -9,4 +9,4 @@ obj-$(CONFIG_DRM_IMX_TVE) += imx-tve.o
 obj-$(CONFIG_DRM_IMX_LDB) += imx-ldb.o
 
 obj-$(CONFIG_DRM_IMX_HDMI) += dw_hdmi-imx.o
-obj-$(CONFIG_DRM_IMX_CDNS_MHDP) += cdn-mhdp-imx8qm.o cdn-mhdp-imx8mq.o cdn-mhdp-dp-phy.o cdn-mhdp-hdmi-phy.o
+obj-$(CONFIG_DRM_IMX_CDNS_MHDP) += cdn-mhdp-imxdrv.o cdn-mhdp-dp-phy.o cdn-mhdp-hdmi-phy.o cdn-mhdp-imx8qm.o
--- a/drivers/gpu/drm/imx/cdn-mhdp-dp-phy.c
+++ b/drivers/gpu/drm/imx/cdn-mhdp-dp-phy.c
@@ -12,7 +12,6 @@
 #include <linux/clk.h>
 #include <linux/kernel.h>
 #include <drm/drm_dp_helper.h>
-
 #include <drm/bridge/cdns-mhdp-common.h>
 #include "cdn-mhdp-phy.h"
 
@@ -477,9 +476,8 @@ static int dp_phy_power_up(struct cdns_m
 	return 0;
 }
 
-int cdns_dp_phy_init_imx8mq(struct imx_mhdp_device *hdp)
+int cdns_dp_phy_set_imx8mq(struct cdns_mhdp_device *mhdp)
 {
-	struct cdns_mhdp_device *mhdp = &hdp->mhdp;
 	int ret;
 
 	/* Disable phy clock if PHY in power up state */
@@ -504,10 +502,8 @@ int cdns_dp_phy_init_imx8mq(struct imx_m
 	return ret;
 }
 
-
-int cdns_dp_phy_init_imx8qm(struct imx_mhdp_device *hdp)
+int cdns_dp_phy_set_imx8qm(struct cdns_mhdp_device *mhdp)
 {
-	struct cdns_mhdp_device *mhdp = &hdp->mhdp;
 	int ret;
 
 	/* Disable phy clock if PHY in power up state */
--- a/drivers/gpu/drm/imx/cdn-mhdp-hdmi-phy.c
+++ b/drivers/gpu/drm/imx/cdn-mhdp-hdmi-phy.c
@@ -624,9 +624,8 @@ static int hdmi_phy_power_up(struct cdns
 	return 0;
 }
 
-int cdns_hdmi_phy_set_imx8mq(struct imx_mhdp_device *hdp)
+int cdns_hdmi_phy_set_imx8mq(struct cdns_mhdp_device *mhdp)
 {
-	struct cdns_mhdp_device *mhdp = &hdp->mhdp;
 	struct drm_display_mode *mode = &mhdp->mode;
 	int ret;
 
@@ -653,9 +652,8 @@ int cdns_hdmi_phy_set_imx8mq(struct imx_
 	return true;
 }
 
-int cdns_hdmi_phy_set_imx8qm(struct imx_mhdp_device *hdp)
+int cdns_hdmi_phy_set_imx8qm(struct cdns_mhdp_device *mhdp)
 {
-	struct cdns_mhdp_device *mhdp = &hdp->mhdp;
 	struct drm_display_mode *mode = &mhdp->mode;
 	int ret;
 
@@ -681,4 +679,3 @@ int cdns_hdmi_phy_set_imx8qm(struct imx_
 
 	return true;
 }
-
--- a/drivers/gpu/drm/imx/cdn-mhdp-imx8mq.c
+++ /dev/null
@@ -1,163 +0,0 @@
-/*
- * Copyright (C) 2019 NXP Semiconductor, Inc.
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License version 2 as
- * published by the Free Software Foundation.
- */
-#include <linux/module.h>
-#include <linux/platform_device.h>
-#include <linux/component.h>
-#include <linux/mfd/syscon.h>
-#include <linux/mfd/syscon/imx6q-iomuxc-gpr.h>
-#include <drm/drm_of.h>
-#include <drm/drmP.h>
-#include <drm/drm_crtc_helper.h>
-#include <drm/drm_edid.h>
-#include <drm/drm_encoder_slave.h>
-
-#include <drm/bridge/cdns-mhdp-imx.h>
-#include "cdn-mhdp-phy.h"
-#include "imx-drm.h"
-
-struct imx_hdmi {
-	struct device *dev;
-	struct drm_encoder encoder;
-};
-
-static void cdns_hdmi_imx_encoder_disable(struct drm_encoder *encoder)
-{
-}
-
-static void cdns_hdmi_imx_encoder_enable(struct drm_encoder *encoder)
-{
-}
-
-static int cdns_hdmi_imx_atomic_check(struct drm_encoder *encoder,
-				    struct drm_crtc_state *crtc_state,
-				    struct drm_connector_state *conn_state)
-{
-	return 0;
-}
-
-static const struct drm_encoder_helper_funcs cdns_hdmi_imx_encoder_helper_funcs = {
-	.enable     = cdns_hdmi_imx_encoder_enable,
-	.disable    = cdns_hdmi_imx_encoder_disable,
-	.atomic_check = cdns_hdmi_imx_atomic_check,
-};
-
-static const struct drm_encoder_funcs cdns_hdmi_imx_encoder_funcs = {
-	.destroy = drm_encoder_cleanup,
-};
-
-static struct cdn_plat_data imx8mq_hdmi_drv_data = {
-	.bind	= cdns_hdmi_bind,
-	.unbind	= cdns_hdmi_unbind,
-	.phy_init = cdns_hdmi_phy_set_imx8mq,
-};
-
-static struct cdn_plat_data imx8mq_dp_drv_data = {
-	.bind	= cdns_dp_bind,
-	.unbind	= cdns_dp_unbind,
-	.phy_init = cdns_dp_phy_init_imx8mq,
-};
-
-static const struct of_device_id cdns_hdmi_imx_dt_ids[] = {
-	{ .compatible = "cdn,imx8mq-hdmi",
-	  .data = &imx8mq_hdmi_drv_data
-	},
-	{ .compatible = "cdn,imx8mq-dp",
-	  .data = &imx8mq_dp_drv_data
-	},
-	{},
-};
-MODULE_DEVICE_TABLE(of, cdns_hdmi_imx_dt_ids);
-
-static int cdns_hdmi_imx_bind(struct device *dev, struct device *master,
-			    void *data)
-{
-	struct platform_device *pdev = to_platform_device(dev);
-	const struct cdn_plat_data *plat_data;
-	const struct of_device_id *match;
-	struct drm_device *drm = data;
-	struct drm_encoder *encoder;
-	struct imx_hdmi *hdmi;
-	int ret;
-
-	if (!pdev->dev.of_node)
-		return -ENODEV;
-
-	hdmi = devm_kzalloc(&pdev->dev, sizeof(*hdmi), GFP_KERNEL);
-	if (!hdmi)
-		return -ENOMEM;
-
-	match = of_match_node(cdns_hdmi_imx_dt_ids, pdev->dev.of_node);
-	plat_data = match->data;
-	hdmi->dev = &pdev->dev;
-	encoder = &hdmi->encoder;
-
-	encoder->possible_crtcs = drm_of_find_possible_crtcs(drm, dev->of_node);
-	/*
-	 * If we failed to find the CRTC(s) which this encoder is
-	 * supposed to be connected to, it's because the CRTC has
-	 * not been registered yet.  Defer probing, and hope that
-	 * the required CRTC is added later.
-	 */
-	if (encoder->possible_crtcs == 0)
-		return -EPROBE_DEFER;
-
-	drm_encoder_helper_add(encoder, &cdns_hdmi_imx_encoder_helper_funcs);
-	drm_encoder_init(drm, encoder, &cdns_hdmi_imx_encoder_funcs,
-			 DRM_MODE_ENCODER_TMDS, NULL);
-
-	ret = plat_data->bind(pdev, encoder, plat_data);
-
-	/*
-	 * If cdns_hdmi_bind() fails we'll never call cdns_hdmi_unbind(),
-	 * which would have called the encoder cleanup.  Do it manually.
-	 */
-	if (ret)
-		drm_encoder_cleanup(encoder);
-
-	return ret;
-}
-
-static void cdns_hdmi_imx_unbind(struct device *dev, struct device *master,
-			       void *data)
-{
-	struct imx_mhdp_device *hdp = dev_get_drvdata(dev);
-
-	hdp->plat_data->unbind(dev);
-}
-
-static const struct component_ops cdns_hdmi_imx_ops = {
-	.bind	= cdns_hdmi_imx_bind,
-	.unbind	= cdns_hdmi_imx_unbind,
-};
-
-static int cdns_hdmi_imx_probe(struct platform_device *pdev)
-{
-	return component_add(&pdev->dev, &cdns_hdmi_imx_ops);
-}
-
-static int cdns_hdmi_imx_remove(struct platform_device *pdev)
-{
-	component_del(&pdev->dev, &cdns_hdmi_imx_ops);
-
-	return 0;
-}
-
-static struct platform_driver cdns_hdmi_imx_platform_driver = {
-	.probe  = cdns_hdmi_imx_probe,
-	.remove = cdns_hdmi_imx_remove,
-	.driver = {
-		.name = "cdn-hdp-imx8mq",
-		.of_match_table = cdns_hdmi_imx_dt_ids,
-	},
-};
-
-module_platform_driver(cdns_hdmi_imx_platform_driver);
-
-MODULE_AUTHOR("Sandor YU <sandor.yu@nxp.com>");
-MODULE_LICENSE("GPL");
-MODULE_ALIAS("platform:cdnhdmi-imx");
--- a/drivers/gpu/drm/imx/cdn-mhdp-imx8qm.c
+++ b/drivers/gpu/drm/imx/cdn-mhdp-imx8qm.c
@@ -1,54 +1,40 @@
 /*
- * Copyright (C) 2019 NXP Semiconductor, Inc.
+ * copyright (c) 2019 nxp semiconductor, inc.
  *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License version 2 as
- * published by the Free Software Foundation.
+ * this program is free software; you can redistribute it and/or modify
+ * it under the terms of the gnu general public license version 2 as
+ * published by the free software foundation.
  */
 #include <dt-bindings/firmware/imx/rsrc.h>
-#include <linux/clk.h>
-#include <linux/module.h>
-#include <linux/platform_device.h>
-#include <linux/component.h>
-#include <drm/drm_of.h>
-#include <drm/drmP.h>
-#include <drm/drm_crtc_helper.h>
-#include <drm/drm_encoder_slave.h>
 #include <linux/firmware/imx/sci.h>
-#include <linux/regmap.h>
 #include <linux/pm_domain.h>
+#include <linux/clk.h>
+#include <drm/drmP.h>
 
-#include <drm/bridge/cdns-mhdp-imx.h>
-#include "cdn-mhdp-phy.h"
-#include "imx-drm.h"
+#include "cdns-mhdp-imx.h"
 
 #define CSR_PIXEL_LINK_MUX_CTL		0x00
-#define PL_MUX_CTL_VCP_OFFSET		5
-#define PL_MUX_CTL_HCP_OFFSET		4
+#define CSR_PIXEL_LINK_MUX_VCP_OFFSET		5
+#define CSR_PIXEL_LINK_MUX_HCP_OFFSET		4
 
 #define PLL_800MHZ (800000000)
 
-struct imx_hdmi {
-	struct device *dev;
-	struct drm_encoder encoder;
-};
-
-static void imx8qm_pixel_link_mux(struct imx_mhdp_device *hdp)
+static void imx8qm_pixel_link_mux(struct imx_mhdp_device *imx_mhdp)
 {
-	struct drm_display_mode *mode = &hdp->mhdp.mode;
+	struct drm_display_mode *mode = &imx_mhdp->mhdp.mode;
 	u32 val;
 
 	val = 0x4;	/* RGB */
-	if (hdp->dual_mode)
+	if (imx_mhdp->dual_mode)
 		val |= 0x2;	/* pixel link 0 and 1 are active */
 	if (mode->flags & DRM_MODE_FLAG_PVSYNC)
-		val |= 1 << PL_MUX_CTL_VCP_OFFSET;
+		val |= 1 << CSR_PIXEL_LINK_MUX_VCP_OFFSET;
 	if (mode->flags & DRM_MODE_FLAG_PHSYNC)
-		val |= 1 << PL_MUX_CTL_HCP_OFFSET;
+		val |= 1 << CSR_PIXEL_LINK_MUX_HCP_OFFSET;
 	if (mode->flags & DRM_MODE_FLAG_INTERLACE)
 		val |= 0x2;
 
-	regmap_write(hdp->regmap_csr, hdp->csr_pxl_mux_reg, val);
+	writel(val, imx_mhdp->mhdp.regs_sec);
 }
 
 static void imx8qm_pixel_link_valid(u32 dual_mode)
@@ -120,10 +106,10 @@ static void imx8qm_clk_mux(u8 is_dp)
 		imx_sc_misc_set_control(handle, IMX_SC_R_HDMI, IMX_SC_C_MODE, 0);
 }
 
-int imx8qm_clocks_init(struct imx_mhdp_device *hdp)
+int imx8qm_clocks_init(struct imx_mhdp_device *imx_mhdp)
 {
-	struct device *dev = hdp->mhdp.dev;
-	struct imx_hdp_clks *clks = &hdp->clks;
+	struct device *dev = imx_mhdp->mhdp.dev;
+	struct imx_hdp_clks *clks = &imx_mhdp->clks;
 
 	clks->dig_pll = devm_clk_get(dev, "dig_pll");
 	if (IS_ERR(clks->dig_pll)) {
@@ -229,10 +215,10 @@ int imx8qm_clocks_init(struct imx_mhdp_d
 	return true;
 }
 
-static int imx8qm_pixel_clk_enable(struct imx_mhdp_device *hdp)
+static int imx8qm_pixel_clk_enable(struct imx_mhdp_device *imx_mhdp)
 {
-	struct imx_hdp_clks *clks = &hdp->clks;
-	struct device *dev = hdp->mhdp.dev;
+	struct imx_hdp_clks *clks = &imx_mhdp->clks;
+	struct device *dev = imx_mhdp->mhdp.dev;
 	int ret;
 
 	ret = clk_prepare_enable(clks->av_pll);
@@ -273,12 +259,11 @@ static int imx8qm_pixel_clk_enable(struc
 		return ret;
 	}
 	return ret;
-
 }
 
-static void imx8qm_pixel_clk_disable(struct imx_mhdp_device *hdp)
+static void imx8qm_pixel_clk_disable(struct imx_mhdp_device *imx_mhdp)
 {
-	struct imx_hdp_clks *clks = &hdp->clks;
+	struct imx_hdp_clks *clks = &imx_mhdp->clks;
 
 	clk_disable_unprepare(clks->lpcg_pxl);
 	clk_disable_unprepare(clks->lpcg_hdp);
@@ -289,14 +274,14 @@ static void imx8qm_pixel_clk_disable(str
 	clk_disable_unprepare(clks->av_pll);
 }
 
-static void imx8qm_pixel_clk_set_rate(struct imx_mhdp_device *hdp, u32 pclock)
+static void imx8qm_pixel_clk_set_rate(struct imx_mhdp_device *imx_mhdp, u32 pclock)
 {
-	struct imx_hdp_clks *clks = &hdp->clks;
+	struct imx_hdp_clks *clks = &imx_mhdp->clks;
 
 	/* pixel clock for HDMI */
 	clk_set_rate(clks->av_pll, pclock);
 
-	if (hdp->dual_mode == true) {
+	if (imx_mhdp->dual_mode == true) {
 		clk_set_rate(clks->clk_pxl, pclock/2);
 		clk_set_rate(clks->clk_pxl_link, pclock/2);
 	} else {
@@ -306,24 +291,11 @@ static void imx8qm_pixel_clk_set_rate(st
 	clk_set_rate(clks->clk_pxl_mux, pclock);
 }
 
-static void imx8qm_pixel_clk_rate_change(struct imx_mhdp_device *hdp)
-{
-	/* set pixel clock before video mode setup */
-	imx8qm_pixel_clk_disable(hdp);
-
-	imx8qm_pixel_clk_set_rate(hdp, hdp->mhdp.mode.clock * 1000);
-
-	imx8qm_pixel_clk_enable(hdp);
-
-	/* Config pixel link mux */
-	imx8qm_pixel_link_mux(hdp);
-}
-
-static int imx8qm_ipg_clk_enable(struct imx_mhdp_device *hdp)
+static int imx8qm_ipg_clk_enable(struct imx_mhdp_device *imx_mhdp)
 {
 	int ret;
-	struct imx_hdp_clks *clks = &hdp->clks;
-	struct device *dev = hdp->mhdp.dev;
+	struct imx_hdp_clks *clks = &imx_mhdp->clks;
+	struct device *dev = imx_mhdp->mhdp.dev;
 
 	ret = clk_prepare_enable(clks->dig_pll);
 	if (ret < 0) {
@@ -381,25 +353,9 @@ static int imx8qm_ipg_clk_enable(struct
 	return ret;
 }
 
-static void imx8qm_ipg_clk_disable(struct imx_mhdp_device *hdp)
-{
-	struct imx_hdp_clks *clks = &hdp->clks;
-
-	clk_disable_unprepare(clks->clk_i2s_bypass);
-	clk_disable_unprepare(clks->lpcg_i2s);
-	clk_disable_unprepare(clks->lpcg_apb_ctrl);
-	clk_disable_unprepare(clks->lpcg_apb_csr);
-	clk_disable_unprepare(clks->lpcg_msi);
-	clk_disable_unprepare(clks->lpcg_lis);
-	clk_disable_unprepare(clks->lpcg_apb);
-	clk_disable_unprepare(clks->clk_core);
-	clk_disable_unprepare(clks->clk_ipg);
-	clk_disable_unprepare(clks->dig_pll);
-}
-
-static void imx8qm_ipg_clk_set_rate(struct imx_mhdp_device *hdp)
+static void imx8qm_ipg_clk_set_rate(struct imx_mhdp_device *imx_mhdp)
 {
-	struct imx_hdp_clks *clks = &hdp->clks;
+	struct imx_hdp_clks *clks = &imx_mhdp->clks;
 
 	/* ipg/core clock */
 	clk_set_rate(clks->dig_pll,  PLL_800MHZ);
@@ -407,308 +363,171 @@ static void imx8qm_ipg_clk_set_rate(stru
 	clk_set_rate(clks->clk_ipg,  PLL_800MHZ/8);
 }
 
-static void imx8qm_detach_pm_domains(struct imx_mhdp_device *hdp)
+static void imx8qm_detach_pm_domains(struct imx_mhdp_device *imx_mhdp)
 {
-	if (hdp->pd_pll1_link && !IS_ERR(hdp->pd_pll1_link))
-		device_link_del(hdp->pd_pll1_link);
-	if (hdp->pd_pll1_dev && !IS_ERR(hdp->pd_pll1_dev))
-		dev_pm_domain_detach(hdp->pd_pll1_dev, true);
-
-	if (hdp->pd_pll0_link && !IS_ERR(hdp->pd_pll0_link))
-		device_link_del(hdp->pd_pll0_link);
-	if (hdp->pd_pll0_dev && !IS_ERR(hdp->pd_pll0_dev))
-		dev_pm_domain_detach(hdp->pd_pll0_dev, true);
-
-	if (hdp->pd_mhdp_link && !IS_ERR(hdp->pd_mhdp_link))
-		device_link_del(hdp->pd_mhdp_link);
-	if (hdp->pd_mhdp_dev && !IS_ERR(hdp->pd_mhdp_dev))
-		dev_pm_domain_detach(hdp->pd_mhdp_dev, true);
-
-	hdp->pd_mhdp_dev = NULL;
-	hdp->pd_mhdp_link = NULL;
-	hdp->pd_pll0_dev = NULL;
-	hdp->pd_pll0_link = NULL;
-	hdp->pd_pll1_dev = NULL;
-	hdp->pd_pll1_link = NULL;
+	if (imx_mhdp->pd_pll1_link && !IS_ERR(imx_mhdp->pd_pll1_link))
+		device_link_del(imx_mhdp->pd_pll1_link);
+	if (imx_mhdp->pd_pll1_dev && !IS_ERR(imx_mhdp->pd_pll1_dev))
+		dev_pm_domain_detach(imx_mhdp->pd_pll1_dev, true);
+
+	if (imx_mhdp->pd_pll0_link && !IS_ERR(imx_mhdp->pd_pll0_link))
+		device_link_del(imx_mhdp->pd_pll0_link);
+	if (imx_mhdp->pd_pll0_dev && !IS_ERR(imx_mhdp->pd_pll0_dev))
+		dev_pm_domain_detach(imx_mhdp->pd_pll0_dev, true);
+
+	if (imx_mhdp->pd_mhdp_link && !IS_ERR(imx_mhdp->pd_mhdp_link))
+		device_link_del(imx_mhdp->pd_mhdp_link);
+	if (imx_mhdp->pd_mhdp_dev && !IS_ERR(imx_mhdp->pd_mhdp_dev))
+		dev_pm_domain_detach(imx_mhdp->pd_mhdp_dev, true);
+
+	imx_mhdp->pd_mhdp_dev = NULL;
+	imx_mhdp->pd_mhdp_link = NULL;
+	imx_mhdp->pd_pll0_dev = NULL;
+	imx_mhdp->pd_pll0_link = NULL;
+	imx_mhdp->pd_pll1_dev = NULL;
+	imx_mhdp->pd_pll1_link = NULL;
 }
 
-static int imx8qm_attach_pm_domains(struct imx_mhdp_device *hdp)
+static int imx8qm_attach_pm_domains(struct imx_mhdp_device *imx_mhdp)
 {
-	struct device *dev = hdp->mhdp.dev;
+	struct device *dev = imx_mhdp->mhdp.dev;
 	u32 flags = DL_FLAG_STATELESS | DL_FLAG_PM_RUNTIME | DL_FLAG_RPM_ACTIVE;
 	int ret = 0;
 
-	hdp->pd_mhdp_dev = dev_pm_domain_attach_by_name(dev, "hdmi");
-	if (IS_ERR(hdp->pd_mhdp_dev)) {
-		ret = PTR_ERR(hdp->pd_mhdp_dev);
+	imx_mhdp->pd_mhdp_dev = dev_pm_domain_attach_by_name(dev, "hdmi");
+	if (IS_ERR(imx_mhdp->pd_mhdp_dev)) {
+		ret = PTR_ERR(imx_mhdp->pd_mhdp_dev);
 		dev_err(dev, "Failed to attach dc pd dev: %d\n", ret);
 		goto fail;
 	}
-	hdp->pd_mhdp_link = device_link_add(dev, hdp->pd_mhdp_dev, flags);
-	if (IS_ERR(hdp->pd_mhdp_link)) {
-		ret = PTR_ERR(hdp->pd_mhdp_link);
+	imx_mhdp->pd_mhdp_link = device_link_add(dev, imx_mhdp->pd_mhdp_dev, flags);
+	if (IS_ERR(imx_mhdp->pd_mhdp_link)) {
+		ret = PTR_ERR(imx_mhdp->pd_mhdp_link);
 		dev_err(dev, "Failed to add device link to dc pd dev: %d\n",
 			ret);
 		goto fail;
 	}
 
-	hdp->pd_pll0_dev = dev_pm_domain_attach_by_name(dev, "pll0");
-	if (IS_ERR(hdp->pd_pll0_dev)) {
-		ret = PTR_ERR(hdp->pd_pll0_dev);
+	imx_mhdp->pd_pll0_dev = dev_pm_domain_attach_by_name(dev, "pll0");
+	if (IS_ERR(imx_mhdp->pd_pll0_dev)) {
+		ret = PTR_ERR(imx_mhdp->pd_pll0_dev);
 		dev_err(dev, "Failed to attach pll0 pd dev: %d\n", ret);
 		goto fail;
 	}
-	hdp->pd_pll0_link = device_link_add(dev, hdp->pd_pll0_dev, flags);
-	if (IS_ERR(hdp->pd_pll0_link)) {
-		ret = PTR_ERR(hdp->pd_pll0_link);
+	imx_mhdp->pd_pll0_link = device_link_add(dev, imx_mhdp->pd_pll0_dev, flags);
+	if (IS_ERR(imx_mhdp->pd_pll0_link)) {
+		ret = PTR_ERR(imx_mhdp->pd_pll0_link);
 		dev_err(dev, "Failed to add device link to pll0 pd dev: %d\n",
 			ret);
 		goto fail;
 	}
 
-	hdp->pd_pll1_dev = dev_pm_domain_attach_by_name(dev, "pll1");
-	if (IS_ERR(hdp->pd_pll1_dev)) {
-		ret = PTR_ERR(hdp->pd_pll1_dev);
+	imx_mhdp->pd_pll1_dev = dev_pm_domain_attach_by_name(dev, "pll1");
+	if (IS_ERR(imx_mhdp->pd_pll1_dev)) {
+		ret = PTR_ERR(imx_mhdp->pd_pll1_dev);
 		dev_err(dev, "Failed to attach pll0 pd dev: %d\n", ret);
 		goto fail;
 	}
-	hdp->pd_pll1_link = device_link_add(dev, hdp->pd_pll1_dev, flags);
-	if (IS_ERR(hdp->pd_pll1_link)) {
-		ret = PTR_ERR(hdp->pd_pll1_link);
+	imx_mhdp->pd_pll1_link = device_link_add(dev, imx_mhdp->pd_pll1_dev, flags);
+	if (IS_ERR(imx_mhdp->pd_pll1_link)) {
+		ret = PTR_ERR(imx_mhdp->pd_pll1_link);
 		dev_err(dev, "Failed to add device link to pll1 pd dev: %d\n",
 			ret);
 		goto fail;
 	}
 fail:
-	imx8qm_detach_pm_domains(hdp);
+	imx8qm_detach_pm_domains(imx_mhdp);
 	return ret;
 }
 
-static int imx8qm_firmware_init(struct imx_mhdp_device *hdp)
+static void imx8qm_mhdp_power_on(struct cdns_mhdp_device *mhdp)
 {
-	u32 rate;
-	int ret;
-
+	struct imx_mhdp_device *imx_mhdp =
+				container_of(mhdp, struct imx_mhdp_device, mhdp);
 	/* Power on PM Domains */
-	imx8qm_attach_pm_domains(hdp);
+
+	imx8qm_attach_pm_domains(imx_mhdp);
 
 	/* clock init and  rate set */
-	imx8qm_clocks_init(hdp);
+	imx8qm_clocks_init(imx_mhdp);
 
-	imx8qm_ipg_clk_set_rate(hdp);
+	imx8qm_ipg_clk_set_rate(imx_mhdp);
 
 	/* Init pixel clock with 148.5MHz before FW init */
-	imx8qm_pixel_clk_set_rate(hdp, 148500000);
+	imx8qm_pixel_clk_set_rate(imx_mhdp, 148500000);
 
-	imx8qm_ipg_clk_enable(hdp);
+	imx8qm_ipg_clk_enable(imx_mhdp);
 
-	imx8qm_clk_mux(hdp->plat_data->is_dp);
+	imx8qm_clk_mux(imx_mhdp->mhdp.plat_data->is_dp);
 
-	imx8qm_pixel_clk_enable(hdp);
+	imx8qm_pixel_clk_enable(imx_mhdp);
 
 	imx8qm_phy_reset(1);
-
-	hdp->csr_pxl_mux_reg = 0;
-	hdp->csr_ctrl0_reg = 0x8;
-	hdp->csr_ctrl0_sec = 0xc;
-	/* iMX8QM HDP register, Remap HPD memory address to low 4K */
-	regmap_write(hdp->regmap_csr, hdp->csr_ctrl0_reg, 0);
-
-	/* configure HDMI/DP core clock */
-	rate = clk_get_rate(hdp->clks.clk_core);
-	cdns_mhdp_set_fw_clk(&hdp->mhdp, rate);
-
-	/* un-reset ucpu */
-	writel(0,  (APB_CTRL << 2) + hdp->mhdp.regs);
-	DRM_INFO("Started firmware!\n");
-
-	ret = cdns_mhdp_check_alive(&hdp->mhdp);
-	if (ret == false) {
-		DRM_ERROR("NO HDMI FW running\n");
-		return -ENXIO;
-	}
-
-	/* turn on IP activity */
-	cdns_mhdp_set_firmware_active(&hdp->mhdp, 1);
-
-	DRM_INFO("HDP FW Version - ver %d verlib %d\n",
-			__raw_readb(VER_L + hdp->mhdp.regs) + (__raw_readb(VER_H + hdp->mhdp.regs) << 8),
-	__raw_readb(VER_LIB_L_ADDR + hdp->mhdp.regs) + (__raw_readb(VER_LIB_H_ADDR + hdp->mhdp.regs) << 8));
-
-	return 0;
 }
 
-static void cdns_hdmi_imx_encoder_disable(struct drm_encoder *encoder)
+void cdns_mhdp_plat_init_imx8qm(struct cdns_mhdp_device *mhdp)
 {
-	struct imx_mhdp_device *hdp = encoder->bridge->driver_private;
+	struct imx_mhdp_device *imx_mhdp =
+				container_of(mhdp, struct imx_mhdp_device, mhdp);
 
-	imx8qm_pixel_link_sync_disable(hdp->dual_mode);
-	imx8qm_pixel_link_invalid(hdp->dual_mode);
+	imx8qm_pixel_link_sync_disable(imx_mhdp->dual_mode);
+	imx8qm_pixel_link_invalid(imx_mhdp->dual_mode);
 }
 
-static void cdns_hdmi_imx_encoder_enable(struct drm_encoder *encoder)
+void cdns_mhdp_plat_deinit_imx8qm(struct cdns_mhdp_device *mhdp)
 {
-	struct imx_mhdp_device *hdp = encoder->bridge->driver_private;
+	struct imx_mhdp_device *imx_mhdp =
+				container_of(mhdp, struct imx_mhdp_device, mhdp);
 
-	imx8qm_pixel_link_valid(hdp->dual_mode);
-	imx8qm_pixel_link_sync_enable(hdp->dual_mode);
+	imx8qm_pixel_link_valid(imx_mhdp->dual_mode);
+	imx8qm_pixel_link_sync_enable(imx_mhdp->dual_mode);
 }
 
-static int cdns_hdmi_imx_encoder_atomic_check(struct drm_encoder *encoder,
-				    struct drm_crtc_state *crtc_state,
-				    struct drm_connector_state *conn_state)
+void cdns_mhdp_pclk_rate_imx8qm(struct cdns_mhdp_device *mhdp)
 {
-	struct imx_crtc_state *imx_crtc_state = to_imx_crtc_state(crtc_state);
-
-	imx_crtc_state->bus_format = MEDIA_BUS_FMT_RGB101010_1X30;
-	return 0;
-}
+	struct imx_mhdp_device *imx_mhdp =
+				container_of(mhdp, struct imx_mhdp_device, mhdp);
 
-static const struct drm_encoder_helper_funcs cdns_hdmi_imx_encoder_helper_funcs = {
-	.enable     = cdns_hdmi_imx_encoder_enable,
-	.disable    = cdns_hdmi_imx_encoder_disable,
-	.atomic_check = cdns_hdmi_imx_encoder_atomic_check,
-};
-
-static const struct drm_encoder_funcs cdns_hdmi_imx_encoder_funcs = {
-	.destroy = drm_encoder_cleanup,
-};
-
-#if 0
-static struct cdn_plat_data imx8mq_hdmi_drv_data = {
-	.bind	= cdns_hdmi_bind,
-	.unbind	= cdns_hdmi_unbind,
-	.phy_init = cdns_hdmi_phy_set_imx8mq,
-};
-
-static struct cdn_plat_data imx8mq_dp_drv_data = {
-	.bind	= cdns_dp_bind,
-	.unbind	= cdns_dp_unbind,
-	.phy_init = cdns_dp_phy_init_imx8mq,
-};
-#endif
-
-static struct cdn_plat_data imx8qm_hdmi_drv_data = {
-	.bind	= cdns_hdmi_bind,
-	.unbind	= cdns_hdmi_unbind,
-	.phy_init = cdns_hdmi_phy_set_imx8qm,
-	.fw_init = imx8qm_firmware_init,
-	.pclock_change = imx8qm_pixel_clk_rate_change,
-};
-
-static struct cdn_plat_data imx8qm_dp_drv_data = {
-	.bind	= cdns_dp_bind,
-	.unbind	= cdns_dp_unbind,
-	.phy_init = cdns_dp_phy_init_imx8qm,
-	.fw_init = imx8qm_firmware_init,
-	.pclock_change = imx8qm_pixel_clk_rate_change,
-	.is_dp = true,
-};
-
-static const struct of_device_id cdns_hdmi_imx_dt_ids[] = {
-#if 0
-	{ .compatible = "cdn,imx8mq-hdmi",
-	  .data = &imx8mq_hdmi_drv_data
-	},
-	{ .compatible = "cdn,imx8mq-dp",
-	  .data = &imx8mq_dp_drv_data
-	},
-#endif
-	{ .compatible = "cdn,imx8qm-hdmi",
-	  .data = &imx8qm_hdmi_drv_data
-	},
-	{ .compatible = "cdn,imx8qm-dp",
-	  .data = &imx8qm_dp_drv_data
-	},
-	{},
-};
-MODULE_DEVICE_TABLE(of, cdns_hdmi_imx_dt_ids);
-
-static int cdns_hdmi_imx_bind(struct device *dev, struct device *master,
-			    void *data)
-{
-	struct platform_device *pdev = to_platform_device(dev);
-	const struct cdn_plat_data *plat_data;
-	const struct of_device_id *match;
-	struct drm_device *drm = data;
-	struct drm_encoder *encoder;
-	struct imx_hdmi *hdmi;
-	int ret;
+	/* set pixel clock before video mode setup */
+	imx8qm_pixel_clk_disable(imx_mhdp);
 
-	if (!pdev->dev.of_node)
-		return -ENODEV;
+	imx8qm_pixel_clk_set_rate(imx_mhdp, imx_mhdp->mhdp.mode.clock * 1000);
 
-	hdmi = devm_kzalloc(&pdev->dev, sizeof(*hdmi), GFP_KERNEL);
-	if (!hdmi)
-		return -ENOMEM;
-
-	match = of_match_node(cdns_hdmi_imx_dt_ids, pdev->dev.of_node);
-	plat_data = match->data;
-	hdmi->dev = &pdev->dev;
-	encoder = &hdmi->encoder;
-
-	encoder->possible_crtcs = drm_of_find_possible_crtcs(drm, dev->of_node);
-	/*
-	 * If we failed to find the CRTC(s) which this encoder is
-	 * supposed to be connected to, it's because the CRTC has
-	 * not been registered yet.  Defer probing, and hope that
-	 * the required CRTC is added later.
-	 */
-	if (encoder->possible_crtcs == 0)
-		return -EPROBE_DEFER;
-
-	drm_encoder_helper_add(encoder, &cdns_hdmi_imx_encoder_helper_funcs);
-	drm_encoder_init(drm, encoder, &cdns_hdmi_imx_encoder_funcs,
-			 DRM_MODE_ENCODER_TMDS, NULL);
-
-	ret = plat_data->bind(pdev, encoder, plat_data);
-
-	/*
-	 * If cdns_hdmi_bind() fails we'll never call cdns_hdmi_unbind(),
-	 * which would have called the encoder cleanup.  Do it manually.
-	 */
-	if (ret)
-		drm_encoder_cleanup(encoder);
+	imx8qm_pixel_clk_enable(imx_mhdp);
 
-	return ret;
+	/* Config pixel link mux */
+	imx8qm_pixel_link_mux(imx_mhdp);
 }
 
-static void cdns_hdmi_imx_unbind(struct device *dev, struct device *master,
-			       void *data)
+int cdns_mhdp_firmware_init_imx8qm(struct cdns_mhdp_device *mhdp)
 {
-	struct imx_mhdp_device *hdp = dev_get_drvdata(dev);
+	struct imx_mhdp_device *imx_mhdp =
+				container_of(mhdp, struct imx_mhdp_device, mhdp);
+	u32 rate;
+	int ret;
 
-	hdp->plat_data->unbind(dev);
-}
+	imx8qm_mhdp_power_on(mhdp);
 
-static const struct component_ops cdns_hdmi_imx8qm_ops = {
-	.bind	= cdns_hdmi_imx_bind,
-	.unbind	= cdns_hdmi_imx_unbind,
-};
+	/* configure HDMI/DP core clock */
+	rate = clk_get_rate(imx_mhdp->clks.clk_core);
+	cdns_mhdp_set_fw_clk(&imx_mhdp->mhdp, rate);
 
-static int cdns_hdmi_imx_probe(struct platform_device *pdev)
-{
-	return component_add(&pdev->dev, &cdns_hdmi_imx8qm_ops);
-}
+	/* un-reset ucpu */
+	cdns_mhdp_bus_write(0, &imx_mhdp->mhdp, APB_CTRL);
+	DRM_INFO("Started firmware!\n");
 
-static int cdns_hdmi_imx_remove(struct platform_device *pdev)
-{
-	component_del(&pdev->dev, &cdns_hdmi_imx8qm_ops);
+	ret = cdns_mhdp_check_alive(&imx_mhdp->mhdp);
+	if (ret == false) {
+		DRM_ERROR("NO HDMI FW running\n");
+		return -ENXIO;
+	}
+
+	/* turn on IP activity */
+	cdns_mhdp_set_firmware_active(&imx_mhdp->mhdp, 1);
+
+	DRM_INFO("HDP FW Version - ver %d verlib %d\n",
+			cdns_mhdp_bus_read(mhdp, VER_L) + (cdns_mhdp_bus_read(mhdp, VER_H) << 8),
+			cdns_mhdp_bus_read(mhdp, VER_LIB_H_ADDR) + (cdns_mhdp_bus_read(mhdp, VER_LIB_H_ADDR) << 8));
 
 	return 0;
 }
-
-static struct platform_driver cdns_hdmi_imx_platform_driver = {
-	.probe  = cdns_hdmi_imx_probe,
-	.remove = cdns_hdmi_imx_remove,
-	.driver = {
-		.name = "cdn-hdp-imx8qm",
-		.of_match_table = cdns_hdmi_imx_dt_ids,
-	},
-};
-
-module_platform_driver(cdns_hdmi_imx_platform_driver);
-
-MODULE_AUTHOR("Sandor YU <sandor.yu@nxp.com>");
-MODULE_LICENSE("GPL");
-MODULE_ALIAS("platform:cdnhdmi-imx");
--- /dev/null
+++ b/drivers/gpu/drm/imx/cdn-mhdp-imxdrv.c
@@ -0,0 +1,202 @@
+/*
+ * copyright (c) 2019 nxp semiconductor, inc.
+ *
+ * this program is free software; you can redistribute it and/or modify
+ * it under the terms of the gnu general public license version 2 as
+ * published by the free software foundation.
+ */
+#include <linux/module.h>
+#include <linux/platform_device.h>
+#include <linux/component.h>
+#include <drm/drm_of.h>
+#include <drm/drmP.h>
+#include <drm/drm_crtc_helper.h>
+#include <drm/drm_encoder_slave.h>
+
+#include "cdns-mhdp-imx.h"
+#include "cdn-mhdp-phy.h"
+#include "imx-drm.h"
+
+static void cdns_mhdp_imx_encoder_disable(struct drm_encoder *encoder)
+{
+	struct cdns_mhdp_device *mhdp = encoder->bridge->driver_private;
+
+	cdns_mhdp_plat_call(mhdp, plat_init);
+}
+
+static void cdns_mhdp_imx_encoder_enable(struct drm_encoder *encoder)
+{
+	struct cdns_mhdp_device *mhdp = encoder->bridge->driver_private;
+
+	cdns_mhdp_plat_call(mhdp, plat_deinit);
+}
+
+static int cdns_mhdp_imx_encoder_atomic_check(struct drm_encoder *encoder,
+				    struct drm_crtc_state *crtc_state,
+				    struct drm_connector_state *conn_state)
+{
+	struct imx_crtc_state *imx_crtc_state = to_imx_crtc_state(crtc_state);
+	struct cdns_mhdp_device *mhdp = encoder->bridge->driver_private;
+
+	if (mhdp->plat_data->video_format != 0)
+		imx_crtc_state->bus_format = mhdp->plat_data->video_format;
+	return 0;
+}
+
+static const struct drm_encoder_helper_funcs cdns_mhdp_imx_encoder_helper_funcs = {
+	.enable     = cdns_mhdp_imx_encoder_enable,
+	.disable    = cdns_mhdp_imx_encoder_disable,
+	.atomic_check = cdns_mhdp_imx_encoder_atomic_check,
+};
+
+static const struct drm_encoder_funcs cdns_mhdp_imx_encoder_funcs = {
+	.destroy = drm_encoder_cleanup,
+};
+
+static struct cdns_plat_data imx8mq_hdmi_drv_data = {
+	.bind	= cdns_hdmi_bind,
+	.unbind	= cdns_hdmi_unbind,
+	.phy_set = cdns_hdmi_phy_set_imx8mq,
+	.bus_type = BUS_TYPE_NORMAL_APB,
+};
+
+static struct cdns_plat_data imx8mq_dp_drv_data = {
+	.bind	= cdns_dp_bind,
+	.unbind	= cdns_dp_unbind,
+	.phy_set = cdns_dp_phy_set_imx8mq,
+	.bus_type = BUS_TYPE_NORMAL_APB,
+};
+
+static struct cdns_plat_data imx8qm_hdmi_drv_data = {
+	.bind	= cdns_hdmi_bind,
+	.unbind	= cdns_hdmi_unbind,
+	.phy_set = cdns_hdmi_phy_set_imx8qm,
+	.firmware_init = cdns_mhdp_firmware_init_imx8qm,
+	.pclk_rate = cdns_mhdp_pclk_rate_imx8qm,
+	.plat_init = cdns_mhdp_plat_init_imx8qm,
+	.plat_deinit = cdns_mhdp_plat_deinit_imx8qm,
+	.bus_type = BUS_TYPE_LOW4K_APB,
+	.video_format =  MEDIA_BUS_FMT_RGB101010_1X30,
+};
+
+static struct cdns_plat_data imx8qm_dp_drv_data = {
+	.bind	= cdns_dp_bind,
+	.unbind	= cdns_dp_unbind,
+	.phy_set = cdns_dp_phy_set_imx8qm,
+	.firmware_init = cdns_mhdp_firmware_init_imx8qm,
+	.pclk_rate = cdns_mhdp_pclk_rate_imx8qm,
+	.plat_init = cdns_mhdp_plat_init_imx8qm,
+	.plat_deinit = cdns_mhdp_plat_deinit_imx8qm,
+	.bus_type = BUS_TYPE_LOW4K_APB,
+	.video_format =  MEDIA_BUS_FMT_RGB101010_1X30,
+	.is_dp = true,
+};
+
+static const struct of_device_id cdns_mhdp_imx_dt_ids[] = {
+	{ .compatible = "cdn,imx8mq-hdmi",
+	  .data = &imx8mq_hdmi_drv_data
+	},
+	{ .compatible = "cdn,imx8mq-dp",
+	  .data = &imx8mq_dp_drv_data
+	},
+	{ .compatible = "cdn,imx8qm-hdmi",
+	  .data = &imx8qm_hdmi_drv_data
+	},
+	{ .compatible = "cdn,imx8qm-dp",
+	  .data = &imx8qm_dp_drv_data
+	},
+	{},
+};
+MODULE_DEVICE_TABLE(of, cdns_mhdp_imx_dt_ids);
+
+static int cdns_mhdp_imx_bind(struct device *dev, struct device *master,
+			    void *data)
+{
+	struct platform_device *pdev = to_platform_device(dev);
+	const struct cdns_plat_data *plat_data;
+	const struct of_device_id *match;
+	struct drm_device *drm = data;
+	struct drm_encoder *encoder;
+	struct imx_mhdp_device *imx_mhdp;
+	int ret;
+
+	if (!pdev->dev.of_node)
+		return -ENODEV;
+
+	imx_mhdp = devm_kzalloc(&pdev->dev, sizeof(*imx_mhdp), GFP_KERNEL);
+	if (!imx_mhdp)
+		return -ENOMEM;
+
+	match = of_match_node(cdns_mhdp_imx_dt_ids, pdev->dev.of_node);
+	plat_data = match->data;
+	encoder = &imx_mhdp->encoder;
+
+	encoder->possible_crtcs = drm_of_find_possible_crtcs(drm, dev->of_node);
+	/*
+	 * If we failed to find the CRTC(s) which this encoder is
+	 * supposed to be connected to, it's because the CRTC has
+	 * not been registered yet.  Defer probing, and hope that
+	 * the required CRTC is added later.
+	 */
+	if (encoder->possible_crtcs == 0)
+		return -EPROBE_DEFER;
+
+	drm_encoder_helper_add(encoder, &cdns_mhdp_imx_encoder_helper_funcs);
+	drm_encoder_init(drm, encoder, &cdns_mhdp_imx_encoder_funcs,
+			 DRM_MODE_ENCODER_TMDS, NULL);
+
+
+	imx_mhdp->mhdp.plat_data = plat_data;
+	imx_mhdp->mhdp.dev = dev;
+	imx_mhdp->mhdp.bus_type = plat_data->bus_type;
+	ret = plat_data->bind(pdev, encoder, &imx_mhdp->mhdp);
+	/*
+	 * If cdns_mhdp_bind() fails we'll never call cdns_mhdp_unbind(),
+	 * which would have called the encoder cleanup.  Do it manually.
+	 */
+	if (ret < 0)
+		drm_encoder_cleanup(encoder);
+
+	imx_mhdp->dual_mode = false;
+	return ret;
+}
+
+static void cdns_mhdp_imx_unbind(struct device *dev, struct device *master,
+			       void *data)
+{
+	struct imx_mhdp_device *imx_mhdp = dev_get_drvdata(dev);
+
+	imx_mhdp->mhdp.plat_data->unbind(dev);
+}
+
+static const struct component_ops cdns_mhdp_imx_ops = {
+	.bind	= cdns_mhdp_imx_bind,
+	.unbind	= cdns_mhdp_imx_unbind,
+};
+
+static int cdns_mhdp_imx_probe(struct platform_device *pdev)
+{
+	return component_add(&pdev->dev, &cdns_mhdp_imx_ops);
+}
+
+static int cdns_mhdp_imx_remove(struct platform_device *pdev)
+{
+	component_del(&pdev->dev, &cdns_mhdp_imx_ops);
+
+	return 0;
+}
+
+static struct platform_driver cdns_mhdp_imx_platform_driver = {
+	.probe  = cdns_mhdp_imx_probe,
+	.remove = cdns_mhdp_imx_remove,
+	.driver = {
+		.name = "cdn-hdp-imx8qm",
+		.of_match_table = cdns_mhdp_imx_dt_ids,
+	},
+};
+
+module_platform_driver(cdns_mhdp_imx_platform_driver);
+
+MODULE_AUTHOR("Sandor YU <sandor.yu@nxp.com>");
+MODULE_LICENSE("GPL");
+MODULE_ALIAS("platform:cdnhdmi-imx");
--- a/drivers/gpu/drm/imx/cdn-mhdp-phy.h
+++ b/drivers/gpu/drm/imx/cdn-mhdp-phy.h
@@ -10,7 +10,7 @@
 #ifndef _CDN_DP_PHY_H
 #define _CDN_DP_PHY_H
 
-#include <drm/bridge/cdns-mhdp-imx.h>
+#include <drm/bridge/cdns-mhdp-common.h>
 
 #define CMN_SSM_BIAS_TMR                0x0022
 #define CMN_PLLSM0_PLLEN_TMR            0x0029
@@ -146,8 +146,8 @@
 #define PHY_PMA_ISO_RX_DATA_LO          0xCC16
 #define PHY_PMA_ISO_RX_DATA_HI          0xCC17
 
-int cdns_dp_phy_init_imx8mq(struct imx_mhdp_device *hdp);
-int cdns_dp_phy_init_imx8qm(struct imx_mhdp_device *hdp);
-int cdns_hdmi_phy_set_imx8mq(struct imx_mhdp_device *hdp);
-int cdns_hdmi_phy_set_imx8qm(struct imx_mhdp_device *hdp);
-#endif /* _CDN_DP_PHY_H */
+int cdns_dp_phy_set_imx8mq(struct cdns_mhdp_device *hdp);
+int cdns_dp_phy_set_imx8qm(struct cdns_mhdp_device *hdp);
+int cdns_hdmi_phy_set_imx8mq(struct cdns_mhdp_device *hdp);
+int cdns_hdmi_phy_set_imx8qm(struct cdns_mhdp_device *hdp);
+#endif /* _CDNS_MHDP_PHY_H */
--- /dev/null
+++ b/drivers/gpu/drm/imx/cdns-mhdp-imx.h
@@ -0,0 +1,80 @@
+/*
+ * Cadence High-Definition Multimedia Interface (HDMI) driver
+ *
+ * Copyright (C) 2019 NXP Semiconductor, Inc.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ */
+#ifndef CDNS_MHDP_IMX_H_
+#define CDNS_MHDP_IMX_H_
+
+#include <drm/bridge/cdns-mhdp-common.h>
+#include <drm/drm_encoder_slave.h>
+
+
+#define HDP_DUAL_MODE_MIN_PCLK_RATE	300000	/* KHz */
+#define HDP_SINGLE_MODE_MAX_WIDTH	1920
+
+static inline bool video_is_dual_mode(const struct drm_display_mode *mode)
+{
+	return (mode->clock > HDP_DUAL_MODE_MIN_PCLK_RATE ||
+		mode->hdisplay > HDP_SINGLE_MODE_MAX_WIDTH) ? true : false;
+}
+
+struct imx_mhdp_device;
+
+struct imx_hdp_clks {
+	struct clk *av_pll;
+	struct clk *dig_pll;
+	struct clk *clk_ipg;
+	struct clk *clk_core;
+	struct clk *clk_pxl;
+	struct clk *clk_pxl_mux;
+	struct clk *clk_pxl_link;
+
+	struct clk *lpcg_hdp;
+	struct clk *lpcg_msi;
+	struct clk *lpcg_pxl;
+	struct clk *lpcg_vif;
+	struct clk *lpcg_lis;
+	struct clk *lpcg_apb;
+	struct clk *lpcg_apb_csr;
+	struct clk *lpcg_apb_ctrl;
+
+	struct clk *lpcg_i2s;
+	struct clk *clk_i2s_bypass;
+};
+
+struct imx_mhdp_device {
+	struct cdns_mhdp_device mhdp;
+	struct drm_encoder encoder;
+
+	struct mutex audio_mutex;
+	spinlock_t audio_lock;
+	bool connected;
+	bool active;
+	bool suspended;
+	struct imx_hdp_clks clks;
+
+	int bus_type;
+
+	u32 dual_mode;
+
+	struct device		*pd_mhdp_dev;
+	struct device		*pd_pll0_dev;
+	struct device		*pd_pll1_dev;
+	struct device_link	*pd_mhdp_link;
+	struct device_link	*pd_pll0_link;
+	struct device_link	*pd_pll1_link;
+
+//	u32 phy_init;
+};
+void cdns_mhdp_plat_init_imx8qm(struct cdns_mhdp_device *mhdp);
+void cdns_mhdp_plat_deinit_imx8qm(struct cdns_mhdp_device *mhdp);
+void cdns_mhdp_pclk_rate_imx8qm(struct cdns_mhdp_device *mhdp);
+int cdns_mhdp_firmware_init_imx8qm(struct cdns_mhdp_device *mhdp);
+#endif /* CDNS_MHDP_IMX_H_ */