platform: msm_shared: add support for 20nm HDMI PLL

Add 20nm PLL support for HDMI to drive 148.5MHz pixel
clock for 1080p@60Hz resolution.

Change-Id: I59843cfeafb710ae75530aee8b73e03d5e696c99
diff --git a/platform/msm_shared/hdmi_pll_20nm.c b/platform/msm_shared/hdmi_pll_20nm.c
new file mode 100644
index 0000000..dc11e8d
--- /dev/null
+++ b/platform/msm_shared/hdmi_pll_20nm.c
@@ -0,0 +1,1060 @@
+/* Copyright (c) 2015, The Linux Foundation. All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ *  * Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ *  * Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in
+ *    the documentation and/or other materials provided with the
+ *    distribution.
+ *  * Neither the name of The Linux Foundation nor the names of its
+ *    contributors may be used to endorse or promote products derived
+ *    from this software without specific prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
+ * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
+ * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
+ * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
+ * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
+ * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
+ * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
+ * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT
+ * OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE.
+ */
+
+#include <debug.h>
+#include <err.h>
+#include <reg.h>
+#include <smem.h>
+#include <bits.h>
+#include <msm_panel.h>
+#include <platform/timer.h>
+#include <platform/iomap.h>
+
+
+#define HDMI_PHY_CMD_SIZE  68
+#define HDMI_PHY_CLK_SIZE  97
+
+#define HDMI_PHY_BASE  0xFD9A9200
+#define HDMI_PLL_BASE  0xFD9A8600
+
+/* hdmi phy registers */
+enum {
+	CALC_QSERDES_COM_SYSCLK_EN_SEL_TXBAND = 0,
+	CALC_QSERDES_COM_DIV_REF1,
+	CALC_QSERDES_COM_DIV_REF2,
+	CALC_QSERDES_COM_KVCO_COUNT1,
+	CALC_QSERDES_COM_KVCO_COUNT2,
+	CALC_QSERDES_COM_KVCO_CAL_CNTRL,
+	CALC_QSERDES_COM_KVCO_CODE,
+	CALC_QSERDES_COM_VREF_CFG3,
+	CALC_QSERDES_COM_VREF_CFG4,
+	CALC_QSERDES_COM_VREF_CFG5,
+	CALC_QSERDES_COM_PLL_IP_SETI,
+	CALC_QSERDES_COM_PLL_CP_SETI,
+	CALC_QSERDES_COM_PLL_IP_SETP,
+	CALC_QSERDES_COM_PLL_CP_SETP,
+	CALC_QSERDES_COM_PLL_CRCTRL,
+	CALC_QSERDES_COM_DIV_FRAC_START1,
+	CALC_QSERDES_COM_DIV_FRAC_START2,
+	CALC_QSERDES_COM_DIV_FRAC_START3,
+	CALC_QSERDES_COM_DEC_START1,
+	CALC_QSERDES_COM_DEC_START2,
+	CALC_QSERDES_COM_PLLLOCK_CMP1,
+	CALC_QSERDES_COM_PLLLOCK_CMP2,
+	CALC_QSERDES_COM_PLLLOCK_CMP3,
+	CALC_QSERDES_COM_PLLLOCK_CMP_EN,
+	CALC_QSERDES_COM_RESETSM_CNTRL,
+	CALC_HDMI_PHY_MODE,
+	CALC_MAX
+};
+
+/* Set to 1 for auto KVCO cal; set to 0 for fixed value */
+#define HDMI_PHY_AUTO_KVCO_CAL    1
+
+/* PLL REGISTERS */
+#define QSERDES_COM_SYS_CLK_CTRL                        (0x000)
+#define QSERDES_COM_PLL_VCOTAIL_EN                      (0x004)
+#define QSERDES_COM_CMN_MODE                            (0x008)
+#define QSERDES_COM_IE_TRIM                             (0x00C)
+#define QSERDES_COM_IP_TRIM                             (0x010)
+#define QSERDES_COM_PLL_CNTRL                           (0x014)
+#define QSERDES_COM_PLL_PHSEL_CONTROL                   (0x018)
+#define QSERDES_COM_IPTAT_TRIM_VCCA_TX_SEL              (0x01C)
+#define QSERDES_COM_PLL_PHSEL_DC                        (0x020)
+#define QSERDES_COM_PLL_IP_SETI                         (0x024)
+#define QSERDES_COM_CORE_CLK_IN_SYNC_SEL                (0x028)
+#define QSERDES_COM_PLL_BKG_KVCO_CAL_EN                 (0x02C)
+#define QSERDES_COM_BIAS_EN_CLKBUFLR_EN                 (0x030)
+#define QSERDES_COM_PLL_CP_SETI                         (0x034)
+#define QSERDES_COM_PLL_IP_SETP                         (0x038)
+#define QSERDES_COM_PLL_CP_SETP                         (0x03C)
+#define QSERDES_COM_ATB_SEL1                            (0x040)
+#define QSERDES_COM_ATB_SEL2                            (0x044)
+#define QSERDES_COM_SYSCLK_EN_SEL_TXBAND                (0x048)
+#define QSERDES_COM_RESETSM_CNTRL                       (0x04C)
+#define QSERDES_COM_RESETSM_CNTRL2                      (0x050)
+#define QSERDES_COM_RESETSM_CNTRL3                      (0x054)
+#define QSERDES_COM_RESETSM_PLL_CAL_COUNT1              (0x058)
+#define QSERDES_COM_RESETSM_PLL_CAL_COUNT2              (0x05C)
+#define QSERDES_COM_DIV_REF1                            (0x060)
+#define QSERDES_COM_DIV_REF2                            (0x064)
+#define QSERDES_COM_KVCO_COUNT1                         (0x068)
+#define QSERDES_COM_KVCO_COUNT2                         (0x06C)
+#define QSERDES_COM_KVCO_CAL_CNTRL                      (0x070)
+#define QSERDES_COM_KVCO_CODE                           (0x074)
+#define QSERDES_COM_VREF_CFG1                           (0x078)
+#define QSERDES_COM_VREF_CFG2                           (0x07C)
+#define QSERDES_COM_VREF_CFG3                           (0x080)
+#define QSERDES_COM_VREF_CFG4                           (0x084)
+#define QSERDES_COM_VREF_CFG5                           (0x088)
+#define QSERDES_COM_VREF_CFG6                           (0x08C)
+#define QSERDES_COM_PLLLOCK_CMP1                        (0x090)
+#define QSERDES_COM_PLLLOCK_CMP2                        (0x094)
+#define QSERDES_COM_PLLLOCK_CMP3                        (0x098)
+#define QSERDES_COM_PLLLOCK_CMP_EN                      (0x09C)
+#define QSERDES_COM_BGTC                                (0x0A0)
+#define QSERDES_COM_PLL_TEST_UPDN                       (0x0A4)
+#define QSERDES_COM_PLL_VCO_TUNE                        (0x0A8)
+#define QSERDES_COM_DEC_START1                          (0x0AC)
+#define QSERDES_COM_PLL_AMP_OS                          (0x0B0)
+#define QSERDES_COM_SSC_EN_CENTER                       (0x0B4)
+#define QSERDES_COM_SSC_ADJ_PER1                        (0x0B8)
+#define QSERDES_COM_SSC_ADJ_PER2                        (0x0BC)
+#define QSERDES_COM_SSC_PER1                            (0x0C0)
+#define QSERDES_COM_SSC_PER2                            (0x0C4)
+#define QSERDES_COM_SSC_STEP_SIZE1                      (0x0C8)
+#define QSERDES_COM_SSC_STEP_SIZE2                      (0x0CC)
+#define QSERDES_COM_RES_CODE_UP                         (0x0D0)
+#define QSERDES_COM_RES_CODE_DN                         (0x0D4)
+#define QSERDES_COM_RES_CODE_UP_OFFSET                  (0x0D8)
+#define QSERDES_COM_RES_CODE_DN_OFFSET                  (0x0DC)
+#define QSERDES_COM_RES_CODE_START_SEG1                 (0x0E0)
+#define QSERDES_COM_RES_CODE_START_SEG2                 (0x0E4)
+#define QSERDES_COM_RES_CODE_CAL_CSR                    (0x0E8)
+#define QSERDES_COM_RES_CODE                            (0x0EC)
+#define QSERDES_COM_RES_TRIM_CONTROL                    (0x0F0)
+#define QSERDES_COM_RES_TRIM_CONTROL2                   (0x0F4)
+#define QSERDES_COM_RES_TRIM_EN_VCOCALDONE              (0x0F8)
+#define QSERDES_COM_FAUX_EN                             (0x0FC)
+#define QSERDES_COM_DIV_FRAC_START1                     (0x100)
+#define QSERDES_COM_DIV_FRAC_START2                     (0x104)
+#define QSERDES_COM_DIV_FRAC_START3                     (0x108)
+#define QSERDES_COM_DEC_START2                          (0x10C)
+#define QSERDES_COM_PLL_RXTXEPCLK_EN                    (0x110)
+#define QSERDES_COM_PLL_CRCTRL                          (0x114)
+#define QSERDES_COM_PLL_CLKEPDIV                        (0x118)
+#define QSERDES_COM_PLL_FREQUPDATE                      (0x11C)
+#define QSERDES_COM_PLL_BKGCAL_TRIM_UP                  (0x120)
+#define QSERDES_COM_PLL_BKGCAL_TRIM_DN                  (0x124)
+#define QSERDES_COM_PLL_BKGCAL_TRIM_MUX                 (0x128)
+#define QSERDES_COM_PLL_BKGCAL_VREF_CFG                 (0x12C)
+#define QSERDES_COM_PLL_BKGCAL_DIV_REF1                 (0x130)
+#define QSERDES_COM_PLL_BKGCAL_DIV_REF2                 (0x134)
+#define QSERDES_COM_MUXADDR                             (0x138)
+#define QSERDES_COM_LOW_POWER_RO_CONTROL                (0x13C)
+#define QSERDES_COM_POST_DIVIDER_CONTROL                (0x140)
+#define QSERDES_COM_HR_OCLK2_DIVIDER                    (0x144)
+#define QSERDES_COM_HR_OCLK3_DIVIDER                    (0x148)
+#define QSERDES_COM_PLL_VCO_HIGH                        (0x14C)
+#define QSERDES_COM_RESET_SM                            (0x150)
+#define QSERDES_COM_MUXVAL                              (0x154)
+#define QSERDES_COM_CORE_RES_CODE_DN                    (0x158)
+#define QSERDES_COM_CORE_RES_CODE_UP                    (0x15C)
+#define QSERDES_COM_CORE_VCO_TUNE                       (0x160)
+#define QSERDES_COM_CORE_VCO_TAIL                       (0x164)
+#define QSERDES_COM_CORE_KVCO_CODE                      (0x168)
+
+/* Tx Channel 0 REGISTERS */
+#define QSERDES_TX_L0_BIST_MODE_LANENO                  (0x00)
+#define QSERDES_TX_L0_CLKBUF_ENABLE                     (0x04)
+#define QSERDES_TX_L0_TX_EMP_POST1_LVL                  (0x08)
+#define QSERDES_TX_L0_TX_DRV_LVL                        (0x0C)
+#define QSERDES_TX_L0_RESET_TSYNC_EN                    (0x10)
+#define QSERDES_TX_L0_LPB_EN                            (0x14)
+#define QSERDES_TX_L0_RES_CODE_UP                       (0x18)
+#define QSERDES_TX_L0_RES_CODE_DN                       (0x1C)
+#define QSERDES_TX_L0_PERL_LENGTH1                      (0x20)
+#define QSERDES_TX_L0_PERL_LENGTH2                      (0x24)
+#define QSERDES_TX_L0_SERDES_BYP_EN_OUT                 (0x28)
+#define QSERDES_TX_L0_HIGHZ_TRANSCEIVEREN_BIAS_DRVR_EN  (0x2C)
+#define QSERDES_TX_L0_PARRATE_REC_DETECT_IDLE_EN        (0x30)
+#define QSERDES_TX_L0_BIST_PATTERN1                     (0x34)
+#define QSERDES_TX_L0_BIST_PATTERN2                     (0x38)
+#define QSERDES_TX_L0_BIST_PATTERN3                     (0x3C)
+#define QSERDES_TX_L0_BIST_PATTERN4                     (0x40)
+#define QSERDES_TX_L0_BIST_PATTERN5                     (0x44)
+#define QSERDES_TX_L0_BIST_PATTERN6                     (0x48)
+#define QSERDES_TX_L0_BIST_PATTERN7                     (0x4C)
+#define QSERDES_TX_L0_BIST_PATTERN8                     (0x50)
+#define QSERDES_TX_L0_LANE_MODE                         (0x54)
+#define QSERDES_TX_L0_IDAC_CAL_LANE_MODE                (0x58)
+#define QSERDES_TX_L0_IDAC_CAL_LANE_MODE_CONFIGURATION  (0x5C)
+#define QSERDES_TX_L0_ATB_SEL1                          (0x60)
+#define QSERDES_TX_L0_ATB_SEL2                          (0x64)
+#define QSERDES_TX_L0_RCV_DETECT_LVL                    (0x68)
+#define QSERDES_TX_L0_PRBS_SEED1                        (0x6C)
+#define QSERDES_TX_L0_PRBS_SEED2                        (0x70)
+#define QSERDES_TX_L0_PRBS_SEED3                        (0x74)
+#define QSERDES_TX_L0_PRBS_SEED4                        (0x78)
+#define QSERDES_TX_L0_RESET_GEN                         (0x7C)
+#define QSERDES_TX_L0_TRAN_DRVR_EMP_EN                  (0x80)
+#define QSERDES_TX_L0_TX_INTERFACE_MODE                 (0x84)
+#define QSERDES_TX_L0_PWM_CTRL                          (0x88)
+#define QSERDES_TX_L0_PWM_DATA                          (0x8C)
+#define QSERDES_TX_L0_PWM_ENC_DIV_CTRL                  (0x90)
+#define QSERDES_TX_L0_VMODE_CTRL1                       (0x94)
+#define QSERDES_TX_L0_VMODE_CTRL2                       (0x98)
+#define QSERDES_TX_L0_VMODE_CTRL3                       (0x9C)
+#define QSERDES_TX_L0_VMODE_CTRL4                       (0xA0)
+#define QSERDES_TX_L0_VMODE_CTRL5                       (0xA4)
+#define QSERDES_TX_L0_VMODE_CTRL6                       (0xA8)
+#define QSERDES_TX_L0_VMODE_CTRL7                       (0xAC)
+#define QSERDES_TX_L0_TX_ALOG_INTF_OBSV_CNTL            (0xB0)
+#define QSERDES_TX_L0_BIST_STATUS                       (0xB4)
+#define QSERDES_TX_L0_BIST_ERROR_COUNT1                 (0xB8)
+#define QSERDES_TX_L0_BIST_ERROR_COUNT2                 (0xBC)
+#define QSERDES_TX_L0_TX_ALOG_INTF_OBSV                 (0xC0)
+#define QSERDES_TX_L0_PWM_DEC_STATUS                    (0xC4)
+
+/* Tx Channel 1 REGISTERS */
+#define QSERDES_TX_L1_BIST_MODE_LANENO                  (0x00)
+#define QSERDES_TX_L1_CLKBUF_ENABLE                     (0x04)
+#define QSERDES_TX_L1_TX_EMP_POST1_LVL                  (0x08)
+#define QSERDES_TX_L1_TX_DRV_LVL                        (0x0C)
+#define QSERDES_TX_L1_RESET_TSYNC_EN                    (0x10)
+#define QSERDES_TX_L1_LPB_EN                            (0x14)
+#define QSERDES_TX_L1_RES_CODE_UP                       (0x18)
+#define QSERDES_TX_L1_RES_CODE_DN                       (0x1C)
+#define QSERDES_TX_L1_PERL_LENGTH1                      (0x20)
+#define QSERDES_TX_L1_PERL_LENGTH2                      (0x24)
+#define QSERDES_TX_L1_SERDES_BYP_EN_OUT                 (0x28)
+#define QSERDES_TX_L1_HIGHZ_TRANSCEIVEREN_BIAS_DRVR_EN  (0x2C)
+#define QSERDES_TX_L1_PARRATE_REC_DETECT_IDLE_EN        (0x30)
+#define QSERDES_TX_L1_BIST_PATTERN1                     (0x34)
+#define QSERDES_TX_L1_BIST_PATTERN2                     (0x38)
+#define QSERDES_TX_L1_BIST_PATTERN3                     (0x3C)
+#define QSERDES_TX_L1_BIST_PATTERN4                     (0x40)
+#define QSERDES_TX_L1_BIST_PATTERN5                     (0x44)
+#define QSERDES_TX_L1_BIST_PATTERN6                     (0x48)
+#define QSERDES_TX_L1_BIST_PATTERN7                     (0x4C)
+#define QSERDES_TX_L1_BIST_PATTERN8                     (0x50)
+#define QSERDES_TX_L1_LANE_MODE                         (0x54)
+#define QSERDES_TX_L1_IDAC_CAL_LANE_MODE                (0x58)
+#define QSERDES_TX_L1_IDAC_CAL_LANE_MODE_CONFIGURATION  (0x5C)
+#define QSERDES_TX_L1_ATB_SEL1                          (0x60)
+#define QSERDES_TX_L1_ATB_SEL2                          (0x64)
+#define QSERDES_TX_L1_RCV_DETECT_LVL                    (0x68)
+#define QSERDES_TX_L1_PRBS_SEED1                        (0x6C)
+#define QSERDES_TX_L1_PRBS_SEED2                        (0x70)
+#define QSERDES_TX_L1_PRBS_SEED3                        (0x74)
+#define QSERDES_TX_L1_PRBS_SEED4                        (0x78)
+#define QSERDES_TX_L1_RESET_GEN                         (0x7C)
+#define QSERDES_TX_L1_TRAN_DRVR_EMP_EN                  (0x80)
+#define QSERDES_TX_L1_TX_INTERFACE_MODE                 (0x84)
+#define QSERDES_TX_L1_PWM_CTRL                          (0x88)
+#define QSERDES_TX_L1_PWM_DATA                          (0x8C)
+#define QSERDES_TX_L1_PWM_ENC_DIV_CTRL                  (0x90)
+#define QSERDES_TX_L1_VMODE_CTRL1                       (0x94)
+#define QSERDES_TX_L1_VMODE_CTRL2                       (0x98)
+#define QSERDES_TX_L1_VMODE_CTRL3                       (0x9C)
+#define QSERDES_TX_L1_VMODE_CTRL4                       (0xA0)
+#define QSERDES_TX_L1_VMODE_CTRL5                       (0xA4)
+#define QSERDES_TX_L1_VMODE_CTRL6                       (0xA8)
+#define QSERDES_TX_L1_VMODE_CTRL7                       (0xAC)
+#define QSERDES_TX_L1_TX_ALOG_INTF_OBSV_CNTL            (0xB0)
+#define QSERDES_TX_L1_BIST_STATUS                       (0xB4)
+#define QSERDES_TX_L1_BIST_ERROR_COUNT1                 (0xB8)
+#define QSERDES_TX_L1_BIST_ERROR_COUNT2                 (0xBC)
+#define QSERDES_TX_L1_TX_ALOG_INTF_OBSV                 (0xC0)
+#define QSERDES_TX_L1_PWM_DEC_STATUS                    (0xC4)
+
+/* Tx Channel 2 REGISERS */
+#define QSERDES_TX_L2_BIST_MODE_LANENO                  (0x00)
+#define QSERDES_TX_L2_CLKBUF_ENABLE                     (0x04)
+#define QSERDES_TX_L2_TX_EMP_POST1_LVL                  (0x08)
+#define QSERDES_TX_L2_TX_DRV_LVL                        (0x0C)
+#define QSERDES_TX_L2_RESET_TSYNC_EN                    (0x10)
+#define QSERDES_TX_L2_LPB_EN                            (0x14)
+#define QSERDES_TX_L2_RES_CODE_UP                       (0x18)
+#define QSERDES_TX_L2_RES_CODE_DN                       (0x1C)
+#define QSERDES_TX_L2_PERL_LENGTH1                      (0x20)
+#define QSERDES_TX_L2_PERL_LENGTH2                      (0x24)
+#define QSERDES_TX_L2_SERDES_BYP_EN_OUT                 (0x28)
+#define QSERDES_TX_L2_HIGHZ_TRANSCEIVEREN_BIAS_DRVR_EN  (0x2C)
+#define QSERDES_TX_L2_PARRATE_REC_DETECT_IDLE_EN        (0x30)
+#define QSERDES_TX_L2_BIST_PATTERN1                     (0x34)
+#define QSERDES_TX_L2_BIST_PATTERN2                     (0x38)
+#define QSERDES_TX_L2_BIST_PATTERN3                     (0x3C)
+#define QSERDES_TX_L2_BIST_PATTERN4                     (0x40)
+#define QSERDES_TX_L2_BIST_PATTERN5                     (0x44)
+#define QSERDES_TX_L2_BIST_PATTERN6                     (0x48)
+#define QSERDES_TX_L2_BIST_PATTERN7                     (0x4C)
+#define QSERDES_TX_L2_BIST_PATTERN8                     (0x50)
+#define QSERDES_TX_L2_LANE_MODE                         (0x54)
+#define QSERDES_TX_L2_IDAC_CAL_LANE_MODE                (0x58)
+#define QSERDES_TX_L2_IDAC_CAL_LANE_MODE_CONFIGURATION  (0x5C)
+#define QSERDES_TX_L2_ATB_SEL1                          (0x60)
+#define QSERDES_TX_L2_ATB_SEL2                          (0x64)
+#define QSERDES_TX_L2_RCV_DETECT_LVL                    (0x68)
+#define QSERDES_TX_L2_PRBS_SEED1                        (0x6C)
+#define QSERDES_TX_L2_PRBS_SEED2                        (0x70)
+#define QSERDES_TX_L2_PRBS_SEED3                        (0x74)
+#define QSERDES_TX_L2_PRBS_SEED4                        (0x78)
+#define QSERDES_TX_L2_RESET_GEN                         (0x7C)
+#define QSERDES_TX_L2_TRAN_DRVR_EMP_EN                  (0x80)
+#define QSERDES_TX_L2_TX_INTERFACE_MODE                 (0x84)
+#define QSERDES_TX_L2_PWM_CTRL                          (0x88)
+#define QSERDES_TX_L2_PWM_DATA                          (0x8C)
+#define QSERDES_TX_L2_PWM_ENC_DIV_CTRL                  (0x90)
+#define QSERDES_TX_L2_VMODE_CTRL1                       (0x94)
+#define QSERDES_TX_L2_VMODE_CTRL2                       (0x98)
+#define QSERDES_TX_L2_VMODE_CTRL3                       (0x9C)
+#define QSERDES_TX_L2_VMODE_CTRL4                       (0xA0)
+#define QSERDES_TX_L2_VMODE_CTRL5                       (0xA4)
+#define QSERDES_TX_L2_VMODE_CTRL6                       (0xA8)
+#define QSERDES_TX_L2_VMODE_CTRL7                       (0xAC)
+#define QSERDES_TX_L2_TX_ALOG_INTF_OBSV_CNTL            (0xB0)
+#define QSERDES_TX_L2_BIST_STATUS                       (0xB4)
+#define QSERDES_TX_L2_BIST_ERROR_COUNT1                 (0xB8)
+#define QSERDES_TX_L2_BIST_ERROR_COUNT2                 (0xBC)
+#define QSERDES_TX_L2_TX_ALOG_INTF_OBSV                 (0xC0)
+#define QSERDES_TX_L2_PWM_DEC_STATUS                    (0xC4)
+
+/* Tx Channel 3 REGISERS */
+#define QSERDES_TX_L3_BIST_MODE_LANENO                  (0x00)
+#define QSERDES_TX_L3_CLKBUF_ENABLE                     (0x04)
+#define QSERDES_TX_L3_TX_EMP_POST1_LVL                  (0x08)
+#define QSERDES_TX_L3_TX_DRV_LVL                        (0x0C)
+#define QSERDES_TX_L3_RESET_TSYNC_EN                    (0x10)
+#define QSERDES_TX_L3_LPB_EN                            (0x14)
+#define QSERDES_TX_L3_RES_CODE_UP                       (0x18)
+#define QSERDES_TX_L3_RES_CODE_DN                       (0x1C)
+#define QSERDES_TX_L3_PERL_LENGTH1                      (0x20)
+#define QSERDES_TX_L3_PERL_LENGTH2                      (0x24)
+#define QSERDES_TX_L3_SERDES_BYP_EN_OUT                 (0x28)
+#define QSERDES_TX_L3_HIGHZ_TRANSCEIVEREN_BIAS_DRVR_EN  (0x2C)
+#define QSERDES_TX_L3_PARRATE_REC_DETECT_IDLE_EN        (0x30)
+#define QSERDES_TX_L3_BIST_PATTERN1                     (0x34)
+#define QSERDES_TX_L3_BIST_PATTERN2                     (0x38)
+#define QSERDES_TX_L3_BIST_PATTERN3                     (0x3C)
+#define QSERDES_TX_L3_BIST_PATTERN4                     (0x40)
+#define QSERDES_TX_L3_BIST_PATTERN5                     (0x44)
+#define QSERDES_TX_L3_BIST_PATTERN6                     (0x48)
+#define QSERDES_TX_L3_BIST_PATTERN7                     (0x4C)
+#define QSERDES_TX_L3_BIST_PATTERN8                     (0x50)
+#define QSERDES_TX_L3_LANE_MODE                         (0x54)
+#define QSERDES_TX_L3_IDAC_CAL_LANE_MODE                (0x58)
+#define QSERDES_TX_L3_IDAC_CAL_LANE_MODE_CONFIGURATION  (0x5C)
+#define QSERDES_TX_L3_ATB_SEL1                          (0x60)
+#define QSERDES_TX_L3_ATB_SEL2                          (0x64)
+#define QSERDES_TX_L3_RCV_DETECT_LVL                    (0x68)
+#define QSERDES_TX_L3_PRBS_SEED1                        (0x6C)
+#define QSERDES_TX_L3_PRBS_SEED2                        (0x70)
+#define QSERDES_TX_L3_PRBS_SEED3                        (0x74)
+#define QSERDES_TX_L3_PRBS_SEED4                        (0x78)
+#define QSERDES_TX_L3_RESET_GEN                         (0x7C)
+#define QSERDES_TX_L3_TRAN_DRVR_EMP_EN                  (0x80)
+#define QSERDES_TX_L3_TX_INTERFACE_MODE                 (0x84)
+#define QSERDES_TX_L3_PWM_CTRL                          (0x88)
+#define QSERDES_TX_L3_PWM_DATA                          (0x8C)
+#define QSERDES_TX_L3_PWM_ENC_DIV_CTRL                  (0x90)
+#define QSERDES_TX_L3_VMODE_CTRL1                       (0x94)
+#define QSERDES_TX_L3_VMODE_CTRL2                       (0x98)
+#define QSERDES_TX_L3_VMODE_CTRL3                       (0x9C)
+#define QSERDES_TX_L3_VMODE_CTRL4                       (0xA0)
+#define QSERDES_TX_L3_VMODE_CTRL5                       (0xA4)
+#define QSERDES_TX_L3_VMODE_CTRL6                       (0xA8)
+#define QSERDES_TX_L3_VMODE_CTRL7                       (0xAC)
+#define QSERDES_TX_L3_TX_ALOG_INTF_OBSV_CNTL            (0xB0)
+#define QSERDES_TX_L3_BIST_STATUS                       (0xB4)
+#define QSERDES_TX_L3_BIST_ERROR_COUNT1                 (0xB8)
+#define QSERDES_TX_L3_BIST_ERROR_COUNT2                 (0xBC)
+#define QSERDES_TX_L3_TX_ALOG_INTF_OBSV                 (0xC0)
+#define QSERDES_TX_L3_PWM_DEC_STATUS                    (0xC4)
+
+/* HDMI PHY REGISTERS */
+#define HDMI_PHY_CFG                                    (0x00)
+#define HDMI_PHY_PD_CTL                                 (0x04)
+#define HDMI_PHY_MODE                                   (0x08)
+#define HDMI_PHY_MISR_CLEAR                             (0x0C)
+#define HDMI_PHY_TX0_TX1_BIST_CFG0                      (0x10)
+#define HDMI_PHY_TX0_TX1_BIST_CFG1                      (0x14)
+#define HDMI_PHY_TX0_TX1_PRBS_SEED_BYTE0                (0x18)
+#define HDMI_PHY_TX0_TX1_PRBS_SEED_BYTE1                (0x1C)
+#define HDMI_PHY_TX0_TX1_PRBS_SEED_BYTE2                (0x20)
+#define HDMI_PHY_TX0_TX1_PRBS_SEED_BYTE3                (0x24)
+#define HDMI_PHY_TX0_TX1_PRBS_POLY_BYTE0                (0x28)
+#define HDMI_PHY_TX0_TX1_PRBS_POLY_BYTE1                (0x2C)
+#define HDMI_PHY_TX0_TX1_PRBS_POLY_BYTE2                (0x30)
+#define HDMI_PHY_TX0_TX1_PRBS_POLY_BYTE3                (0x34)
+#define HDMI_PHY_TX2_TX3_BIST_CFG0                      (0x38)
+#define HDMI_PHY_TX2_TX3_BIST_CFG1                      (0x3C)
+#define HDMI_PHY_TX2_TX3_PRBS_SEED_BYTE0                (0x40)
+#define HDMI_PHY_TX2_TX3_PRBS_SEED_BYTE1                (0x44)
+#define HDMI_PHY_TX2_TX3_PRBS_SEED_BYTE2                (0x48)
+#define HDMI_PHY_TX2_TX3_PRBS_SEED_BYTE3                (0x4C)
+#define HDMI_PHY_TX2_TX3_PRBS_POLY_BYTE0                (0x50)
+#define HDMI_PHY_TX2_TX3_PRBS_POLY_BYTE1                (0x54)
+#define HDMI_PHY_TX2_TX3_PRBS_POLY_BYTE2                (0x58)
+#define HDMI_PHY_TX2_TX3_PRBS_POLY_BYTE3                (0x5C)
+#define HDMI_PHY_DEBUG_BUS_SEL                          (0x60)
+#define HDMI_PHY_TXCAL_CFG0                             (0x64)
+#define HDMI_PHY_TXCAL_CFG1                             (0x68)
+#define HDMI_PHY_TX0_TX1_BIST_STATUS0                   (0x6C)
+#define HDMI_PHY_TX0_TX1_BIST_STATUS1                   (0x70)
+#define HDMI_PHY_TX0_TX1_BIST_STATUS2                   (0x74)
+#define HDMI_PHY_TX2_TX3_BIST_STATUS0                   (0x78)
+#define HDMI_PHY_TX2_TX3_BIST_STATUS1                   (0x7C)
+#define HDMI_PHY_TX2_TX3_BIST_STATUS2                   (0x80)
+#define HDMI_PHY_PRE_MISR_STATUS0                       (0x84)
+#define HDMI_PHY_PRE_MISR_STATUS1                       (0x88)
+#define HDMI_PHY_PRE_MISR_STATUS2                       (0x8C)
+#define HDMI_PHY_PRE_MISR_STATUS3                       (0x90)
+#define HDMI_PHY_POST_MISR_STATUS0                      (0x94)
+#define HDMI_PHY_POST_MISR_STATUS1                      (0x98)
+#define HDMI_PHY_POST_MISR_STATUS2                      (0x9C)
+#define HDMI_PHY_POST_MISR_STATUS3                      (0xA0)
+#define HDMI_PHY_STATUS                                 (0xA4)
+#define HDMI_PHY_MISC3_STATUS                           (0xA8)
+#define HDMI_PHY_DEBUG_BUS0                             (0xAC)
+#define HDMI_PHY_DEBUG_BUS1                             (0xB0)
+#define HDMI_PHY_DEBUG_BUS2                             (0xB4)
+#define HDMI_PHY_DEBUG_BUS3                             (0xB8)
+#define HDMI_PHY_REVISION_ID0                           (0xBC)
+#define HDMI_PHY_REVISION_ID1                           (0xC0)
+#define HDMI_PHY_REVISION_ID2                           (0xC4)
+#define HDMI_PHY_REVISION_ID3                           (0xC8)
+
+#define HDMI_PLL_POLL_MAX_READS			2500
+#define HDMI_PLL_POLL_TIMEOUT_US		50
+
+static uint32_t clk_tbl[HDMI_PHY_CLK_SIZE] = {
+	297000000, 268500000, 148500000,  74250000,  27000000,  27027000,
+	 25200000, 108108000,  54054000,  25175000,  31500000,  33750000,
+	 35500000,  36000000,  40000000,  49500000,  50000000,  56250000,
+	 65000000,  68250000,  71000000,  72000000,  73250000,  75000000,
+	 78750000,  79500000,  83500000,  85500000,  88750000,  94500000,
+	101000000, 102250000, 106500000, 108000000, 115500000, 117500000,
+	119000000, 121750000, 122500000, 135000000, 136750000, 140250000,
+	146250000, 148250000,  25175000,  31469000,  33784000,  37762000,
+	 37800000,  40500000,  40541000,  44900000,  73515000,  74176000,
+	 91894000,  92720000,  92813000, 110272000, 111264000, 111375000,
+	118681000, 118800000, 140250000, 148352000, 154000000, 156000000,
+	157000000, 157500000, 162000000, 175500000, 178022000, 178200000,
+	179500000, 182750000, 185440000, 185625000, 187000000, 187250000,
+	189000000, 193250000, 202500000, 204750000, 208000000, 214750000,
+	218250000, 222527000, 222750000, 229500000, 234000000, 245250000,
+	245500000, 261000000, 268250000, 281250000, 288000000, 296703000,
+	340000000,
+};
+
+/* one to one mapping with clk_tbl */
+static uint32_t clk_settings[CALC_MAX][HDMI_PHY_CLK_SIZE] = {
+	{	/* CALC_QSERDES_COM_SYSCLK_EN_SEL_TXBAND */
+		0x4A, 0x4A, 0x5A, 0x6A, 0x7A, 0x7A, 0x7A, 0x5A, 0x6A, 0x7A,
+		0x7A, 0x7A, 0x7A, 0x7A, 0x6A, 0x6A, 0x6A, 0x6A, 0x6A, 0x6A,
+		0x6A, 0x6A, 0x6A, 0x6A, 0x6A, 0x6A, 0x5A, 0x5A, 0x5A, 0x5A,
+		0x5A, 0x5A, 0x5A, 0x5A, 0x5A, 0x5A, 0x5A, 0x5A, 0x5A, 0x5A,
+		0x5A, 0x5A, 0x5A, 0x5A, 0x7A, 0x7A, 0x7A, 0x7A, 0x7A, 0x6A,
+		0x6A, 0x6A, 0x6A, 0x6A, 0x5A, 0x5A, 0x5A, 0x5A, 0x5A, 0x5A,
+		0x5A, 0x5A, 0x5A, 0x5A, 0x5A, 0x5A, 0x5A, 0x5A, 0x4A, 0x4A,
+		0x4A, 0x4A, 0x4A, 0x4A, 0x4A, 0x4A, 0x4A, 0x4A, 0x4A, 0x4A,
+		0x4A, 0x4A, 0x4A, 0x4A, 0x4A, 0x4A, 0x4A, 0x4A, 0x4A, 0x4A,
+		0x4A, 0x4A, 0x4A, 0x4A, 0x4A, 0x4A, 0x4A
+	},
+	{	/* CALC_QSERDES_COM_DIV_REF1 */
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
+	},
+	{	/* CALC_QSERDES_COM_DIV_REF2 */
+		0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01,
+		0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01,
+		0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01,
+		0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01,
+		0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01,
+		0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01,
+		0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01,
+		0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01,
+		0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01,
+		0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x00
+	},
+	{	/* CALC_QSERDES_COM_KVCO_COUNT1 */
+		0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A,
+		0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A,
+		0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A,
+		0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A,
+		0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A,
+		0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A,
+		0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A,
+		0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A,
+		0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A,
+		0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x8A, 0x00
+	},
+	{	/* CALC_QSERDES_COM_KVCO_COUNT2 */
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
+	},
+	{	/* CALC_QSERDES_COM_KVCO_CAL_CNTRL */
+		0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F,
+		0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F,
+		0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F,
+		0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F,
+		0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F,
+		0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F,
+		0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F,
+		0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F,
+		0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F,
+		0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x00
+	},
+	{	/* CALC_QSERDES_COM_KVCO_CODE */
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x3F
+	},
+	{	/* CALC_QSERDES_COM_VREF_CFG3 */
+		0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40,
+		0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40,
+		0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40,
+		0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40,
+		0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40,
+		0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40,
+		0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40,
+		0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40,
+		0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x40,
+		0x40, 0x40, 0x40, 0x40, 0x40, 0x40, 0x00
+	},
+	{	/* CALC_QSERDES_COM_VREF_CFG4 */
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
+	},
+	{	/* CALC_QSERDES_COM_VREF_CFG5 */
+		0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10,
+		0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10,
+		0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10,
+		0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10,
+		0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10,
+		0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10,
+		0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10,
+		0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10,
+		0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10,
+		0x10, 0x10, 0x10, 0x10, 0x10, 0x10, 0x10
+	},
+	{	/* CALC_QSERDES_COM_PLL_IP_SETI */
+		0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03,
+		0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03,
+		0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03,
+		0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03,
+		0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03,
+		0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03,
+		0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03,
+		0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03,
+		0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03,
+		0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03
+	},
+	{	/* CALC_QSERDES_COM_PLL_CP_SETI */
+		0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
+		0x3F, 0x3F, 0x2F, 0x2F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
+		0x2F, 0x2F, 0x2F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
+		0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
+		0x3F, 0x2F, 0x2F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
+		0x3F, 0x3F, 0x2F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
+		0x3F, 0x3F, 0x2F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
+		0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
+		0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F, 0x3F,
+		0x3F, 0x3F, 0x3F, 0x2F, 0x2F, 0x3F, 0x3F
+	},
+	{	/* CALC_QSERDES_COM_PLL_IP_SETP */
+		0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03,
+		0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03,
+		0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03,
+		0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03,
+		0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03,
+		0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03,
+		0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03,
+		0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03,
+		0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03,
+		0x03, 0x03, 0x03, 0x03, 0x03, 0x03, 0x03
+	},
+	{	/* CALC_QSERDES_COM_PLL_CP_SETP */
+		0x17, 0x1F, 0x17, 0x17, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F,
+		0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F,
+		0x1F, 0x1F, 0x1F, 0x17, 0x17, 0x17, 0x1F, 0x1F, 0x1F, 0x1F,
+		0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F,
+		0x1F, 0x1F, 0x1F, 0x17, 0x1F, 0x1F, 0x1F, 0x17, 0x17, 0x1F,
+		0x1F, 0x1F, 0x1F, 0x17, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F,
+		0x1F, 0x1F, 0x1F, 0x17, 0x17, 0x17, 0x17, 0x17, 0x1F, 0x1F,
+		0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F,
+		0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x1F,
+		0x1F, 0x1F, 0x1F, 0x1F, 0x1F, 0x17, 0x17
+	},
+	{	/* CALC_QSERDES_COM_PLL_CRCTRL */
+		0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB,
+		0xBB, 0xBB, 0xBB, 0xBB, 0x77, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB,
+		0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB,
+		0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB,
+		0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB,
+		0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB,
+		0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB,
+		0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB,
+		0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB,
+		0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB, 0xBB
+	},
+	{	/* CALC_QSERDES_COM_DIV_FRAC_START1 */
+		0x80, 0x80, 0x80, 0x80, 0x80, 0xE6, 0x80, 0xE6, 0xE6, 0xAB,
+		0x80, 0x80, 0xD5, 0x80, 0xAB, 0x80, 0xD5, 0x80, 0xD5, 0x80,
+		0xD5, 0x80, 0xD5, 0x80, 0x80, 0x80, 0xD5, 0x80, 0xD5, 0x80,
+		0xAB, 0xD5, 0x80, 0x80, 0x80, 0xAB, 0xAB, 0xD5, 0xD5, 0x80,
+		0xD5, 0x80, 0x80, 0xAB, 0xAB, 0xF7, 0xA2, 0xBC, 0x80, 0x80,
+		0xEF, 0xD5, 0x80, 0xC4, 0x89, 0xAB, 0x91, 0xEF, 0xB3, 0x80,
+		0xA2, 0x80, 0x80, 0xC4, 0xD5, 0x80, 0xD5, 0x80, 0x80, 0x80,
+		0xA2, 0x80, 0xAB, 0xD5, 0xAB, 0x80, 0xAB, 0xD5, 0x80, 0xD5,
+		0x80, 0x80, 0xAB, 0xAB, 0x80, 0xA2, 0x80, 0x80, 0x80, 0x80,
+		0xAB, 0x80, 0xD5, 0x80, 0x80, 0xB3, 0xAB
+	},
+	{	/* CALC_QSERDES_COM_DIV_FRAC_START2 */
+		0x80, 0x80, 0x80, 0x80, 0x80, 0xCC, 0x80, 0xCC, 0xCC, 0xD5,
+		0x80, 0x80, 0xAA, 0x80, 0xD5, 0x80, 0xAA, 0x80, 0xAA, 0x80,
+		0xAA, 0x80, 0xAA, 0x80, 0x80, 0x80, 0xAA, 0x80, 0xAA, 0x80,
+		0xD5, 0xAA, 0x80, 0x80, 0x80, 0xD5, 0xD5, 0xAA, 0xAA, 0x80,
+		0xAA, 0x80, 0x80, 0xD5, 0xD5, 0xEE, 0xC4, 0xF7, 0x80, 0x80,
+		0xDD, 0xAA, 0x80, 0x88, 0x91, 0xD5, 0xE2, 0xDD, 0xE6, 0xC0,
+		0x84, 0x80, 0x80, 0x88, 0xAA, 0x80, 0xAA, 0x80, 0x80, 0x80,
+		0x84, 0x80, 0xD5, 0xEA, 0xD5, 0xE0, 0xD5, 0xEA, 0x80, 0xEA,
+		0x80, 0xC0, 0xD5, 0x95, 0xC0, 0xE4, 0xC0, 0x80, 0x80, 0xC0,
+		0xD5, 0x80, 0xEA, 0xC0, 0x80, 0x86, 0xD5
+	},
+	{	/* CALC_QSERDES_COM_DIV_FRAC_START3 */
+		0x56, 0x7B, 0x56, 0x56, 0x50, 0x53, 0x60, 0x53, 0x53, 0x5C,
+		0x68, 0x54, 0x7D, 0x40, 0x6A, 0x64, 0x45, 0x66, 0x6D, 0x46,
+		0x7D, 0x40, 0x53, 0x48, 0x42, 0x74, 0x5F, 0x62, 0x4E, 0x4E,
+		0x66, 0x50, 0x5E, 0x50, 0x4A, 0x4C, 0x7E, 0x5A, 0x73, 0x54,
+		0x4E, 0x43, 0x4B, 0x4D, 0x5C, 0x63, 0x58, 0x6A, 0x70, 0x4C,
+		0x4E, 0x71, 0x65, 0x51, 0x77, 0x52, 0x55, 0x5B, 0x7C, 0x40,
+		0x74, 0x78, 0x43, 0x51, 0x4D, 0x50, 0x71, 0x42, 0x4C, 0x6D,
+		0x57, 0x5A, 0x6F, 0x65, 0x52, 0x55, 0x6C, 0x70, 0x4E, 0x54,
+		0x6F, 0x54, 0x4A, 0x7B, 0x75, 0x7C, 0x40, 0x71, 0x7C, 0x77,
+		0x7B, 0x7E, 0x76, 0x4F, 0x40, 0x51, 0x62
+	},
+	{	/* CALC_QSERDES_COM_DEC_START1 */
+		0xCD, 0xC5, 0xCD, 0xCD, 0xB8, 0xB8, 0xB4, 0xB8, 0xB8, 0xB4,
+		0xC1, 0xC6, 0xC9, 0xCB, 0xA9, 0xB3, 0xB4, 0xBA, 0xC3, 0xC7,
+		0xC9, 0xCB, 0xCC, 0xCE, 0xD2, 0xD2, 0xAB, 0xAC, 0xAE, 0xB1,
+		0xB4, 0xB5, 0xB7, 0xB8, 0xBC, 0xBD, 0xBD, 0xBF, 0xBF, 0xC6,
+		0xC7, 0xC9, 0xCC, 0xCD, 0xB4, 0xC1, 0xC6, 0xCE, 0xCE, 0xAA,
+		0xAA, 0xAE, 0xCC, 0xCD, 0xAF, 0xB0, 0xB0, 0xB9, 0xB9, 0xBA,
+		0xBD, 0xBD, 0xC9, 0xCD, 0xD0, 0xD1, 0xD1, 0xD2, 0xAA, 0xAD,
+		0xAE, 0xAE, 0xAE, 0xAF, 0xB0, 0xB0, 0xB0, 0xB0, 0xB1, 0xB2,
+		0xB4, 0xB5, 0xB6, 0xB7, 0xB8, 0xB9, 0xBA, 0xBB, 0xBC, 0xBF,
+		0xBF, 0xC3, 0xC5, 0xC9, 0xCB, 0xCD, 0xD8
+	},
+	{	/*CALC_QSERDES_COM_DEC_START2 */
+		0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02,
+		0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02,
+		0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02,
+		0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02,
+		0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02,
+		0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02,
+		0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02,
+		0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02,
+		0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02,
+		0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02
+	},
+	{	/* CALC_QSERDES_COM_PLLLOCK_CMP1 */
+		0xDF, 0xEF, 0xDF, 0xDF, 0xFF, 0x0B, 0xFF, 0x0B, 0x0B, 0xF4,
+		0x7F, 0x3F, 0x2A, 0xFF, 0x54, 0x3F, 0xAA, 0xDF, 0x2A, 0xDF,
+		0x2A, 0xFF, 0x0A, 0x7F, 0x9F, 0x3F, 0xCA, 0x9F, 0xFA, 0x5F,
+		0x14, 0x9A, 0x5F, 0xFF, 0x1F, 0xF4, 0x94, 0xBA, 0x0A, 0x3F,
+		0xFA, 0x6F, 0xEF, 0xC4, 0xF4, 0x72, 0x4E, 0xEF, 0xFF, 0xBF,
+		0xC8, 0x6A, 0x42, 0xCF, 0x49, 0xA1, 0xAB, 0xF1, 0x5B, 0x67,
+		0x72, 0x7F, 0x6F, 0xCF, 0x2A, 0xFF, 0x6A, 0x9F, 0xBF, 0x8F,
+		0x16, 0x1F, 0x64, 0x12, 0xA1, 0xAB, 0xF4, 0x02, 0x5F, 0x42,
+		0x2F, 0xA7, 0x54, 0xBC, 0x77, 0x5B, 0x67, 0xCF, 0xBF, 0x17,
+		0x24, 0x5F, 0xE2, 0x97, 0xFF, 0xCF, 0xD4
+	},
+	{	/* CALC_QSERDES_COM_PLLLOCK_CMP2 */
+		0x3D, 0x37, 0x3D, 0x3D, 0x2C, 0x2D, 0x29, 0x2D, 0x2D, 0x29,
+		0x34, 0x38, 0x3B, 0x3B, 0x21, 0x29, 0x29, 0x2E, 0x36, 0x38,
+		0x3B, 0x3B, 0x3D, 0x3E, 0x41, 0x42, 0x22, 0x23, 0x24, 0x27,
+		0x2A, 0x2A, 0x2C, 0x2C, 0x30, 0x30, 0x31, 0x32, 0x33, 0x38,
+		0x38, 0x3A, 0x3C, 0x3D, 0x29, 0x34, 0x38, 0x3E, 0x3E, 0x21,
+		0x21, 0x25, 0x3D, 0x3D, 0x26, 0x26, 0x26, 0x2D, 0x2E, 0x2E,
+		0x31, 0x31, 0x3A, 0x3D, 0x40, 0x40, 0x41, 0x41, 0x21, 0x24,
+		0x25, 0x25, 0x25, 0x26, 0x26, 0x26, 0x26, 0x27, 0x27, 0x28,
+		0x2A, 0x2A, 0x2B, 0x2C, 0x2D, 0x2E, 0x2E, 0x2F, 0x30, 0x33,
+		0x33, 0x36, 0x37, 0x3A, 0x3B, 0x3D, 0x46
+	},
+	{	/* CALC_QSERDES_COM_PLLLOCK_CMP3 */
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
+	},
+	{	/* CALC_QSERDES_COM_PLLLOCK_CMP_EN */
+		0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11,
+		0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11,
+		0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11,
+		0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11,
+		0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11,
+		0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11,
+		0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11,
+		0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11,
+		0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11,
+		0x11, 0x11, 0x11, 0x11, 0x11, 0x11, 0x11
+	},
+	{	/* CALC_QSERDES_COM_RESETSM_CNTRL */
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x80
+	},
+	{	/* CALC_HDMI_PHY_MODE */
+		0x00, 0x00, 0x01, 0x02, 0x03, 0x03, 0x03, 0x01, 0x02, 0x03,
+		0x03, 0x03, 0x03, 0x03, 0x02, 0x02, 0x02, 0x02, 0x02, 0x02,
+		0x02, 0x02, 0x02, 0x02, 0x02, 0x02, 0x01, 0x01, 0x01, 0x01,
+		0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01,
+		0x01, 0x01, 0x01, 0x01, 0x03, 0x03, 0x03, 0x03, 0x03, 0x02,
+		0x02, 0x02, 0x02, 0x02, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01,
+		0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
+		0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00
+	}
+};
+
+#define SW_RESET BIT(2)
+#define SW_RESET_PLL BIT(0)
+
+void hdmi_phy_reset(void)
+{
+	uint32_t phy_reset_polarity = 0x0;
+	uint32_t pll_reset_polarity = 0x0;
+	uint32_t val;
+
+	val = readl(HDMI_PHY_CTRL);
+
+	phy_reset_polarity = val >> 3 & 0x1;
+	pll_reset_polarity = val >> 1 & 0x1;
+
+	if (phy_reset_polarity == 0)
+		writel(val | SW_RESET, HDMI_PHY_CTRL);
+	else
+		writel(val & (~SW_RESET), HDMI_PHY_CTRL);
+
+	if (pll_reset_polarity == 0)
+		writel(val | SW_RESET_PLL, HDMI_PHY_CTRL);
+	else
+		writel(val & (~SW_RESET_PLL), HDMI_PHY_CTRL);
+
+	if (phy_reset_polarity == 0)
+		writel(val & (~SW_RESET), HDMI_PHY_CTRL);
+	else
+		writel(val | SW_RESET, HDMI_PHY_CTRL);
+
+	if (pll_reset_polarity == 0)
+		writel(val & (~SW_RESET_PLL), HDMI_PHY_CTRL);
+	else
+		writel(val | SW_RESET_PLL, HDMI_PHY_CTRL);
+}
+
+static uint32_t hdmi_poll_status(void)
+{
+	uint32_t ready_poll;
+	uint32_t time_out_loop;
+	uint32_t time_out_max = HDMI_PLL_POLL_MAX_READS;
+
+	/* Poll for C_READY and PHY READY */
+	dprintf(SPEW, "%s: Waiting for PHY Ready\n", __func__);
+	time_out_loop = 0;
+	do {
+		if (time_out_loop)
+			udelay(HDMI_PLL_POLL_TIMEOUT_US);
+
+		ready_poll = readl(HDMI_PLL_BASE + QSERDES_COM_RESET_SM);
+		time_out_loop++;
+	} while (!(ready_poll & BIT(6)) &&
+		(time_out_loop < time_out_max));
+
+	if (time_out_loop >= time_out_max) {
+		dprintf(CRITICAL, "%s: C READY TIMEOUT\n", __func__);
+		return ERROR;
+	} else {
+		dprintf(SPEW, "%s: C READY\n", __func__);
+	}
+
+	/* Poll for PHY READY */
+	dprintf(SPEW, "%s: Waiting for PHY Ready\n", __func__);
+	time_out_loop = 0;
+	do {
+		udelay(HDMI_PLL_POLL_TIMEOUT_US);
+
+		ready_poll = readl(HDMI_PHY_BASE + HDMI_PHY_STATUS);
+		time_out_loop++;
+	} while (!(ready_poll & BIT(0)) && (time_out_loop < time_out_max));
+
+	if (time_out_loop >= time_out_max) {
+		dprintf(CRITICAL, "%s: PHY READY TIMEOUT\n", __func__);
+		return ERROR;
+	} else {
+		udelay(100);
+		dprintf(SPEW, "%s: HDMI PHY READY\n", __func__);
+	}
+
+	return NO_ERROR;
+}
+
+uint32_t hdmi_pll_config(void)
+{
+	uint32_t tmds_clk_rate = 148500000;
+	uint32_t clk_index;
+
+	/* Find clock target for reset sequence */
+	for (clk_index = 0; clk_index < HDMI_PHY_CLK_SIZE; clk_index++) {
+		if ((clk_tbl[clk_index] >= (tmds_clk_rate - 2000)) &&
+                        (clk_tbl[clk_index] <= (tmds_clk_rate + 2000))) {
+			dprintf(SPEW, "%s: found clk %d\n", __func__,
+				tmds_clk_rate);
+			break;
+		}
+	}
+
+	if (clk_index >= HDMI_PHY_CLK_SIZE) {
+		dprintf(CRITICAL, "%s: pixel clock %d not valid\n",
+			__func__, tmds_clk_rate);
+		return ERROR;
+	}
+
+	/* Initially shut down PHY */
+	dprintf(SPEW, "%s: Disabling PHY\n", __func__);
+	writel(0x0, HDMI_PHY_BASE + HDMI_PHY_PD_CTL);
+	udelay(100);
+
+	/* power-up and recommended common block settings */
+	writel(0x1F, HDMI_PHY_BASE + HDMI_PHY_PD_CTL);
+	writel(0x01, HDMI_PHY_BASE + HDMI_PHY_CFG);
+	udelay(100);
+
+	writel(0x07, HDMI_PHY_BASE + HDMI_PHY_CFG);
+	udelay(100);
+
+	writel(0x05, HDMI_PHY_BASE + HDMI_PHY_CFG);
+	udelay(100);
+
+	writel(0x42, HDMI_PLL_BASE + QSERDES_COM_SYS_CLK_CTRL);
+	writel(0x03, HDMI_PLL_BASE + QSERDES_COM_PLL_VCOTAIL_EN);
+	writel(0x00, HDMI_PLL_BASE + QSERDES_COM_CMN_MODE);
+	writel(0x00, HDMI_PLL_BASE + QSERDES_COM_IE_TRIM);
+	writel(0x00, HDMI_PLL_BASE + QSERDES_COM_IP_TRIM);
+	writel(0x01, HDMI_PLL_BASE + QSERDES_COM_PLL_CNTRL);
+	writel(0x04, HDMI_PLL_BASE + QSERDES_COM_PLL_PHSEL_CONTROL);
+	writel(tmds_clk_rate > 148500000 ? 0x80 : 0xC0,
+		HDMI_PLL_BASE + QSERDES_COM_IPTAT_TRIM_VCCA_TX_SEL);
+	writel(0x00, HDMI_PLL_BASE + QSERDES_COM_PLL_PHSEL_DC);
+	writel(0x00, HDMI_PLL_BASE + QSERDES_COM_CORE_CLK_IN_SYNC_SEL);
+
+	writel(0x00, HDMI_PLL_BASE + QSERDES_COM_PLL_BKG_KVCO_CAL_EN);
+
+	writel(0x0F, HDMI_PLL_BASE + QSERDES_COM_BIAS_EN_CLKBUFLR_EN);
+	writel(0x00, HDMI_PLL_BASE + QSERDES_COM_ATB_SEL1);
+	writel(0x00, HDMI_PLL_BASE + QSERDES_COM_ATB_SEL2);
+
+	writel(clk_settings[CALC_QSERDES_COM_SYSCLK_EN_SEL_TXBAND][clk_index],
+		HDMI_PLL_BASE + QSERDES_COM_SYSCLK_EN_SEL_TXBAND);
+
+	writel(0x30, HDMI_PLL_BASE + QSERDES_COM_KVCO_CODE);
+	writel(0x0F, HDMI_PLL_BASE + QSERDES_COM_BGTC);
+
+	writel(0x00, HDMI_PLL_BASE + QSERDES_COM_PLL_TEST_UPDN);
+	writel(0x00, HDMI_PLL_BASE + QSERDES_COM_PLL_VCO_TUNE);
+	writel(0x00, HDMI_PLL_BASE + QSERDES_COM_PLL_AMP_OS);
+	writel(0x00, HDMI_PLL_BASE + QSERDES_COM_SSC_EN_CENTER);
+	writel(0x00, HDMI_PLL_BASE + QSERDES_COM_RES_CODE_UP);
+	writel(0x00, HDMI_PLL_BASE + QSERDES_COM_RES_CODE_DN);
+
+	writel(0x77, HDMI_PLL_BASE + QSERDES_COM_RES_CODE_CAL_CSR);
+	writel(0x00, HDMI_PLL_BASE + QSERDES_COM_RES_TRIM_EN_VCOCALDONE);
+	writel(0x00, HDMI_PLL_BASE + QSERDES_COM_FAUX_EN);
+	writel(0x0E, HDMI_PLL_BASE + QSERDES_COM_PLL_RXTXEPCLK_EN);
+
+	/* PLL loop bandwidth */
+	writel(0x01, HDMI_PLL_BASE + QSERDES_COM_PLL_IP_SETI);
+	writel(0x3F, HDMI_PLL_BASE + QSERDES_COM_PLL_CP_SETI);
+	writel(0x06, HDMI_PLL_BASE + QSERDES_COM_PLL_IP_SETP);
+	writel(0x1F, HDMI_PLL_BASE + QSERDES_COM_PLL_CP_SETP);
+	writel(0xBB, HDMI_PLL_BASE + QSERDES_COM_PLL_CRCTRL);
+
+	/* PLL calibration */
+	writel(clk_settings[CALC_QSERDES_COM_DIV_FRAC_START1][clk_index],
+		HDMI_PLL_BASE + QSERDES_COM_DIV_FRAC_START1);
+	writel(clk_settings[CALC_QSERDES_COM_DIV_FRAC_START2][clk_index],
+		HDMI_PLL_BASE + QSERDES_COM_DIV_FRAC_START2);
+	writel(clk_settings[CALC_QSERDES_COM_DIV_FRAC_START3][clk_index],
+		HDMI_PLL_BASE + QSERDES_COM_DIV_FRAC_START3);
+	writel(clk_settings[CALC_QSERDES_COM_DEC_START1][clk_index],
+		HDMI_PLL_BASE + QSERDES_COM_DEC_START1);
+	writel(clk_settings[CALC_QSERDES_COM_DEC_START2][clk_index],
+		HDMI_PLL_BASE + QSERDES_COM_DEC_START2);
+	writel(clk_settings[CALC_QSERDES_COM_PLLLOCK_CMP1][clk_index],
+		HDMI_PLL_BASE + QSERDES_COM_PLLLOCK_CMP1);
+	writel(clk_settings[CALC_QSERDES_COM_PLLLOCK_CMP2][clk_index],
+		HDMI_PLL_BASE + QSERDES_COM_PLLLOCK_CMP2);
+	writel(clk_settings[CALC_QSERDES_COM_PLLLOCK_CMP3][clk_index],
+		HDMI_PLL_BASE + QSERDES_COM_PLLLOCK_CMP3);
+	writel(0x01, HDMI_PLL_BASE + QSERDES_COM_PLLLOCK_CMP_EN);
+
+	/* Resistor calibration linear search */
+	writel(0x60, HDMI_PLL_BASE + QSERDES_COM_RES_CODE_START_SEG1);
+	writel(0x60, HDMI_PLL_BASE + QSERDES_COM_RES_CODE_START_SEG2);
+	writel(0x01, HDMI_PLL_BASE + QSERDES_COM_RES_TRIM_CONTROL);
+
+	/* Reset state machine control */
+	writel(0x80, HDMI_PLL_BASE + QSERDES_COM_RESETSM_CNTRL);
+	writel(0x07, HDMI_PLL_BASE + QSERDES_COM_RESETSM_CNTRL2);
+	udelay(100);
+
+	/* TX lanes (transceivers) power-up sequence */
+	writel(clk_settings[CALC_HDMI_PHY_MODE][clk_index],
+		HDMI_PHY_BASE + HDMI_PHY_MODE);
+
+	writel(0x03, HDMI_PLL_BASE + 0x400 + QSERDES_TX_L0_CLKBUF_ENABLE);
+	writel(0x03, HDMI_PLL_BASE + 0x600 + QSERDES_TX_L1_CLKBUF_ENABLE);
+	writel(0x03, HDMI_PLL_BASE + 0x800 + QSERDES_TX_L2_CLKBUF_ENABLE);
+	writel(0x03, HDMI_PLL_BASE + 0xA00 + QSERDES_TX_L3_CLKBUF_ENABLE);
+
+	writel(0x03, HDMI_PLL_BASE + 0x400 + QSERDES_TX_L0_TRAN_DRVR_EMP_EN);
+	writel(0x03, HDMI_PLL_BASE + 0x600 + QSERDES_TX_L1_TRAN_DRVR_EMP_EN);
+	writel(0x03, HDMI_PLL_BASE + 0x800 + QSERDES_TX_L2_TRAN_DRVR_EMP_EN);
+	writel(0x03, HDMI_PLL_BASE + 0xA00 + QSERDES_TX_L3_TRAN_DRVR_EMP_EN);
+
+	writel(0x6F, HDMI_PLL_BASE + 0x400 +
+		QSERDES_TX_L0_HIGHZ_TRANSCEIVEREN_BIAS_DRVR_EN);
+	writel(0x6F, HDMI_PLL_BASE + 0x600 +
+		QSERDES_TX_L1_HIGHZ_TRANSCEIVEREN_BIAS_DRVR_EN);
+	writel(0x6F, HDMI_PLL_BASE + 0x800 +
+		QSERDES_TX_L2_HIGHZ_TRANSCEIVEREN_BIAS_DRVR_EN);
+	writel(0x6F, HDMI_PLL_BASE + 0xA00 +
+		QSERDES_TX_L3_HIGHZ_TRANSCEIVEREN_BIAS_DRVR_EN);
+
+	writel(tmds_clk_rate >= 74000000 ? 0x2F : 0x21,
+		HDMI_PLL_BASE + 0x400 + QSERDES_TX_L0_TX_EMP_POST1_LVL);
+	writel(tmds_clk_rate >= 74000000 ? 0xAF : 0xA1,
+		HDMI_PHY_BASE + HDMI_PHY_TXCAL_CFG0);
+
+	writel(tmds_clk_rate >= 74000000 ? 0x0C : 0x04,
+		HDMI_PLL_BASE + 0x400 + QSERDES_TX_L0_VMODE_CTRL1);
+	writel(tmds_clk_rate >= 74000000 ? 0x0D : 0x05,
+		HDMI_PLL_BASE + 0x800 + QSERDES_TX_L2_VMODE_CTRL1);
+	writel(tmds_clk_rate >= 74000000 ? 0x1F : 0x11,
+		HDMI_PLL_BASE + 0x400 + QSERDES_TX_L0_TX_DRV_LVL);
+	writel(tmds_clk_rate >= 74000000 ? 0x1F : 0x11,
+		HDMI_PLL_BASE + 0x800 + QSERDES_TX_L2_TX_DRV_LVL);
+	writel(0x80, HDMI_PLL_BASE + 0x400 + QSERDES_TX_L0_VMODE_CTRL2);
+	writel(0x00, HDMI_PLL_BASE + 0x800 + QSERDES_TX_L2_VMODE_CTRL2);
+	writel(tmds_clk_rate >= 74000000 ? 0x01 : 0x02,
+		HDMI_PLL_BASE + 0x400 + QSERDES_TX_L0_VMODE_CTRL3);
+	writel(tmds_clk_rate >= 74000000 ? 0x00 : 0x02,
+		HDMI_PLL_BASE + 0x800 + QSERDES_TX_L2_VMODE_CTRL3);
+	writel(tmds_clk_rate >= 74000000 ? 0x00 : 0xA0,
+		HDMI_PLL_BASE + 0x400 + QSERDES_TX_L0_VMODE_CTRL5);
+	writel(tmds_clk_rate >= 74000000 ? 0x00 : 0xA0,
+		HDMI_PLL_BASE + 0x800 + QSERDES_TX_L2_VMODE_CTRL5);
+	writel(0x00, HDMI_PLL_BASE + 0x400 + QSERDES_TX_L0_VMODE_CTRL6);
+	writel(0x00, HDMI_PLL_BASE + 0x800 + QSERDES_TX_L2_VMODE_CTRL6);
+
+	writel(0x40, HDMI_PLL_BASE + 0x400 +
+		QSERDES_TX_L0_PARRATE_REC_DETECT_IDLE_EN);
+	writel(0x00, HDMI_PLL_BASE + 0x400 +
+		QSERDES_TX_L0_TX_INTERFACE_MODE);
+	writel(0x40, HDMI_PLL_BASE + 0x600 +
+		QSERDES_TX_L1_PARRATE_REC_DETECT_IDLE_EN);
+	writel(0x00, HDMI_PLL_BASE + 0x600 +
+		QSERDES_TX_L1_TX_INTERFACE_MODE);
+	writel(0x40, HDMI_PLL_BASE + 0x800 +
+		QSERDES_TX_L2_PARRATE_REC_DETECT_IDLE_EN);
+	writel(0x00, HDMI_PLL_BASE + 0x800 +
+		QSERDES_TX_L2_TX_INTERFACE_MODE);
+	writel(0x40, HDMI_PLL_BASE + 0xA00 +
+		QSERDES_TX_L3_PARRATE_REC_DETECT_IDLE_EN);
+	writel(0x00, HDMI_PLL_BASE + 0xA00 +
+		QSERDES_TX_L3_TX_INTERFACE_MODE);
+
+	return NO_ERROR;
+}
+
+int hdmi_vco_enable(void)
+{
+	int rc;
+
+	writel(0x01, HDMI_PHY_BASE + HDMI_PHY_CFG);
+	udelay(100);
+
+	writel(0x03, HDMI_PHY_BASE + HDMI_PHY_CFG);
+	udelay(100);
+
+	writel(0x09, HDMI_PHY_BASE + HDMI_PHY_CFG);
+	udelay(100);
+
+	rc = hdmi_poll_status();
+
+	writel(0x08, HDMI_PHY_BASE + HDMI_PHY_CFG);
+	udelay(100);
+
+	writel(0x09, HDMI_PHY_BASE + HDMI_PHY_CFG);
+	udelay(100);
+
+	return rc;
+}
+
+void hdmi_vco_disable(void)
+{
+	writel(0x0, HDMI_PHY_BASE + HDMI_PHY_PD_CTL);
+	udelay(100);
+}