drivers/phy/qualcomm/phy-qcom-qmp-combo.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /*
   3  * Copyright (c) 2017, The Linux Foundation. All rights reserved.
   4  */
   5
   6 #include <linux/clk.h>
   7 #include <linux/clk-provider.h>
   8 #include <linux/delay.h>
   9 #include <linux/err.h>
  10 #include <linux/io.h>
  11 #include <linux/iopoll.h>
  12 #include <linux/kernel.h>
  13 #include <linux/module.h>
  14 #include <linux/of.h>
  15 #include <linux/of_address.h>
  16 #include <linux/phy/phy.h>
  17 #include <linux/platform_device.h>
  18 #include <linux/regulator/consumer.h>
  19 #include <linux/reset.h>
  20 #include <linux/slab.h>
  21 #include <linux/usb/typec.h>
  22 #include <linux/usb/typec_mux.h>
  23
  24 #include <drm/drm_bridge.h>
  25
  26 #include <dt-bindings/phy/phy-qcom-qmp.h>
  27
  28 #include "phy-qcom-qmp.h"
  29 #include "phy-qcom-qmp-pcs-misc-v3.h"
  30 #include "phy-qcom-qmp-pcs-usb-v4.h"
  31 #include "phy-qcom-qmp-pcs-usb-v5.h"
  32 #include "phy-qcom-qmp-pcs-usb-v6.h"
  33
  34 /* QPHY_SW_RESET bit */
  35 #define SW_RESET                                BIT(0)
  36 /* QPHY_POWER_DOWN_CONTROL */
  37 #define SW_PWRDN                                BIT(0)
  38 /* QPHY_START_CONTROL bits */
  39 #define SERDES_START                            BIT(0)
  40 #define PCS_START                               BIT(1)
  41 /* QPHY_PCS_STATUS bit */
  42 #define PHYSTATUS                               BIT(6)
  43
  44 /* QPHY_V3_DP_COM_RESET_OVRD_CTRL register bits */
  45 /* DP PHY soft reset */
  46 #define SW_DPPHY_RESET                          BIT(0)
  47 /* mux to select DP PHY reset control, 0:HW control, 1: software reset */
  48 #define SW_DPPHY_RESET_MUX                      BIT(1)
  49 /* USB3 PHY soft reset */
  50 #define SW_USB3PHY_RESET                        BIT(2)
  51 /* mux to select USB3 PHY reset control, 0:HW control, 1: software reset */
  52 #define SW_USB3PHY_RESET_MUX                    BIT(3)
  53
  54 /* QPHY_V3_DP_COM_PHY_MODE_CTRL register bits */
  55 #define USB3_MODE                               BIT(0) /* enables USB3 mode */
  56 #define DP_MODE                                 BIT(1) /* enables DP mode */
  57
  58 /* QPHY_PCS_AUTONOMOUS_MODE_CTRL register bits */
  59 #define ARCVR_DTCT_EN                           BIT(0)
  60 #define ALFPS_DTCT_EN                           BIT(1)
  61 #define ARCVR_DTCT_EVENT_SEL                    BIT(4)
  62
  63 /* QPHY_PCS_LFPS_RXTERM_IRQ_CLEAR register bits */
  64 #define IRQ_CLEAR                               BIT(0)
  65
  66 /* QPHY_V3_PCS_MISC_CLAMP_ENABLE register bits */
  67 #define CLAMP_EN                                BIT(0) /* enables i/o clamp_n */
  68
  69 /* QPHY_V3_DP_COM_TYPEC_CTRL register bits */
  70 #define SW_PORTSELECT_VAL                       BIT(0)
  71 #define SW_PORTSELECT_MUX                       BIT(1)
  72
  73 #define PHY_INIT_COMPLETE_TIMEOUT               10000
  74
  75 struct qmp_phy_init_tbl {
  76         unsigned int offset;
  77         unsigned int val;
  78         /*
  79          * mask of lanes for which this register is written
  80          * for cases when second lane needs different values
  81          */
  82         u8 lane_mask;
  83 };
  84
  85 #define QMP_PHY_INIT_CFG(o, v)          \
  86         {                               \
  87                 .offset = o,            \
  88                 .val = v,               \
  89                 .lane_mask = 0xff,      \
  90         }
  91
  92 #define QMP_PHY_INIT_CFG_LANE(o, v, l)  \
  93         {                               \
  94                 .offset = o,            \
  95                 .val = v,               \
  96                 .lane_mask = l,         \
  97         }
  98
  99 /* set of registers with offsets different per-PHY */
 100 enum qphy_reg_layout {
 101         /* PCS registers */
 102         QPHY_SW_RESET,
 103         QPHY_START_CTRL,
 104         QPHY_PCS_STATUS,
 105         QPHY_PCS_AUTONOMOUS_MODE_CTRL,
 106         QPHY_PCS_LFPS_RXTERM_IRQ_CLEAR,
 107         QPHY_PCS_POWER_DOWN_CONTROL,
 108
 109         QPHY_COM_RESETSM_CNTRL,
 110         QPHY_COM_C_READY_STATUS,
 111         QPHY_COM_CMN_STATUS,
 112         QPHY_COM_BIAS_EN_CLKBUFLR_EN,
 113
 114         QPHY_DP_PHY_STATUS,
 115
 116         QPHY_TX_TX_POL_INV,
 117         QPHY_TX_TX_DRV_LVL,
 118         QPHY_TX_TX_EMP_POST1_LVL,
 119         QPHY_TX_HIGHZ_DRVR_EN,
 120         QPHY_TX_TRANSCEIVER_BIAS_EN,
 121
 122         /* Keep last to ensure regs_layout arrays are properly initialized */
 123         QPHY_LAYOUT_SIZE
 124 };
 125
 126 static const unsigned int qmp_v3_usb3phy_regs_layout[QPHY_LAYOUT_SIZE] = {
 127         [QPHY_SW_RESET]                 = QPHY_V3_PCS_SW_RESET,
 128         [QPHY_START_CTRL]               = QPHY_V3_PCS_START_CONTROL,
 129         [QPHY_PCS_STATUS]               = QPHY_V3_PCS_PCS_STATUS,
 130         [QPHY_PCS_POWER_DOWN_CONTROL]   = QPHY_V3_PCS_POWER_DOWN_CONTROL,
 131         [QPHY_PCS_AUTONOMOUS_MODE_CTRL] = QPHY_V3_PCS_AUTONOMOUS_MODE_CTRL,
 132         [QPHY_PCS_LFPS_RXTERM_IRQ_CLEAR] = QPHY_V3_PCS_LFPS_RXTERM_IRQ_CLEAR,
 133
 134         [QPHY_COM_RESETSM_CNTRL]        = QSERDES_V3_COM_RESETSM_CNTRL,
 135         [QPHY_COM_C_READY_STATUS]       = QSERDES_V3_COM_C_READY_STATUS,
 136         [QPHY_COM_CMN_STATUS]           = QSERDES_V3_COM_CMN_STATUS,
 137         [QPHY_COM_BIAS_EN_CLKBUFLR_EN]  = QSERDES_V3_COM_BIAS_EN_CLKBUFLR_EN,
 138
 139         [QPHY_DP_PHY_STATUS]            = QSERDES_V3_DP_PHY_STATUS,
 140
 141         [QPHY_TX_TX_POL_INV]            = QSERDES_V3_TX_TX_POL_INV,
 142         [QPHY_TX_TX_DRV_LVL]            = QSERDES_V3_TX_TX_DRV_LVL,
 143         [QPHY_TX_TX_EMP_POST1_LVL]      = QSERDES_V3_TX_TX_EMP_POST1_LVL,
 144         [QPHY_TX_HIGHZ_DRVR_EN]         = QSERDES_V3_TX_HIGHZ_DRVR_EN,
 145         [QPHY_TX_TRANSCEIVER_BIAS_EN]   = QSERDES_V3_TX_TRANSCEIVER_BIAS_EN,
 146 };
 147
 148 static const unsigned int qmp_v45_usb3phy_regs_layout[QPHY_LAYOUT_SIZE] = {
 149         [QPHY_SW_RESET]                 = QPHY_V4_PCS_SW_RESET,
 150         [QPHY_START_CTRL]               = QPHY_V4_PCS_START_CONTROL,
 151         [QPHY_PCS_STATUS]               = QPHY_V4_PCS_PCS_STATUS1,
 152         [QPHY_PCS_POWER_DOWN_CONTROL]   = QPHY_V4_PCS_POWER_DOWN_CONTROL,
 153
 154         /* In PCS_USB */
 155         [QPHY_PCS_AUTONOMOUS_MODE_CTRL] = QPHY_V4_PCS_USB3_AUTONOMOUS_MODE_CTRL,
 156         [QPHY_PCS_LFPS_RXTERM_IRQ_CLEAR] = QPHY_V4_PCS_USB3_LFPS_RXTERM_IRQ_CLEAR,
 157
 158         [QPHY_COM_RESETSM_CNTRL]        = QSERDES_V4_COM_RESETSM_CNTRL,
 159         [QPHY_COM_C_READY_STATUS]       = QSERDES_V4_COM_C_READY_STATUS,
 160         [QPHY_COM_CMN_STATUS]           = QSERDES_V4_COM_CMN_STATUS,
 161         [QPHY_COM_BIAS_EN_CLKBUFLR_EN]  = QSERDES_V4_COM_BIAS_EN_CLKBUFLR_EN,
 162
 163         [QPHY_DP_PHY_STATUS]            = QSERDES_V4_DP_PHY_STATUS,
 164
 165         [QPHY_TX_TX_POL_INV]            = QSERDES_V4_TX_TX_POL_INV,
 166         [QPHY_TX_TX_DRV_LVL]            = QSERDES_V4_TX_TX_DRV_LVL,
 167         [QPHY_TX_TX_EMP_POST1_LVL]      = QSERDES_V4_TX_TX_EMP_POST1_LVL,
 168         [QPHY_TX_HIGHZ_DRVR_EN]         = QSERDES_V4_TX_HIGHZ_DRVR_EN,
 169         [QPHY_TX_TRANSCEIVER_BIAS_EN]   = QSERDES_V4_TX_TRANSCEIVER_BIAS_EN,
 170 };
 171
 172 static const unsigned int qmp_v5_5nm_usb3phy_regs_layout[QPHY_LAYOUT_SIZE] = {
 173         [QPHY_SW_RESET]                 = QPHY_V5_PCS_SW_RESET,
 174         [QPHY_START_CTRL]               = QPHY_V5_PCS_START_CONTROL,
 175         [QPHY_PCS_STATUS]               = QPHY_V5_PCS_PCS_STATUS1,
 176         [QPHY_PCS_POWER_DOWN_CONTROL]   = QPHY_V5_PCS_POWER_DOWN_CONTROL,
 177
 178         /* In PCS_USB */
 179         [QPHY_PCS_AUTONOMOUS_MODE_CTRL] = QPHY_V5_PCS_USB3_AUTONOMOUS_MODE_CTRL,
 180         [QPHY_PCS_LFPS_RXTERM_IRQ_CLEAR] = QPHY_V5_PCS_USB3_LFPS_RXTERM_IRQ_CLEAR,
 181
 182         [QPHY_COM_RESETSM_CNTRL]        = QSERDES_V5_COM_RESETSM_CNTRL,
 183         [QPHY_COM_C_READY_STATUS]       = QSERDES_V5_COM_C_READY_STATUS,
 184         [QPHY_COM_CMN_STATUS]           = QSERDES_V5_COM_CMN_STATUS,
 185         [QPHY_COM_BIAS_EN_CLKBUFLR_EN]  = QSERDES_V5_COM_BIAS_EN_CLKBUFLR_EN,
 186
 187         [QPHY_DP_PHY_STATUS]            = QSERDES_V5_DP_PHY_STATUS,
 188
 189         [QPHY_TX_TX_POL_INV]            = QSERDES_V5_5NM_TX_TX_POL_INV,
 190         [QPHY_TX_TX_DRV_LVL]            = QSERDES_V5_5NM_TX_TX_DRV_LVL,
 191         [QPHY_TX_TX_EMP_POST1_LVL]      = QSERDES_V5_5NM_TX_TX_EMP_POST1_LVL,
 192         [QPHY_TX_HIGHZ_DRVR_EN]         = QSERDES_V5_5NM_TX_HIGHZ_DRVR_EN,
 193         [QPHY_TX_TRANSCEIVER_BIAS_EN]   = QSERDES_V5_5NM_TX_TRANSCEIVER_BIAS_EN,
 194 };
 195
 196 static const unsigned int qmp_v6_usb3phy_regs_layout[QPHY_LAYOUT_SIZE] = {
 197         [QPHY_SW_RESET]                 = QPHY_V6_PCS_SW_RESET,
 198         [QPHY_START_CTRL]               = QPHY_V6_PCS_START_CONTROL,
 199         [QPHY_PCS_STATUS]               = QPHY_V6_PCS_PCS_STATUS1,
 200         [QPHY_PCS_POWER_DOWN_CONTROL]   = QPHY_V6_PCS_POWER_DOWN_CONTROL,
 201
 202         /* In PCS_USB */
 203         [QPHY_PCS_AUTONOMOUS_MODE_CTRL] = QPHY_V6_PCS_USB3_AUTONOMOUS_MODE_CTRL,
 204         [QPHY_PCS_LFPS_RXTERM_IRQ_CLEAR] = QPHY_V6_PCS_USB3_LFPS_RXTERM_IRQ_CLEAR,
 205
 206         [QPHY_COM_RESETSM_CNTRL]        = QSERDES_V6_COM_RESETSM_CNTRL,
 207         [QPHY_COM_C_READY_STATUS]       = QSERDES_V6_COM_C_READY_STATUS,
 208         [QPHY_COM_CMN_STATUS]           = QSERDES_V6_COM_CMN_STATUS,
 209         [QPHY_COM_BIAS_EN_CLKBUFLR_EN]  = QSERDES_V6_COM_PLL_BIAS_EN_CLK_BUFLR_EN,
 210
 211         [QPHY_DP_PHY_STATUS]            = QSERDES_V6_DP_PHY_STATUS,
 212
 213         [QPHY_TX_TX_POL_INV]            = QSERDES_V6_TX_TX_POL_INV,
 214         [QPHY_TX_TX_DRV_LVL]            = QSERDES_V6_TX_TX_DRV_LVL,
 215         [QPHY_TX_TX_EMP_POST1_LVL]      = QSERDES_V6_TX_TX_EMP_POST1_LVL,
 216         [QPHY_TX_HIGHZ_DRVR_EN]         = QSERDES_V6_TX_HIGHZ_DRVR_EN,
 217         [QPHY_TX_TRANSCEIVER_BIAS_EN]   = QSERDES_V6_TX_TRANSCEIVER_BIAS_EN,
 218 };
 219
 220 static const struct qmp_phy_init_tbl qmp_v3_usb3_serdes_tbl[] = {
 221         QMP_PHY_INIT_CFG(QSERDES_V3_COM_PLL_IVCO, 0x07),
 222         QMP_PHY_INIT_CFG(QSERDES_V3_COM_SYSCLK_EN_SEL, 0x14),
 223         QMP_PHY_INIT_CFG(QSERDES_V3_COM_BIAS_EN_CLKBUFLR_EN, 0x08),
 224         QMP_PHY_INIT_CFG(QSERDES_V3_COM_CLK_SELECT, 0x30),
 225         QMP_PHY_INIT_CFG(QSERDES_V3_COM_SYS_CLK_CTRL, 0x02),
 226         QMP_PHY_INIT_CFG(QSERDES_V3_COM_RESETSM_CNTRL2, 0x08),
 227         QMP_PHY_INIT_CFG(QSERDES_V3_COM_CMN_CONFIG, 0x16),
 228         QMP_PHY_INIT_CFG(QSERDES_V3_COM_SVS_MODE_CLK_SEL, 0x01),
 229         QMP_PHY_INIT_CFG(QSERDES_V3_COM_HSCLK_SEL, 0x80),
 230         QMP_PHY_INIT_CFG(QSERDES_V3_COM_DEC_START_MODE0, 0x82),
 231         QMP_PHY_INIT_CFG(QSERDES_V3_COM_DIV_FRAC_START1_MODE0, 0xab),
 232         QMP_PHY_INIT_CFG(QSERDES_V3_COM_DIV_FRAC_START2_MODE0, 0xea),
 233         QMP_PHY_INIT_CFG(QSERDES_V3_COM_DIV_FRAC_START3_MODE0, 0x02),
 234         QMP_PHY_INIT_CFG(QSERDES_V3_COM_CP_CTRL_MODE0, 0x06),
 235         QMP_PHY_INIT_CFG(QSERDES_V3_COM_PLL_RCTRL_MODE0, 0x16),
 236         QMP_PHY_INIT_CFG(QSERDES_V3_COM_PLL_CCTRL_MODE0, 0x36),
 237         QMP_PHY_INIT_CFG(QSERDES_V3_COM_INTEGLOOP_GAIN1_MODE0, 0x00),
 238         QMP_PHY_INIT_CFG(QSERDES_V3_COM_INTEGLOOP_GAIN0_MODE0, 0x3f),
 239         QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE2_MODE0, 0x01),
 240         QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE1_MODE0, 0xc9),
 241         QMP_PHY_INIT_CFG(QSERDES_V3_COM_CORECLK_DIV_MODE0, 0x0a),
 242         QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP3_MODE0, 0x00),
 243         QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP2_MODE0, 0x34),
 244         QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP1_MODE0, 0x15),
 245         QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP_EN, 0x04),
 246         QMP_PHY_INIT_CFG(QSERDES_V3_COM_CORE_CLK_EN, 0x00),
 247         QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP_CFG, 0x00),
 248         QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE_MAP, 0x00),
 249         QMP_PHY_INIT_CFG(QSERDES_V3_COM_SYSCLK_BUF_ENABLE, 0x0a),
 250         QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_EN_CENTER, 0x01),
 251         QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_PER1, 0x31),
 252         QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_PER2, 0x01),
 253         QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_ADJ_PER1, 0x00),
 254         QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_ADJ_PER2, 0x00),
 255         QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_STEP_SIZE1, 0x85),
 256         QMP_PHY_INIT_CFG(QSERDES_V3_COM_SSC_STEP_SIZE2, 0x07),
 257 };
 258
 259 static const struct qmp_phy_init_tbl qmp_v3_usb3_tx_tbl[] = {
 260         QMP_PHY_INIT_CFG(QSERDES_V3_TX_HIGHZ_DRVR_EN, 0x10),
 261         QMP_PHY_INIT_CFG(QSERDES_V3_TX_RCV_DETECT_LVL_2, 0x12),
 262         QMP_PHY_INIT_CFG(QSERDES_V3_TX_LANE_MODE_1, 0x16),
 263         QMP_PHY_INIT_CFG(QSERDES_V3_TX_RES_CODE_LANE_OFFSET_RX, 0x09),
 264         QMP_PHY_INIT_CFG(QSERDES_V3_TX_RES_CODE_LANE_OFFSET_TX, 0x06),
 265 };
 266
 267 static const struct qmp_phy_init_tbl qmp_v3_dp_serdes_tbl[] = {
 268         QMP_PHY_INIT_CFG(QSERDES_V3_COM_SVS_MODE_CLK_SEL, 0x01),
 269         QMP_PHY_INIT_CFG(QSERDES_V3_COM_SYSCLK_EN_SEL, 0x37),
 270         QMP_PHY_INIT_CFG(QSERDES_V3_COM_SYS_CLK_CTRL, 0x02),
 271         QMP_PHY_INIT_CFG(QSERDES_V3_COM_CLK_ENABLE1, 0x0e),
 272         QMP_PHY_INIT_CFG(QSERDES_V3_COM_SYSCLK_BUF_ENABLE, 0x06),
 273         QMP_PHY_INIT_CFG(QSERDES_V3_COM_CLK_SELECT, 0x30),
 274         QMP_PHY_INIT_CFG(QSERDES_V3_COM_CMN_CONFIG, 0x02),
 275         QMP_PHY_INIT_CFG(QSERDES_V3_COM_DIV_FRAC_START1_MODE0, 0x00),
 276         QMP_PHY_INIT_CFG(QSERDES_V3_COM_INTEGLOOP_GAIN0_MODE0, 0x3f),
 277         QMP_PHY_INIT_CFG(QSERDES_V3_COM_INTEGLOOP_GAIN1_MODE0, 0x00),
 278         QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE_MAP, 0x00),
 279         QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP3_MODE0, 0x00),
 280         QMP_PHY_INIT_CFG(QSERDES_V3_COM_BG_TIMER, 0x0a),
 281         QMP_PHY_INIT_CFG(QSERDES_V3_COM_CORECLK_DIV_MODE0, 0x0a),
 282         QMP_PHY_INIT_CFG(QSERDES_V3_COM_VCO_TUNE_CTRL, 0x00),
 283         QMP_PHY_INIT_CFG(QSERDES_V3_COM_BIAS_EN_CLKBUFLR_EN, 0x3f),
 284         QMP_PHY_INIT_CFG(QSERDES_V3_COM_CORE_CLK_EN, 0x1f),
 285         QMP_PHY_INIT_CFG(QSERDES_V3_COM_PLL_IVCO, 0x07),
 286         QMP_PHY_INIT_CFG(QSERDES_V3_COM_PLL_CCTRL_MODE0, 0x36),
 287         QMP_PHY_INIT_CFG(QSERDES_V3_COM_PLL_RCTRL_MODE0, 0x16),
 288         QMP_PHY_INIT_CFG(QSERDES_V3_COM_CP_CTRL_MODE0, 0x06),
 289 };
 290
 291 static const struct qmp_phy_init_tbl qmp_v3_dp_serdes_tbl_rbr[] = {
 292         QMP_PHY_INIT_CFG(QSERDES_V3_COM_HSCLK_SEL, 0x0c),
 293         QMP_PHY_INIT_CFG(QSERDES_V3_COM_DEC_START_MODE0, 0x69),
 294         QMP_PHY_INIT_CFG(QSERDES_V3_COM_DIV_FRAC_START2_MODE0, 0x80),
 295         QMP_PHY_INIT_CFG(QSERDES_V3_COM_DIV_FRAC_START3_MODE0, 0x07),
 296         QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP1_MODE0, 0x6f),
 297         QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP2_MODE0, 0x08),
 298         QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP_EN, 0x00),
 299 };
 300
 301 static const struct qmp_phy_init_tbl qmp_v3_dp_serdes_tbl_hbr[] = {
 302         QMP_PHY_INIT_CFG(QSERDES_V3_COM_HSCLK_SEL, 0x04),
 303         QMP_PHY_INIT_CFG(QSERDES_V3_COM_DEC_START_MODE0, 0x69),
 304         QMP_PHY_INIT_CFG(QSERDES_V3_COM_DIV_FRAC_START2_MODE0, 0x80),
 305         QMP_PHY_INIT_CFG(QSERDES_V3_COM_DIV_FRAC_START3_MODE0, 0x07),
 306         QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP1_MODE0, 0x0f),
 307         QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP2_MODE0, 0x0e),
 308         QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP_EN, 0x00),
 309 };
 310
 311 static const struct qmp_phy_init_tbl qmp_v3_dp_serdes_tbl_hbr2[] = {
 312         QMP_PHY_INIT_CFG(QSERDES_V3_COM_HSCLK_SEL, 0x00),
 313         QMP_PHY_INIT_CFG(QSERDES_V3_COM_DEC_START_MODE0, 0x8c),
 314         QMP_PHY_INIT_CFG(QSERDES_V3_COM_DIV_FRAC_START2_MODE0, 0x00),
 315         QMP_PHY_INIT_CFG(QSERDES_V3_COM_DIV_FRAC_START3_MODE0, 0x0a),
 316         QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP1_MODE0, 0x1f),
 317         QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP2_MODE0, 0x1c),
 318         QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP_EN, 0x00),
 319 };
 320
 321 static const struct qmp_phy_init_tbl qmp_v3_dp_serdes_tbl_hbr3[] = {
 322         QMP_PHY_INIT_CFG(QSERDES_V3_COM_HSCLK_SEL, 0x03),
 323         QMP_PHY_INIT_CFG(QSERDES_V3_COM_DEC_START_MODE0, 0x69),
 324         QMP_PHY_INIT_CFG(QSERDES_V3_COM_DIV_FRAC_START2_MODE0, 0x80),
 325         QMP_PHY_INIT_CFG(QSERDES_V3_COM_DIV_FRAC_START3_MODE0, 0x07),
 326         QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP1_MODE0, 0x2f),
 327         QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP2_MODE0, 0x2a),
 328         QMP_PHY_INIT_CFG(QSERDES_V3_COM_LOCK_CMP_EN, 0x08),
 329 };
 330
 331 static const struct qmp_phy_init_tbl qmp_v3_dp_tx_tbl[] = {
 332         QMP_PHY_INIT_CFG(QSERDES_V3_TX_TRANSCEIVER_BIAS_EN, 0x1a),
 333         QMP_PHY_INIT_CFG(QSERDES_V3_TX_VMODE_CTRL1, 0x40),
 334         QMP_PHY_INIT_CFG(QSERDES_V3_TX_PRE_STALL_LDO_BOOST_EN, 0x30),
 335         QMP_PHY_INIT_CFG(QSERDES_V3_TX_INTERFACE_SELECT, 0x3d),
 336         QMP_PHY_INIT_CFG(QSERDES_V3_TX_CLKBUF_ENABLE, 0x0f),
 337         QMP_PHY_INIT_CFG(QSERDES_V3_TX_RESET_TSYNC_EN, 0x03),
 338         QMP_PHY_INIT_CFG(QSERDES_V3_TX_TRAN_DRVR_EMP_EN, 0x03),
 339         QMP_PHY_INIT_CFG(QSERDES_V3_TX_PARRATE_REC_DETECT_IDLE_EN, 0x00),
 340         QMP_PHY_INIT_CFG(QSERDES_V3_TX_TX_INTERFACE_MODE, 0x00),
 341         QMP_PHY_INIT_CFG(QSERDES_V3_TX_TX_BAND, 0x4),
 342         QMP_PHY_INIT_CFG(QSERDES_V3_TX_TX_POL_INV, 0x0a),
 343         QMP_PHY_INIT_CFG(QSERDES_V3_TX_TX_DRV_LVL, 0x38),
 344         QMP_PHY_INIT_CFG(QSERDES_V3_TX_TX_EMP_POST1_LVL, 0x20),
 345         QMP_PHY_INIT_CFG(QSERDES_V3_TX_RES_CODE_LANE_OFFSET_TX, 0x06),
 346         QMP_PHY_INIT_CFG(QSERDES_V3_TX_RES_CODE_LANE_OFFSET_RX, 0x07),
 347 };
 348
 349 static const struct qmp_phy_init_tbl qmp_v3_usb3_rx_tbl[] = {
 350         QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_FASTLOCK_FO_GAIN, 0x0b),
 351         QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQU_ADAPTOR_CNTRL2, 0x0f),
 352         QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQU_ADAPTOR_CNTRL3, 0x4e),
 353         QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQU_ADAPTOR_CNTRL4, 0x18),
 354         QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQ_OFFSET_ADAPTOR_CNTRL1, 0x77),
 355         QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_OFFSET_ADAPTOR_CNTRL2, 0x80),
 356         QMP_PHY_INIT_CFG(QSERDES_V3_RX_SIGDET_CNTRL, 0x03),
 357         QMP_PHY_INIT_CFG(QSERDES_V3_RX_SIGDET_DEGLITCH_CNTRL, 0x16),
 358         QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_SO_SATURATION_AND_ENABLE, 0x75),
 359 };
 360
 361 static const struct qmp_phy_init_tbl qmp_v3_usb3_pcs_tbl[] = {
 362         /* FLL settings */
 363         QMP_PHY_INIT_CFG(QPHY_V3_PCS_FLL_CNTRL2, 0x83),
 364         QMP_PHY_INIT_CFG(QPHY_V3_PCS_FLL_CNT_VAL_L, 0x09),
 365         QMP_PHY_INIT_CFG(QPHY_V3_PCS_FLL_CNT_VAL_H_TOL, 0xa2),
 366         QMP_PHY_INIT_CFG(QPHY_V3_PCS_FLL_MAN_CODE, 0x40),
 367         QMP_PHY_INIT_CFG(QPHY_V3_PCS_FLL_CNTRL1, 0x02),
 368
 369         /* Lock Det settings */
 370         QMP_PHY_INIT_CFG(QPHY_V3_PCS_LOCK_DETECT_CONFIG1, 0xd1),
 371         QMP_PHY_INIT_CFG(QPHY_V3_PCS_LOCK_DETECT_CONFIG2, 0x1f),
 372         QMP_PHY_INIT_CFG(QPHY_V3_PCS_LOCK_DETECT_CONFIG3, 0x47),
 373         QMP_PHY_INIT_CFG(QPHY_V3_PCS_POWER_STATE_CONFIG2, 0x1b),
 374
 375         QMP_PHY_INIT_CFG(QPHY_V3_PCS_RX_SIGDET_LVL, 0xba),
 376         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_V0, 0x9f),
 377         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_V1, 0x9f),
 378         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_V2, 0xb7),
 379         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_V3, 0x4e),
 380         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_V4, 0x65),
 381         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_LS, 0x6b),
 382         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M6DB_V0, 0x15),
 383         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_V0, 0x0d),
 384         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M6DB_V1, 0x15),
 385         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_V1, 0x0d),
 386         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M6DB_V2, 0x15),
 387         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_V2, 0x0d),
 388         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M6DB_V3, 0x15),
 389         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_V3, 0x1d),
 390         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M6DB_V4, 0x15),
 391         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_V4, 0x0d),
 392         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M6DB_LS, 0x15),
 393         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_LS, 0x0d),
 394
 395         QMP_PHY_INIT_CFG(QPHY_V3_PCS_RATE_SLEW_CNTRL, 0x02),
 396         QMP_PHY_INIT_CFG(QPHY_V3_PCS_PWRUP_RESET_DLY_TIME_AUXCLK, 0x04),
 397         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TSYNC_RSYNC_TIME, 0x44),
 398         QMP_PHY_INIT_CFG(QPHY_V3_PCS_PWRUP_RESET_DLY_TIME_AUXCLK, 0x04),
 399         QMP_PHY_INIT_CFG(QPHY_V3_PCS_RCVR_DTCT_DLY_P1U2_L, 0xe7),
 400         QMP_PHY_INIT_CFG(QPHY_V3_PCS_RCVR_DTCT_DLY_P1U2_H, 0x03),
 401         QMP_PHY_INIT_CFG(QPHY_V3_PCS_RCVR_DTCT_DLY_U3_L, 0x40),
 402         QMP_PHY_INIT_CFG(QPHY_V3_PCS_RCVR_DTCT_DLY_U3_H, 0x00),
 403         QMP_PHY_INIT_CFG(QPHY_V3_PCS_RXEQTRAINING_WAIT_TIME, 0x75),
 404         QMP_PHY_INIT_CFG(QPHY_V3_PCS_LFPS_TX_ECSTART_EQTLOCK, 0x86),
 405         QMP_PHY_INIT_CFG(QPHY_V3_PCS_RXEQTRAINING_RUN_TIME, 0x13),
 406 };
 407
 408 static const struct qmp_phy_init_tbl sm6350_usb3_rx_tbl[] = {
 409         QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_FASTLOCK_FO_GAIN, 0x0b),
 410         QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQU_ADAPTOR_CNTRL2, 0x0f),
 411         QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQU_ADAPTOR_CNTRL3, 0x4e),
 412         QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQU_ADAPTOR_CNTRL4, 0x18),
 413         QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_EQ_OFFSET_ADAPTOR_CNTRL1, 0x77),
 414         QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_OFFSET_ADAPTOR_CNTRL2, 0x80),
 415         QMP_PHY_INIT_CFG(QSERDES_V3_RX_SIGDET_CNTRL, 0x03),
 416         QMP_PHY_INIT_CFG(QSERDES_V3_RX_SIGDET_DEGLITCH_CNTRL, 0x16),
 417         QMP_PHY_INIT_CFG(QSERDES_V3_RX_RX_MODE_00, 0x05),
 418         QMP_PHY_INIT_CFG(QSERDES_V3_RX_UCDR_SO_SATURATION_AND_ENABLE, 0x75),
 419 };
 420
 421 static const struct qmp_phy_init_tbl sm6350_usb3_pcs_tbl[] = {
 422         /* FLL settings */
 423         QMP_PHY_INIT_CFG(QPHY_V3_PCS_FLL_CNTRL2, 0x83),
 424         QMP_PHY_INIT_CFG(QPHY_V3_PCS_FLL_CNT_VAL_L, 0x09),
 425         QMP_PHY_INIT_CFG(QPHY_V3_PCS_FLL_CNT_VAL_H_TOL, 0xa2),
 426         QMP_PHY_INIT_CFG(QPHY_V3_PCS_FLL_MAN_CODE, 0x40),
 427         QMP_PHY_INIT_CFG(QPHY_V3_PCS_FLL_CNTRL1, 0x02),
 428
 429         /* Lock Det settings */
 430         QMP_PHY_INIT_CFG(QPHY_V3_PCS_LOCK_DETECT_CONFIG1, 0xd1),
 431         QMP_PHY_INIT_CFG(QPHY_V3_PCS_LOCK_DETECT_CONFIG2, 0x1f),
 432         QMP_PHY_INIT_CFG(QPHY_V3_PCS_LOCK_DETECT_CONFIG3, 0x47),
 433         QMP_PHY_INIT_CFG(QPHY_V3_PCS_POWER_STATE_CONFIG2, 0x1b),
 434
 435         QMP_PHY_INIT_CFG(QPHY_V3_PCS_RX_SIGDET_LVL, 0xcc),
 436         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_V0, 0x9f),
 437         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_V1, 0x9f),
 438         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_V2, 0xb7),
 439         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_V3, 0x4e),
 440         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_V4, 0x65),
 441         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXMGN_LS, 0x6b),
 442         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M6DB_V0, 0x15),
 443         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_V0, 0x0d),
 444         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M6DB_V1, 0x15),
 445         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_V1, 0x0d),
 446         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M6DB_V2, 0x15),
 447         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_V2, 0x0d),
 448         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M6DB_V3, 0x15),
 449         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_V3, 0x1d),
 450         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M6DB_V4, 0x15),
 451         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_V4, 0x0d),
 452         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M6DB_LS, 0x15),
 453         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TXDEEMPH_M3P5DB_LS, 0x0d),
 454
 455         QMP_PHY_INIT_CFG(QPHY_V3_PCS_RATE_SLEW_CNTRL, 0x02),
 456         QMP_PHY_INIT_CFG(QPHY_V3_PCS_PWRUP_RESET_DLY_TIME_AUXCLK, 0x04),
 457         QMP_PHY_INIT_CFG(QPHY_V3_PCS_TSYNC_RSYNC_TIME, 0x44),
 458         QMP_PHY_INIT_CFG(QPHY_V3_PCS_PWRUP_RESET_DLY_TIME_AUXCLK, 0x04),
 459         QMP_PHY_INIT_CFG(QPHY_V3_PCS_RCVR_DTCT_DLY_P1U2_L, 0xe7),
 460         QMP_PHY_INIT_CFG(QPHY_V3_PCS_RCVR_DTCT_DLY_P1U2_H, 0x03),
 461         QMP_PHY_INIT_CFG(QPHY_V3_PCS_RCVR_DTCT_DLY_U3_L, 0x40),
 462         QMP_PHY_INIT_CFG(QPHY_V3_PCS_RCVR_DTCT_DLY_U3_H, 0x00),
 463         QMP_PHY_INIT_CFG(QPHY_V3_PCS_RXEQTRAINING_WAIT_TIME, 0x75),
 464         QMP_PHY_INIT_CFG(QPHY_V3_PCS_LFPS_TX_ECSTART_EQTLOCK, 0x86),
 465         QMP_PHY_INIT_CFG(QPHY_V3_PCS_RXEQTRAINING_RUN_TIME, 0x13),
 466         QMP_PHY_INIT_CFG(QPHY_V3_PCS_LFPS_DET_HIGH_COUNT_VAL, 0x04),
 467
 468         QMP_PHY_INIT_CFG(QPHY_V3_PCS_REFGEN_REQ_CONFIG1, 0x21),
 469         QMP_PHY_INIT_CFG(QPHY_V3_PCS_REFGEN_REQ_CONFIG2, 0x60),
 470 };
 471
 472 static const struct qmp_phy_init_tbl sm8150_usb3_serdes_tbl[] = {
 473         QMP_PHY_INIT_CFG(QSERDES_V4_COM_SSC_EN_CENTER, 0x01),
 474         QMP_PHY_INIT_CFG(QSERDES_V4_COM_SSC_PER1, 0x31),
 475         QMP_PHY_INIT_CFG(QSERDES_V4_COM_SSC_PER2, 0x01),
 476         QMP_PHY_INIT_CFG(QSERDES_V4_COM_SSC_STEP_SIZE1_MODE0, 0xde),
 477         QMP_PHY_INIT_CFG(QSERDES_V4_COM_SSC_STEP_SIZE2_MODE0, 0x07),
 478         QMP_PHY_INIT_CFG(QSERDES_V4_COM_SSC_STEP_SIZE1_MODE1, 0xde),
 479         QMP_PHY_INIT_CFG(QSERDES_V4_COM_SSC_STEP_SIZE2_MODE1, 0x07),
 480         QMP_PHY_INIT_CFG(QSERDES_V4_COM_SYSCLK_BUF_ENABLE, 0x0a),
 481         QMP_PHY_INIT_CFG(QSERDES_V4_COM_CMN_IPTRIM, 0x20),
 482         QMP_PHY_INIT_CFG(QSERDES_V4_COM_CP_CTRL_MODE0, 0x06),
 483         QMP_PHY_INIT_CFG(QSERDES_V4_COM_CP_CTRL_MODE1, 0x06),
 484         QMP_PHY_INIT_CFG(QSERDES_V4_COM_PLL_RCTRL_MODE0, 0x16),
 485         QMP_PHY_INIT_CFG(QSERDES_V4_COM_PLL_RCTRL_MODE1, 0x16),
 486         QMP_PHY_INIT_CFG(QSERDES_V4_COM_PLL_CCTRL_MODE0, 0x36),
 487         QMP_PHY_INIT_CFG(QSERDES_V4_COM_PLL_CCTRL_MODE1, 0x36),
 488         QMP_PHY_INIT_CFG(QSERDES_V4_COM_SYSCLK_EN_SEL, 0x1a),
 489         QMP_PHY_INIT_CFG(QSERDES_V4_COM_LOCK_CMP_EN, 0x04),
 490         QMP_PHY_INIT_CFG(QSERDES_V4_COM_LOCK_CMP1_MODE0, 0x14),
 491         QMP_PHY_INIT_CFG(QSERDES_V4_COM_LOCK_CMP2_MODE0, 0x34),
 492         QMP_PHY_INIT_CFG(QSERDES_V4_COM_LOCK_CMP1_MODE1, 0x34),
 493         QMP_PHY_INIT_CFG(QSERDES_V4_COM_LOCK_CMP2_MODE1, 0x82),
 494         QMP_PHY_INIT_CFG(QSERDES_V4_COM_DEC_START_MODE0, 0x82),
 495         QMP_PHY_INIT_CFG(QSERDES_V4_COM_DEC_START_MODE1, 0x82),
 496         QMP_PHY_INIT_CFG(QSERDES_V4_COM_DIV_FRAC_START1_MODE0, 0xab),
 497         QMP_PHY_INIT_CFG(QSERDES_V4_COM_DIV_FRAC_START2_MODE0, 0xea),
 498         QMP_PHY_INIT_CFG(QSERDES_V4_COM_DIV_FRAC_START3_MODE0, 0x02),
 499         QMP_PHY_INIT_CFG(QSERDES_V4_COM_VCO_TUNE_MAP, 0x02),
 500         QMP_PHY_INIT_CFG(QSERDES_V4_COM_DIV_FRAC_START1_MODE1, 0xab),
 501         QMP_PHY_INIT_CFG(QSERDES_V4_COM_DIV_FRAC_START2_MODE1, 0xea),
 502         QMP_PHY_INIT_CFG(QSERDES_V4_COM_DIV_FRAC_START3_MODE1, 0x02),
 503         QMP_PHY_INIT_CFG(QSERDES_V4_COM_VCO_TUNE1_MODE0, 0x24),
 504         QMP_PHY_INIT_CFG(QSERDES_V4_COM_VCO_TUNE1_MODE1, 0x24),
 505         QMP_PHY_INIT_CFG(QSERDES_V4_COM_VCO_TUNE2_MODE1, 0x02),
 506         QMP_PHY_INIT_CFG(QSERDES_V4_COM_HSCLK_SEL, 0x01),
 507         QMP_PHY_INIT_CFG(QSERDES_V4_COM_CORECLK_DIV_MODE1, 0x08),
 508         QMP_PHY_INIT_CFG(QSERDES_V4_COM_BIN_VCOCAL_CMP_CODE1_MODE0, 0xca),
 509         QMP_PHY_INIT_CFG(QSERDES_V4_COM_BIN_VCOCAL_CMP_CODE2_MODE0, 0x1e),
 510         QMP_PHY_INIT_CFG(QSERDES_V4_COM_BIN_VCOCAL_CMP_CODE1_MODE1, 0xca),
 511         QMP_PHY_INIT_CFG(QSERDES_V4_COM_BIN_VCOCAL_CMP_CODE2_MODE1, 0x1e),
 512         QMP_PHY_INIT_CFG(QSERDES_V4_COM_BIN_VCOCAL_HSCLK_SEL, 0x11),
 513 };
 514
 515 static const struct qmp_phy_init_tbl sm8150_usb3_tx_tbl[] = {
 516         QMP_PHY_INIT_CFG(QSERDES_V4_TX_RES_CODE_LANE_TX, 0x00),
 517         QMP_PHY_INIT_CFG(QSERDES_V4_TX_RES_CODE_LANE_RX, 0x00),
 518         QMP_PHY_INIT_CFG(QSERDES_V4_TX_LANE_MODE_1, 0xd5),
 519         QMP_PHY_INIT_CFG(QSERDES_V4_TX_RCV_DETECT_LVL_2, 0x12),
 520         QMP_PHY_INIT_CFG(QSERDES_V4_TX_PI_QEC_CTRL, 0x20),
 521 };
 522
 523 static const struct qmp_phy_init_tbl sm8150_usb3_rx_tbl[] = {
 524         QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_SO_GAIN, 0x05),
 525         QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_FASTLOCK_FO_GAIN, 0x2f),
 526         QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_SO_SATURATION_AND_ENABLE, 0x7f),
 527         QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_FASTLOCK_COUNT_LOW, 0xff),
 528         QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_FASTLOCK_COUNT_HIGH, 0x0f),
 529         QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_PI_CONTROLS, 0x99),
 530         QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_SB2_THRESH1, 0x04),
 531         QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_SB2_THRESH2, 0x08),
 532         QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_SB2_GAIN1, 0x05),
 533         QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_SB2_GAIN2, 0x05),
 534         QMP_PHY_INIT_CFG(QSERDES_V4_RX_VGA_CAL_CNTRL1, 0x54),
 535         QMP_PHY_INIT_CFG(QSERDES_V4_RX_VGA_CAL_CNTRL2, 0x0e),
 536         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_EQU_ADAPTOR_CNTRL2, 0x0f),
 537         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_EQU_ADAPTOR_CNTRL3, 0x4a),
 538         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_EQU_ADAPTOR_CNTRL4, 0x0a),
 539         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_IDAC_TSETTLE_LOW, 0xc0),
 540         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_IDAC_TSETTLE_HIGH, 0x00),
 541         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_EQ_OFFSET_ADAPTOR_CNTRL1, 0x77),
 542         QMP_PHY_INIT_CFG(QSERDES_V4_RX_SIGDET_CNTRL, 0x04),
 543         QMP_PHY_INIT_CFG(QSERDES_V4_RX_SIGDET_DEGLITCH_CNTRL, 0x0e),
 544         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_LOW, 0xbf),
 545         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_HIGH, 0xbf),
 546         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_HIGH2, 0x3f),
 547         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_HIGH3, 0x7f),
 548         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_HIGH4, 0x94),
 549         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_LOW, 0xdc),
 550         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_HIGH, 0xdc),
 551         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_HIGH2, 0x5c),
 552         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_HIGH3, 0x0b),
 553         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_HIGH4, 0xb3),
 554         QMP_PHY_INIT_CFG(QSERDES_V4_RX_DFE_EN_TIMER, 0x04),
 555         QMP_PHY_INIT_CFG(QSERDES_V4_RX_DFE_CTLE_POST_CAL_OFFSET, 0x38),
 556         QMP_PHY_INIT_CFG(QSERDES_V4_RX_AUX_DATA_TCOARSE_TFINE, 0xa0),
 557         QMP_PHY_INIT_CFG(QSERDES_V4_RX_DCC_CTRL1, 0x0c),
 558         QMP_PHY_INIT_CFG(QSERDES_V4_RX_GM_CAL, 0x1f),
 559         QMP_PHY_INIT_CFG(QSERDES_V4_RX_VTH_CODE, 0x10),
 560 };
 561
 562 static const struct qmp_phy_init_tbl sm8150_usb3_pcs_tbl[] = {
 563         /* Lock Det settings */
 564         QMP_PHY_INIT_CFG(QPHY_V4_PCS_LOCK_DETECT_CONFIG1, 0xd0),
 565         QMP_PHY_INIT_CFG(QPHY_V4_PCS_LOCK_DETECT_CONFIG2, 0x07),
 566         QMP_PHY_INIT_CFG(QPHY_V4_PCS_LOCK_DETECT_CONFIG6, 0x13),
 567
 568         QMP_PHY_INIT_CFG(QPHY_V4_PCS_REFGEN_REQ_CONFIG1, 0x21),
 569         QMP_PHY_INIT_CFG(QPHY_V4_PCS_RX_SIGDET_LVL, 0xaa),
 570         QMP_PHY_INIT_CFG(QPHY_V4_PCS_CDR_RESET_TIME, 0x0a),
 571         QMP_PHY_INIT_CFG(QPHY_V4_PCS_ALIGN_DETECT_CONFIG1, 0x88),
 572         QMP_PHY_INIT_CFG(QPHY_V4_PCS_ALIGN_DETECT_CONFIG2, 0x13),
 573         QMP_PHY_INIT_CFG(QPHY_V4_PCS_PCS_TX_RX_CONFIG, 0x0c),
 574         QMP_PHY_INIT_CFG(QPHY_V4_PCS_EQ_CONFIG1, 0x4b),
 575         QMP_PHY_INIT_CFG(QPHY_V4_PCS_EQ_CONFIG5, 0x10),
 576 };
 577
 578 static const struct qmp_phy_init_tbl sm8150_usb3_pcs_usb_tbl[] = {
 579         QMP_PHY_INIT_CFG(QPHY_V4_PCS_USB3_LFPS_DET_HIGH_COUNT_VAL, 0xf8),
 580         QMP_PHY_INIT_CFG(QPHY_V4_PCS_USB3_RXEQTRAINING_DFE_TIME_S2, 0x07),
 581 };
 582
 583 static const struct qmp_phy_init_tbl sm8250_usb3_tx_tbl[] = {
 584         QMP_PHY_INIT_CFG(QSERDES_V4_TX_RES_CODE_LANE_TX, 0x60),
 585         QMP_PHY_INIT_CFG(QSERDES_V4_TX_RES_CODE_LANE_RX, 0x60),
 586         QMP_PHY_INIT_CFG(QSERDES_V4_TX_RES_CODE_LANE_OFFSET_TX, 0x11),
 587         QMP_PHY_INIT_CFG(QSERDES_V4_TX_RES_CODE_LANE_OFFSET_RX, 0x02),
 588         QMP_PHY_INIT_CFG(QSERDES_V4_TX_LANE_MODE_1, 0xd5),
 589         QMP_PHY_INIT_CFG(QSERDES_V4_TX_RCV_DETECT_LVL_2, 0x12),
 590         QMP_PHY_INIT_CFG_LANE(QSERDES_V4_TX_PI_QEC_CTRL, 0x40, 1),
 591         QMP_PHY_INIT_CFG_LANE(QSERDES_V4_TX_PI_QEC_CTRL, 0x54, 2),
 592 };
 593
 594 static const struct qmp_phy_init_tbl sm8250_usb3_rx_tbl[] = {
 595         QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_SO_GAIN, 0x06),
 596         QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_FASTLOCK_FO_GAIN, 0x2f),
 597         QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_SO_SATURATION_AND_ENABLE, 0x7f),
 598         QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_FASTLOCK_COUNT_LOW, 0xff),
 599         QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_FASTLOCK_COUNT_HIGH, 0x0f),
 600         QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_PI_CONTROLS, 0x99),
 601         QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_SB2_THRESH1, 0x04),
 602         QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_SB2_THRESH2, 0x08),
 603         QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_SB2_GAIN1, 0x05),
 604         QMP_PHY_INIT_CFG(QSERDES_V4_RX_UCDR_SB2_GAIN2, 0x05),
 605         QMP_PHY_INIT_CFG(QSERDES_V4_RX_VGA_CAL_CNTRL1, 0x54),
 606         QMP_PHY_INIT_CFG(QSERDES_V4_RX_VGA_CAL_CNTRL2, 0x0c),
 607         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_EQU_ADAPTOR_CNTRL2, 0x0f),
 608         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_EQU_ADAPTOR_CNTRL3, 0x4a),
 609         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_EQU_ADAPTOR_CNTRL4, 0x0a),
 610         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_IDAC_TSETTLE_LOW, 0xc0),
 611         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_IDAC_TSETTLE_HIGH, 0x00),
 612         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_EQ_OFFSET_ADAPTOR_CNTRL1, 0x77),
 613         QMP_PHY_INIT_CFG(QSERDES_V4_RX_SIGDET_CNTRL, 0x04),
 614         QMP_PHY_INIT_CFG(QSERDES_V4_RX_SIGDET_DEGLITCH_CNTRL, 0x0e),
 615         QMP_PHY_INIT_CFG_LANE(QSERDES_V4_RX_RX_MODE_00_LOW, 0xff, 1),
 616         QMP_PHY_INIT_CFG_LANE(QSERDES_V4_RX_RX_MODE_00_LOW, 0x7f, 2),
 617         QMP_PHY_INIT_CFG_LANE(QSERDES_V4_RX_RX_MODE_00_HIGH, 0x7f, 1),
 618         QMP_PHY_INIT_CFG_LANE(QSERDES_V4_RX_RX_MODE_00_HIGH, 0xff, 2),
 619         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_HIGH2, 0x7f),
 620         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_HIGH3, 0x7f),
 621         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_00_HIGH4, 0x97),
 622         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_LOW, 0xdc),
 623         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_HIGH, 0xdc),
 624         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_HIGH2, 0x5c),
 625         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_HIGH3, 0x7b),
 626         QMP_PHY_INIT_CFG(QSERDES_V4_RX_RX_MODE_01_HIGH4, 0xb4),
 627         QMP_PHY_INIT_CFG(QSERDES_V4_RX_DFE_EN_TIMER, 0x04),
 628         QMP_PHY_INIT_CFG(QSERDES_V4_RX_DFE_CTLE_POST_CAL_OFFSET, 0x38),
 629         QMP_PHY_INIT_CFG(QSERDES_V4_RX_AUX_DATA_TCOARSE_TFINE, 0xa0),
 630         QMP_PHY_INIT_CFG(QSERDES_V4_RX_DCC_CTRL1, 0x0c),
 631         QMP_PHY_INIT_CFG(QSERDES_V4_RX_GM_CAL, 0x1f),
 632         QMP_PHY_INIT_CFG(QSERDES_V4_RX_VTH_CODE, 0x10),
 633 };
 634
 635 static const struct qmp_phy_init_tbl sm8250_usb3_pcs_tbl[] = {
 636         QMP_PHY_INIT_CFG(QPHY_V4_PCS_LOCK_DETECT_CONFIG1, 0xd0),
 637         QMP_PHY_INIT_CFG(QPHY_V4_PCS_LOCK_DETECT_CONFIG2, 0x07),
 638         QMP_PHY_INIT_CFG(QPHY_V4_PCS_LOCK_DETECT_CONFIG3, 0x20),
 639         QMP_PHY_INIT_CFG(QPHY_V4_PCS_LOCK_DETECT_CONFIG6, 0x13),
 640         QMP_PHY_INIT_CFG(QPHY_V4_PCS_REFGEN_REQ_CONFIG1, 0x21),
 641         QMP_PHY_INIT_CFG(QPHY_V4_PCS_RX_SIGDET_LVL, 0xa9),
 642         QMP_PHY_INIT_CFG(QPHY_V4_PCS_CDR_RESET_TIME, 0x0a),
 643         QMP_PHY_INIT_CFG(QPHY_V4_PCS_ALIGN_DETECT_CONFIG1, 0x88),
 644         QMP_PHY_INIT_CFG(QPHY_V4_PCS_ALIGN_DETECT_CONFIG2, 0x13),
 645         QMP_PHY_INIT_CFG(QPHY_V4_PCS_PCS_TX_RX_CONFIG, 0x0c),
 646         QMP_PHY_INIT_CFG(QPHY_V4_PCS_EQ_CONFIG1, 0x4b),
 647         QMP_PHY_INIT_CFG(QPHY_V4_PCS_EQ_CONFIG5, 0x10),
 648 };
 649
 650 static const struct qmp_phy_init_tbl sm8250_usb3_pcs_usb_tbl[] = {
 651         QMP_PHY_INIT_CFG(QPHY_V4_PCS_USB3_LFPS_DET_HIGH_COUNT_VAL, 0xf8),
 652         QMP_PHY_INIT_CFG(QPHY_V4_PCS_USB3_RXEQTRAINING_DFE_TIME_S2, 0x07),
 653 };
 654
 655 static const struct qmp_phy_init_tbl sm8350_usb3_tx_tbl[] = {
 656         QMP_PHY_INIT_CFG(QSERDES_V5_TX_RES_CODE_LANE_TX, 0x00),
 657         QMP_PHY_INIT_CFG(QSERDES_V5_TX_RES_CODE_LANE_RX, 0x00),
 658         QMP_PHY_INIT_CFG(QSERDES_V5_TX_RES_CODE_LANE_OFFSET_TX, 0x16),
 659         QMP_PHY_INIT_CFG(QSERDES_V5_TX_RES_CODE_LANE_OFFSET_RX, 0x0e),
 660         QMP_PHY_INIT_CFG(QSERDES_V5_TX_LANE_MODE_1, 0x35),
 661         QMP_PHY_INIT_CFG(QSERDES_V5_TX_LANE_MODE_3, 0x3f),
 662         QMP_PHY_INIT_CFG(QSERDES_V5_TX_LANE_MODE_4, 0x7f),
 663         QMP_PHY_INIT_CFG(QSERDES_V5_TX_LANE_MODE_5, 0x3f),
 664         QMP_PHY_INIT_CFG(QSERDES_V5_TX_RCV_DETECT_LVL_2, 0x12),
 665         QMP_PHY_INIT_CFG(QSERDES_V5_TX_PI_QEC_CTRL, 0x21),
 666 };
 667
 668 static const struct qmp_phy_init_tbl sm8350_usb3_rx_tbl[] = {
 669         QMP_PHY_INIT_CFG(QSERDES_V5_RX_UCDR_FO_GAIN, 0x0a),
 670         QMP_PHY_INIT_CFG(QSERDES_V5_RX_UCDR_SO_GAIN, 0x05),
 671         QMP_PHY_INIT_CFG(QSERDES_V5_RX_UCDR_FASTLOCK_FO_GAIN, 0x2f),
 672         QMP_PHY_INIT_CFG(QSERDES_V5_RX_UCDR_SO_SATURATION_AND_ENABLE, 0x7f),
 673         QMP_PHY_INIT_CFG(QSERDES_V5_RX_UCDR_FASTLOCK_COUNT_LOW, 0xff),
 674         QMP_PHY_INIT_CFG(QSERDES_V5_RX_UCDR_FASTLOCK_COUNT_HIGH, 0x0f),
 675         QMP_PHY_INIT_CFG(QSERDES_V5_RX_UCDR_PI_CONTROLS, 0x99),
 676         QMP_PHY_INIT_CFG(QSERDES_V5_RX_UCDR_SB2_THRESH1, 0x08),
 677         QMP_PHY_INIT_CFG(QSERDES_V5_RX_UCDR_SB2_THRESH2, 0x08),
 678         QMP_PHY_INIT_CFG(QSERDES_V5_RX_UCDR_SB2_GAIN1, 0x00),
 679         QMP_PHY_INIT_CFG(QSERDES_V5_RX_UCDR_SB2_GAIN2, 0x04),
 680         QMP_PHY_INIT_CFG(QSERDES_V5_RX_VGA_CAL_CNTRL1, 0x54),
 681         QMP_PHY_INIT_CFG(QSERDES_V5_RX_VGA_CAL_CNTRL2, 0x0f),
 682         QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_EQU_ADAPTOR_CNTRL2, 0x0f),
 683         QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_EQU_ADAPTOR_CNTRL3, 0x4a),
 684         QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_EQU_ADAPTOR_CNTRL4, 0x0a),
 685         QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_IDAC_TSETTLE_LOW, 0xc0),
 686         QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_IDAC_TSETTLE_HIGH, 0x00),
 687         QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_EQ_OFFSET_ADAPTOR_CNTRL1, 0x47),
 688         QMP_PHY_INIT_CFG(QSERDES_V5_RX_SIGDET_CNTRL, 0x04),
 689         QMP_PHY_INIT_CFG(QSERDES_V5_RX_SIGDET_DEGLITCH_CNTRL, 0x0e),
 690         QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_00_LOW, 0xbb),
 691         QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_00_HIGH, 0x7b),
 692         QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_00_HIGH2, 0xbb),
 693         QMP_PHY_INIT_CFG_LANE(QSERDES_V5_RX_RX_MODE_00_HIGH3, 0x3d, 1),
 694         QMP_PHY_INIT_CFG_LANE(QSERDES_V5_RX_RX_MODE_00_HIGH3, 0x3c, 2),
 695         QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_00_HIGH4, 0xdb),
 696         QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_01_LOW, 0x64),
 697         QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_01_HIGH, 0x24),
 698         QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_01_HIGH2, 0xd2),
 699         QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_01_HIGH3, 0x13),
 700         QMP_PHY_INIT_CFG(QSERDES_V5_RX_RX_MODE_01_HIGH4, 0xa9),
 701         QMP_PHY_INIT_CFG(QSERDES_V5_RX_DFE_EN_TIMER, 0x04),
 702         QMP_PHY_INIT_CFG(QSERDES_V5_RX_DFE_CTLE_POST_CAL_OFFSET, 0x38),
 703         QMP_PHY_INIT_CFG(QSERDES_V5_RX_AUX_DATA_TCOARSE_TFINE, 0xa0),
 704         QMP_PHY_INIT_CFG(QSERDES_V5_RX_DCC_CTRL1, 0x0c),
 705         QMP_PHY_INIT_CFG(QSERDES_V5_RX_GM_CAL, 0x00),
 706         QMP_PHY_INIT_CFG(QSERDES_V5_RX_VTH_CODE, 0x10),
 707 };
 708
 709 static const struct qmp_phy_init_tbl sm8350_usb3_pcs_tbl[] = {
 710         QMP_PHY_INIT_CFG(QPHY_V4_PCS_RCVR_DTCT_DLY_P1U2_L, 0xe7),
 711         QMP_PHY_INIT_CFG(QPHY_V4_PCS_RCVR_DTCT_DLY_P1U2_H, 0x03),
 712         QMP_PHY_INIT_CFG(QPHY_V4_PCS_LOCK_DETECT_CONFIG1, 0xd0),
 713         QMP_PHY_INIT_CFG(QPHY_V4_PCS_LOCK_DETECT_CONFIG2, 0x07),
 714         QMP_PHY_INIT_CFG(QPHY_V4_PCS_LOCK_DETECT_CONFIG3, 0x20),
 715         QMP_PHY_INIT_CFG(QPHY_V4_PCS_LOCK_DETECT_CONFIG6, 0x13),
 716         QMP_PHY_INIT_CFG(QPHY_V4_PCS_REFGEN_REQ_CONFIG1, 0x21),
 717         QMP_PHY_INIT_CFG(QPHY_V4_PCS_RX_SIGDET_LVL, 0xaa),
 718         QMP_PHY_INIT_CFG(QPHY_V4_PCS_CDR_RESET_TIME, 0x0a),
 719         QMP_PHY_INIT_CFG(QPHY_V4_PCS_ALIGN_DETECT_CONFIG1, 0x88),
 720         QMP_PHY_INIT_CFG(QPHY_V4_PCS_ALIGN_DETECT_CONFIG2, 0x13),
 721         QMP_PHY_INIT_CFG(QPHY_V4_PCS_PCS_TX_RX_CONFIG, 0x0c),
 722         QMP_PHY_INIT_CFG(QPHY_V4_PCS_EQ_CONFIG1, 0x4b),
 723         QMP_PHY_INIT_CFG(QPHY_V4_PCS_EQ_CONFIG5, 0x10),
 724 };
 725
 726 static const struct qmp_phy_init_tbl sm8350_usb3_pcs_usb_tbl[] = {
 727         QMP_PHY_INIT_CFG(QPHY_V5_PCS_USB3_RCVR_DTCT_DLY_U3_L, 0x40),
 728         QMP_PHY_INIT_CFG(QPHY_V5_PCS_USB3_RCVR_DTCT_DLY_U3_H, 0x00),
 729         QMP_PHY_INIT_CFG(QPHY_V5_PCS_USB3_LFPS_DET_HIGH_COUNT_VAL, 0xf8),
 730         QMP_PHY_INIT_CFG(QPHY_V5_PCS_USB3_RXEQTRAINING_DFE_TIME_S2, 0x07),
 731 };
 732
 733 static const struct qmp_phy_init_tbl sm8550_usb3_serdes_tbl[] = {
 734         QMP_PHY_INIT_CFG(QSERDES_V6_COM_SSC_STEP_SIZE1_MODE1, 0xc0),
 735         QMP_PHY_INIT_CFG(QSERDES_V6_COM_SSC_STEP_SIZE2_MODE1, 0x01),
 736         QMP_PHY_INIT_CFG(QSERDES_V6_COM_CP_CTRL_MODE1, 0x02),
 737         QMP_PHY_INIT_CFG(QSERDES_V6_COM_PLL_RCTRL_MODE1, 0x16),
 738         QMP_PHY_INIT_CFG(QSERDES_V6_COM_PLL_CCTRL_MODE1, 0x36),
 739         QMP_PHY_INIT_CFG(QSERDES_V6_COM_CORECLK_DIV_MODE1, 0x04),
 740         QMP_PHY_INIT_CFG(QSERDES_V6_COM_LOCK_CMP1_MODE1, 0x16),
 741         QMP_PHY_INIT_CFG(QSERDES_V6_COM_LOCK_CMP2_MODE1, 0x41),
 742         QMP_PHY_INIT_CFG(QSERDES_V6_COM_DEC_START_MODE1, 0x41),
 743         QMP_PHY_INIT_CFG(QSERDES_V6_COM_DEC_START_MSB_MODE1, 0x00),
 744         QMP_PHY_INIT_CFG(QSERDES_V6_COM_DIV_FRAC_START1_MODE1, 0x55),
 745         QMP_PHY_INIT_CFG(QSERDES_V6_COM_DIV_FRAC_START2_MODE1, 0x75),
 746         QMP_PHY_INIT_CFG(QSERDES_V6_COM_DIV_FRAC_START3_MODE1, 0x01),
 747         QMP_PHY_INIT_CFG(QSERDES_V6_COM_HSCLK_SEL_1, 0x01),
 748         QMP_PHY_INIT_CFG(QSERDES_V6_COM_VCO_TUNE1_MODE1, 0x25),
 749         QMP_PHY_INIT_CFG(QSERDES_V6_COM_VCO_TUNE2_MODE1, 0x02),
 750         QMP_PHY_INIT_CFG(QSERDES_V6_COM_BIN_VCOCAL_CMP_CODE1_MODE1, 0x5c),
 751         QMP_PHY_INIT_CFG(QSERDES_V6_COM_BIN_VCOCAL_CMP_CODE2_MODE1, 0x0f),
 752         QMP_PHY_INIT_CFG(QSERDES_V6_COM_BIN_VCOCAL_CMP_CODE1_MODE0, 0x5c),
 753         QMP_PHY_INIT_CFG(QSERDES_V6_COM_BIN_VCOCAL_CMP_CODE2_MODE0, 0x0f),
 754         QMP_PHY_INIT_CFG(QSERDES_V6_COM_SSC_STEP_SIZE1_MODE0, 0xc0),
 755         QMP_PHY_INIT_CFG(QSERDES_V6_COM_SSC_STEP_SIZE2_MODE0, 0x01),
 756         QMP_PHY_INIT_CFG(QSERDES_V6_COM_CP_CTRL_MODE0, 0x02),
 757         QMP_PHY_INIT_CFG(QSERDES_V6_COM_PLL_RCTRL_MODE0, 0x16),
 758         QMP_PHY_INIT_CFG(QSERDES_V6_COM_PLL_CCTRL_MODE0, 0x36),
 759         QMP_PHY_INIT_CFG(QSERDES_V6_COM_LOCK_CMP1_MODE0, 0x08),
 760         QMP_PHY_INIT_CFG(QSERDES_V6_COM_LOCK_CMP2_MODE0, 0x1a),
 761         QMP_PHY_INIT_CFG(QSERDES_V6_COM_DEC_START_MODE0, 0x41),
 762         QMP_PHY_INIT_CFG(QSERDES_V6_COM_DEC_START_MSB_MODE0, 0x00),
 763         QMP_PHY_INIT_CFG(QSERDES_V6_COM_DIV_FRAC_START1_MODE0, 0x55),
 764         QMP_PHY_INIT_CFG(QSERDES_V6_COM_DIV_FRAC_START2_MODE0, 0x75),
 765         QMP_PHY_INIT_CFG(QSERDES_V6_COM_DIV_FRAC_START3_MODE0, 0x01),
 766         QMP_PHY_INIT_CFG(QSERDES_V6_COM_VCO_TUNE1_MODE0, 0x25),
 767         QMP_PHY_INIT_CFG(QSERDES_V6_COM_VCO_TUNE2_MODE0, 0x02),
 768         QMP_PHY_INIT_CFG(QSERDES_V6_COM_BG_TIMER, 0x0a),
 769         QMP_PHY_INIT_CFG(QSERDES_V6_COM_SSC_EN_CENTER, 0x01),
 770         QMP_PHY_INIT_CFG(QSERDES_V6_COM_SSC_PER1, 0x62),
 771         QMP_PHY_INIT_CFG(QSERDES_V6_COM_SSC_PER2, 0x02),
 772         QMP_PHY_INIT_CFG(QSERDES_V6_COM_SYSCLK_BUF_ENABLE, 0x0c),
 773         QMP_PHY_INIT_CFG(QSERDES_V6_COM_SYSCLK_EN_SEL, 0x1a),
 774         QMP_PHY_INIT_CFG(QSERDES_V6_COM_LOCK_CMP_CFG, 0x14),
 775         QMP_PHY_INIT_CFG(QSERDES_V6_COM_VCO_TUNE_MAP, 0x04),
 776         QMP_PHY_INIT_CFG(QSERDES_V6_COM_CORE_CLK_EN, 0x20),
 777         QMP_PHY_INIT_CFG(QSERDES_V6_COM_CMN_CONFIG_1, 0x16),
 778         QMP_PHY_INIT_CFG(QSERDES_V6_COM_AUTO_GAIN_ADJ_CTRL_1, 0xb6),
 779         QMP_PHY_INIT_CFG(QSERDES_V6_COM_AUTO_GAIN_ADJ_CTRL_2, 0x4b),
 780         QMP_PHY_INIT_CFG(QSERDES_V6_COM_AUTO_GAIN_ADJ_CTRL_3, 0x37),
 781         QMP_PHY_INIT_CFG(QSERDES_V6_COM_ADDITIONAL_MISC, 0x0c),
 782 };
 783
 784 static const struct qmp_phy_init_tbl sm8550_usb3_tx_tbl[] = {
 785         QMP_PHY_INIT_CFG(QSERDES_V6_TX_RES_CODE_LANE_TX, 0x00),
 786         QMP_PHY_INIT_CFG(QSERDES_V6_TX_RES_CODE_LANE_RX, 0x00),
 787         QMP_PHY_INIT_CFG(QSERDES_V6_TX_RES_CODE_LANE_OFFSET_TX, 0x1f),
 788         QMP_PHY_INIT_CFG(QSERDES_V6_TX_RES_CODE_LANE_OFFSET_RX, 0x09),
 789         QMP_PHY_INIT_CFG(QSERDES_V6_TX_LANE_MODE_1, 0xf5),
 790         QMP_PHY_INIT_CFG(QSERDES_V6_TX_LANE_MODE_3, 0x3f),
 791         QMP_PHY_INIT_CFG(QSERDES_V6_TX_LANE_MODE_4, 0x3f),
 792         QMP_PHY_INIT_CFG(QSERDES_V6_TX_LANE_MODE_5, 0x5f),
 793         QMP_PHY_INIT_CFG(QSERDES_V6_TX_RCV_DETECT_LVL_2, 0x12),
 794         QMP_PHY_INIT_CFG_LANE(QSERDES_V6_TX_PI_QEC_CTRL, 0x21, 1),
 795         QMP_PHY_INIT_CFG_LANE(QSERDES_V6_TX_PI_QEC_CTRL, 0x05, 2),
 796 };
 797
 798 static const struct qmp_phy_init_tbl sm8550_usb3_rx_tbl[] = {
 799         QMP_PHY_INIT_CFG(QSERDES_V6_RX_UCDR_FO_GAIN, 0x0a),
 800         QMP_PHY_INIT_CFG(QSERDES_V6_RX_UCDR_SO_GAIN, 0x06),
 801         QMP_PHY_INIT_CFG(QSERDES_V6_RX_UCDR_FASTLOCK_FO_GAIN, 0x2f),
 802         QMP_PHY_INIT_CFG(QSERDES_V6_RX_UCDR_SO_SATURATION_AND_ENABLE, 0x7f),
 803         QMP_PHY_INIT_CFG(QSERDES_V6_RX_UCDR_FASTLOCK_COUNT_LOW, 0xff),
 804         QMP_PHY_INIT_CFG(QSERDES_V6_RX_UCDR_FASTLOCK_COUNT_HIGH, 0x0f),
 805         QMP_PHY_INIT_CFG(QSERDES_V6_RX_UCDR_PI_CONTROLS, 0x99),
 806         QMP_PHY_INIT_CFG(QSERDES_V6_RX_UCDR_SB2_THRESH1, 0x08),
 807         QMP_PHY_INIT_CFG(QSERDES_V6_RX_UCDR_SB2_THRESH2, 0x08),
 808         QMP_PHY_INIT_CFG(QSERDES_V6_RX_UCDR_SB2_GAIN1, 0x00),
 809         QMP_PHY_INIT_CFG(QSERDES_V6_RX_UCDR_SB2_GAIN2, 0x0a),
 810         QMP_PHY_INIT_CFG(QSERDES_V6_RX_AUX_DATA_TCOARSE_TFINE, 0xa0),
 811         QMP_PHY_INIT_CFG(QSERDES_V6_RX_VGA_CAL_CNTRL1, 0x54),
 812         QMP_PHY_INIT_CFG(QSERDES_V6_RX_VGA_CAL_CNTRL2, 0x0f),
 813         QMP_PHY_INIT_CFG(QSERDES_V6_RX_GM_CAL, 0x13),
 814         QMP_PHY_INIT_CFG(QSERDES_V6_RX_RX_EQU_ADAPTOR_CNTRL2, 0x0f),
 815         QMP_PHY_INIT_CFG(QSERDES_V6_RX_RX_EQU_ADAPTOR_CNTRL3, 0x4a),
 816         QMP_PHY_INIT_CFG(QSERDES_V6_RX_RX_EQU_ADAPTOR_CNTRL4, 0x0a),
 817         QMP_PHY_INIT_CFG(QSERDES_V6_RX_RX_IDAC_TSETTLE_LOW, 0x07),
 818         QMP_PHY_INIT_CFG(QSERDES_V6_RX_RX_IDAC_TSETTLE_HIGH, 0x00),
 819         QMP_PHY_INIT_CFG(QSERDES_V6_RX_RX_EQ_OFFSET_ADAPTOR_CNTRL1, 0x47),
 820         QMP_PHY_INIT_CFG(QSERDES_V6_RX_SIGDET_CNTRL, 0x04),
 821         QMP_PHY_INIT_CFG(QSERDES_V6_RX_SIGDET_DEGLITCH_CNTRL, 0x0e),
 822         QMP_PHY_INIT_CFG(QSERDES_V6_RX_RX_MODE_01_LOW, 0xdc),
 823         QMP_PHY_INIT_CFG(QSERDES_V6_RX_RX_MODE_01_HIGH, 0x5c),
 824         QMP_PHY_INIT_CFG(QSERDES_V6_RX_RX_MODE_01_HIGH2, 0x9c),
 825         QMP_PHY_INIT_CFG(QSERDES_V6_RX_RX_MODE_01_HIGH3, 0x1d),
 826         QMP_PHY_INIT_CFG(QSERDES_V6_RX_RX_MODE_01_HIGH4, 0x09),
 827         QMP_PHY_INIT_CFG(QSERDES_V6_RX_DFE_EN_TIMER, 0x04),
 828         QMP_PHY_INIT_CFG(QSERDES_V6_RX_DFE_CTLE_POST_CAL_OFFSET, 0x38),
 829         QMP_PHY_INIT_CFG(QSERDES_V6_RX_DCC_CTRL1, 0x0c),
 830         QMP_PHY_INIT_CFG(QSERDES_V6_RX_VTH_CODE, 0x10),
 831         QMP_PHY_INIT_CFG(QSERDES_V6_RX_SIGDET_CAL_CTRL1, 0x14),
 832         QMP_PHY_INIT_CFG(QSERDES_V6_RX_SIGDET_CAL_TRIM, 0x08),
 833
 834         QMP_PHY_INIT_CFG_LANE(QSERDES_V6_RX_RX_MODE_00_LOW, 0x3f, 1),
 835         QMP_PHY_INIT_CFG_LANE(QSERDES_V6_RX_RX_MODE_00_HIGH, 0xbf, 1),
 836         QMP_PHY_INIT_CFG_LANE(QSERDES_V6_RX_RX_MODE_00_HIGH2, 0xff, 1),
 837         QMP_PHY_INIT_CFG_LANE(QSERDES_V6_RX_RX_MODE_00_HIGH3, 0xdf, 1),
 838         QMP_PHY_INIT_CFG_LANE(QSERDES_V6_RX_RX_MODE_00_HIGH4, 0xed, 1),
 839
 840         QMP_PHY_INIT_CFG_LANE(QSERDES_V6_RX_RX_MODE_00_LOW, 0xbf, 2),
 841         QMP_PHY_INIT_CFG_LANE(QSERDES_V6_RX_RX_MODE_00_HIGH, 0xbf, 2),
 842         QMP_PHY_INIT_CFG_LANE(QSERDES_V6_RX_RX_MODE_00_HIGH2, 0xbf, 2),
 843         QMP_PHY_INIT_CFG_LANE(QSERDES_V6_RX_RX_MODE_00_HIGH3, 0xdf, 2),
 844         QMP_PHY_INIT_CFG_LANE(QSERDES_V6_RX_RX_MODE_00_HIGH4, 0xfd, 2),
 845 };
 846
 847 static const struct qmp_phy_init_tbl sm8550_usb3_pcs_tbl[] = {
 848         QMP_PHY_INIT_CFG(QPHY_V6_PCS_LOCK_DETECT_CONFIG1, 0xc4),
 849         QMP_PHY_INIT_CFG(QPHY_V6_PCS_LOCK_DETECT_CONFIG2, 0x89),
 850         QMP_PHY_INIT_CFG(QPHY_V6_PCS_LOCK_DETECT_CONFIG3, 0x20),
 851         QMP_PHY_INIT_CFG(QPHY_V6_PCS_LOCK_DETECT_CONFIG6, 0x13),
 852         QMP_PHY_INIT_CFG(QPHY_V6_PCS_REFGEN_REQ_CONFIG1, 0x21),
 853         QMP_PHY_INIT_CFG(QPHY_V6_PCS_RX_SIGDET_LVL, 0x99),
 854         QMP_PHY_INIT_CFG(QPHY_V6_PCS_RCVR_DTCT_DLY_P1U2_L, 0xe7),
 855         QMP_PHY_INIT_CFG(QPHY_V6_PCS_RCVR_DTCT_DLY_P1U2_H, 0x03),
 856         QMP_PHY_INIT_CFG(QPHY_V6_PCS_CDR_RESET_TIME, 0x0a),
 857         QMP_PHY_INIT_CFG(QPHY_V6_PCS_ALIGN_DETECT_CONFIG1, 0x88),
 858         QMP_PHY_INIT_CFG(QPHY_V6_PCS_ALIGN_DETECT_CONFIG2, 0x13),
 859         QMP_PHY_INIT_CFG(QPHY_V6_PCS_PCS_TX_RX_CONFIG, 0x0c),
 860         QMP_PHY_INIT_CFG(QPHY_V6_PCS_EQ_CONFIG1, 0x4b),
 861         QMP_PHY_INIT_CFG(QPHY_V6_PCS_EQ_CONFIG5, 0x10),
 862 };
 863
 864 static const struct qmp_phy_init_tbl sm8550_usb3_pcs_usb_tbl[] = {
 865         QMP_PHY_INIT_CFG(QPHY_V6_PCS_USB3_LFPS_DET_HIGH_COUNT_VAL, 0xf8),
 866         QMP_PHY_INIT_CFG(QPHY_V6_PCS_USB3_RXEQTRAINING_DFE_TIME_S2, 0x07),
 867         QMP_PHY_INIT_CFG(QPHY_V6_PCS_USB3_RCVR_DTCT_DLY_U3_L, 0x40),
 868         QMP_PHY_INIT_CFG(QPHY_V6_PCS_USB3_RCVR_DTCT_DLY_U3_H, 0x00),
 869         QMP_PHY_INIT_CFG(QPHY_V6_PCS_USB3_POWER_STATE_CONFIG1, 0x68),
 870 };
 871
 872 static const struct qmp_phy_init_tbl qmp_v4_dp_serdes_tbl[] = {
 873         QMP_PHY_INIT_CFG(QSERDES_V4_COM_SVS_MODE_CLK_SEL, 0x05),
 874         QMP_PHY_INIT_CFG(QSERDES_V4_COM_SYSCLK_EN_SEL, 0x3b),
 875         QMP_PHY_INIT_CFG(QSERDES_V4_COM_SYS_CLK_CTRL, 0x02),
 876         QMP_PHY_INIT_CFG(QSERDES_V4_COM_CLK_ENABLE1, 0x0c),
 877         QMP_PHY_INIT_CFG(QSERDES_V4_COM_SYSCLK_BUF_ENABLE, 0x06),
 878         QMP_PHY_INIT_CFG(QSERDES_V4_COM_CLK_SELECT, 0x30),
 879         QMP_PHY_INIT_CFG(QSERDES_V4_COM_PLL_IVCO, 0x0f),
 880         QMP_PHY_INIT_CFG(QSERDES_V4_COM_PLL_CCTRL_MODE0, 0x36),
 881         QMP_PHY_INIT_CFG(QSERDES_V4_COM_PLL_RCTRL_MODE0, 0x16),
 882         QMP_PHY_INIT_CFG(QSERDES_V4_COM_CP_CTRL_MODE0, 0x06),
 883         QMP_PHY_INIT_CFG(QSERDES_V4_COM_CMN_CONFIG, 0x02),
 884         QMP_PHY_INIT_CFG(QSERDES_V4_COM_INTEGLOOP_GAIN0_MODE0, 0x3f),
 885         QMP_PHY_INIT_CFG(QSERDES_V4_COM_INTEGLOOP_GAIN1_MODE0, 0x00),
 886         QMP_PHY_INIT_CFG(QSERDES_V4_COM_VCO_TUNE_MAP, 0x00),
 887         QMP_PHY_INIT_CFG(QSERDES_V4_COM_DIV_FRAC_START1_MODE0, 0x00),
 888         QMP_PHY_INIT_CFG(QSERDES_V4_COM_BG_TIMER, 0x0a),
 889         QMP_PHY_INIT_CFG(QSERDES_V4_COM_CORECLK_DIV_MODE0, 0x0a),
 890         QMP_PHY_INIT_CFG(QSERDES_V4_COM_VCO_TUNE_CTRL, 0x00),
 891         QMP_PHY_INIT_CFG(QSERDES_V4_COM_BIAS_EN_CLKBUFLR_EN, 0x17),
 892         QMP_PHY_INIT_CFG(QSERDES_V4_COM_CORE_CLK_EN, 0x1f),
 893 };
 894
 895 static const struct qmp_phy_init_tbl qmp_v4_dp_serdes_tbl_rbr[] = {
 896         QMP_PHY_INIT_CFG(QSERDES_V4_COM_HSCLK_SEL, 0x05),
 897         QMP_PHY_INIT_CFG(QSERDES_V4_COM_DEC_START_MODE0, 0x69),
 898         QMP_PHY_INIT_CFG(QSERDES_V4_COM_DIV_FRAC_START2_MODE0, 0x80),
 899         QMP_PHY_INIT_CFG(QSERDES_V4_COM_DIV_FRAC_START3_MODE0, 0x07),
 900         QMP_PHY_INIT_CFG(QSERDES_V4_COM_LOCK_CMP1_MODE0, 0x6f),
 901         QMP_PHY_INIT_CFG(QSERDES_V4_COM_LOCK_CMP2_MODE0, 0x08),
 902         QMP_PHY_INIT_CFG(QSERDES_V4_COM_LOCK_CMP_EN, 0x04),
 903 };
 904
 905 static const struct qmp_phy_init_tbl qmp_v4_dp_serdes_tbl_hbr[] = {
 906         QMP_PHY_INIT_CFG(QSERDES_V4_COM_HSCLK_SEL, 0x03),
 907         QMP_PHY_INIT_CFG(QSERDES_V4_COM_DEC_START_MODE0, 0x69),
 908         QMP_PHY_INIT_CFG(QSERDES_V4_COM_DIV_FRAC_START2_MODE0, 0x80),
 909         QMP_PHY_INIT_CFG(QSERDES_V4_COM_DIV_FRAC_START3_MODE0, 0x07),
 910         QMP_PHY_INIT_CFG(QSERDES_V4_COM_LOCK_CMP1_MODE0, 0x0f),
 911         QMP_PHY_INIT_CFG(QSERDES_V4_COM_LOCK_CMP2_MODE0, 0x0e),
 912         QMP_PHY_INIT_CFG(QSERDES_V4_COM_LOCK_CMP_EN, 0x08),
 913 };
 914
 915 static const struct qmp_phy_init_tbl qmp_v4_dp_serdes_tbl_hbr2[] = {
 916         QMP_PHY_INIT_CFG(QSERDES_V4_COM_HSCLK_SEL, 0x01),
 917         QMP_PHY_INIT_CFG(QSERDES_V4_COM_DEC_START_MODE0, 0x8c),
 918         QMP_PHY_INIT_CFG(QSERDES_V4_COM_DIV_FRAC_START2_MODE0, 0x00),
 919         QMP_PHY_INIT_CFG(QSERDES_V4_COM_DIV_FRAC_START3_MODE0, 0x0a),
 920         QMP_PHY_INIT_CFG(QSERDES_V4_COM_LOCK_CMP1_MODE0, 0x1f),
 921         QMP_PHY_INIT_CFG(QSERDES_V4_COM_LOCK_CMP2_MODE0, 0x1c),
 922         QMP_PHY_INIT_CFG(QSERDES_V4_COM_LOCK_CMP_EN, 0x08),
 923 };
 924
 925 static const struct qmp_phy_init_tbl qmp_v4_dp_serdes_tbl_hbr3[] = {
 926         QMP_PHY_INIT_CFG(QSERDES_V4_COM_HSCLK_SEL, 0x00),
 927         QMP_PHY_INIT_CFG(QSERDES_V4_COM_DEC_START_MODE0, 0x69),
 928         QMP_PHY_INIT_CFG(QSERDES_V4_COM_DIV_FRAC_START2_MODE0, 0x80),
 929         QMP_PHY_INIT_CFG(QSERDES_V4_COM_DIV_FRAC_START3_MODE0, 0x07),
 930         QMP_PHY_INIT_CFG(QSERDES_V4_COM_LOCK_CMP1_MODE0, 0x2f),
 931         QMP_PHY_INIT_CFG(QSERDES_V4_COM_LOCK_CMP2_MODE0, 0x2a),
 932         QMP_PHY_INIT_CFG(QSERDES_V4_COM_LOCK_CMP_EN, 0x08),
 933 };
 934
 935 static const struct qmp_phy_init_tbl qmp_v4_dp_tx_tbl[] = {
 936         QMP_PHY_INIT_CFG(QSERDES_V4_TX_VMODE_CTRL1, 0x40),
 937         QMP_PHY_INIT_CFG(QSERDES_V4_TX_PRE_STALL_LDO_BOOST_EN, 0x30),
 938         QMP_PHY_INIT_CFG(QSERDES_V4_TX_INTERFACE_SELECT, 0x3b),
 939         QMP_PHY_INIT_CFG(QSERDES_V4_TX_CLKBUF_ENABLE, 0x0f),
 940         QMP_PHY_INIT_CFG(QSERDES_V4_TX_RESET_TSYNC_EN, 0x03),
 941         QMP_PHY_INIT_CFG(QSERDES_V4_TX_TRAN_DRVR_EMP_EN, 0x0f),
 942         QMP_PHY_INIT_CFG(QSERDES_V4_TX_PARRATE_REC_DETECT_IDLE_EN, 0x00),
 943         QMP_PHY_INIT_CFG(QSERDES_V4_TX_TX_INTERFACE_MODE, 0x00),
 944         QMP_PHY_INIT_CFG(QSERDES_V4_TX_RES_CODE_LANE_OFFSET_TX, 0x11),
 945         QMP_PHY_INIT_CFG(QSERDES_V4_TX_RES_CODE_LANE_OFFSET_RX, 0x11),
 946         QMP_PHY_INIT_CFG(QSERDES_V4_TX_TX_BAND, 0x4),
 947         QMP_PHY_INIT_CFG(QSERDES_V4_TX_TX_POL_INV, 0x0a),
 948         QMP_PHY_INIT_CFG(QSERDES_V4_TX_TX_DRV_LVL, 0x2a),
 949         QMP_PHY_INIT_CFG(QSERDES_V4_TX_TX_EMP_POST1_LVL, 0x20),
 950 };
 951
 952 static const struct qmp_phy_init_tbl qmp_v5_dp_serdes_tbl[] = {
 953         QMP_PHY_INIT_CFG(QSERDES_V4_COM_SVS_MODE_CLK_SEL, 0x05),
 954         QMP_PHY_INIT_CFG(QSERDES_V4_COM_SYSCLK_EN_SEL, 0x3b),
 955         QMP_PHY_INIT_CFG(QSERDES_V4_COM_SYS_CLK_CTRL, 0x02),
 956         QMP_PHY_INIT_CFG(QSERDES_V4_COM_CLK_ENABLE1, 0x0c),
 957         QMP_PHY_INIT_CFG(QSERDES_V4_COM_SYSCLK_BUF_ENABLE, 0x06),
 958         QMP_PHY_INIT_CFG(QSERDES_V4_COM_CLK_SELECT, 0x30),
 959         QMP_PHY_INIT_CFG(QSERDES_V4_COM_PLL_IVCO, 0x0f),
 960         QMP_PHY_INIT_CFG(QSERDES_V4_COM_PLL_CCTRL_MODE0, 0x36),
 961         QMP_PHY_INIT_CFG(QSERDES_V4_COM_PLL_CCTRL_MODE1, 0x36),
 962         QMP_PHY_INIT_CFG(QSERDES_V4_COM_PLL_RCTRL_MODE0, 0x16),
 963         QMP_PHY_INIT_CFG(QSERDES_V4_COM_PLL_RCTRL_MODE1, 0x16),
 964         QMP_PHY_INIT_CFG(QSERDES_V4_COM_CP_CTRL_MODE0, 0x06),
 965         QMP_PHY_INIT_CFG(QSERDES_V4_COM_CP_CTRL_MODE1, 0x06),
 966         QMP_PHY_INIT_CFG(QSERDES_V4_COM_CMN_CONFIG, 0x02),
 967         QMP_PHY_INIT_CFG(QSERDES_V4_COM_INTEGLOOP_GAIN0_MODE0, 0x3f),
 968         QMP_PHY_INIT_CFG(QSERDES_V4_COM_INTEGLOOP_GAIN1_MODE0, 0x00),
 969         QMP_PHY_INIT_CFG(QSERDES_V4_COM_VCO_TUNE_MAP, 0x02),
 970         QMP_PHY_INIT_CFG(QSERDES_V4_COM_DIV_FRAC_START1_MODE0, 0x00),
 971         QMP_PHY_INIT_CFG(QSERDES_V4_COM_BG_TIMER, 0x0a),
 972         QMP_PHY_INIT_CFG(QSERDES_V4_COM_CORECLK_DIV_MODE0, 0x0a),
 973         QMP_PHY_INIT_CFG(QSERDES_V4_COM_VCO_TUNE_CTRL, 0x00),
 974         QMP_PHY_INIT_CFG(QSERDES_V4_COM_BIAS_EN_CLKBUFLR_EN, 0x17),
 975         QMP_PHY_INIT_CFG(QSERDES_V4_COM_CORE_CLK_EN, 0x1f),
 976 };
 977
 978 static const struct qmp_phy_init_tbl qmp_v5_dp_tx_tbl[] = {
 979         QMP_PHY_INIT_CFG(QSERDES_V5_TX_VMODE_CTRL1, 0x40),
 980         QMP_PHY_INIT_CFG(QSERDES_V5_TX_PRE_STALL_LDO_BOOST_EN, 0x30),
 981         QMP_PHY_INIT_CFG(QSERDES_V5_TX_INTERFACE_SELECT, 0x3b),
 982         QMP_PHY_INIT_CFG(QSERDES_V5_TX_CLKBUF_ENABLE, 0x0f),
 983         QMP_PHY_INIT_CFG(QSERDES_V5_TX_RESET_TSYNC_EN, 0x03),
 984         QMP_PHY_INIT_CFG(QSERDES_V5_TX_TRAN_DRVR_EMP_EN, 0x0f),
 985         QMP_PHY_INIT_CFG(QSERDES_V5_TX_PARRATE_REC_DETECT_IDLE_EN, 0x00),
 986         QMP_PHY_INIT_CFG(QSERDES_V5_TX_TX_INTERFACE_MODE, 0x00),
 987         QMP_PHY_INIT_CFG(QSERDES_V5_TX_RES_CODE_LANE_OFFSET_TX, 0x11),
 988         QMP_PHY_INIT_CFG(QSERDES_V5_TX_RES_CODE_LANE_OFFSET_RX, 0x11),
 989         QMP_PHY_INIT_CFG(QSERDES_V5_TX_TX_BAND, 0x04),
 990 };
 991
 992 static const struct qmp_phy_init_tbl qmp_v5_5nm_dp_tx_tbl[] = {
 993         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_TX_LANE_MODE_3, 0x51),
 994         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_TX_TRANSCEIVER_BIAS_EN, 0x1a),
 995         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_TX_VMODE_CTRL1, 0x40),
 996         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_TX_PRE_STALL_LDO_BOOST_EN, 0x0),
 997         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_TX_INTERFACE_SELECT, 0xff),
 998         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_TX_CLKBUF_ENABLE, 0x0f),
 999         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_TX_RESET_TSYNC_EN, 0x03),
1000         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_TX_TRAN_DRVR_EMP_EN, 0xf),
1001         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_TX_PARRATE_REC_DETECT_IDLE_EN, 0x00),
1002         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_TX_RES_CODE_LANE_OFFSET_TX, 0x11),
1003         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_TX_RES_CODE_LANE_OFFSET_RX, 0x11),
1004         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_TX_TX_BAND, 0x01),
1005 };
1006
1007 static const struct qmp_phy_init_tbl qmp_v6_dp_serdes_tbl[] = {
1008         QMP_PHY_INIT_CFG(QSERDES_V6_COM_SVS_MODE_CLK_SEL, 0x15),
1009         QMP_PHY_INIT_CFG(QSERDES_V6_COM_SYSCLK_EN_SEL, 0x3b),
1010         QMP_PHY_INIT_CFG(QSERDES_V6_COM_SYS_CLK_CTRL, 0x02),
1011         QMP_PHY_INIT_CFG(QSERDES_V6_COM_CLK_ENABLE1, 0x0c),
1012         QMP_PHY_INIT_CFG(QSERDES_V6_COM_SYSCLK_BUF_ENABLE, 0x06),
1013         QMP_PHY_INIT_CFG(QSERDES_V6_COM_CLK_SELECT, 0x30),
1014         QMP_PHY_INIT_CFG(QSERDES_V6_COM_PLL_IVCO, 0x0f),
1015         QMP_PHY_INIT_CFG(QSERDES_V6_COM_PLL_CCTRL_MODE0, 0x36),
1016         QMP_PHY_INIT_CFG(QSERDES_V6_COM_PLL_RCTRL_MODE0, 0x16),
1017         QMP_PHY_INIT_CFG(QSERDES_V6_COM_CP_CTRL_MODE0, 0x06),
1018         QMP_PHY_INIT_CFG(QSERDES_V6_COM_DIV_FRAC_START1_MODE0, 0x00),
1019         QMP_PHY_INIT_CFG(QSERDES_V6_COM_CMN_CONFIG_1, 0x12),
1020         QMP_PHY_INIT_CFG(QSERDES_V6_COM_INTEGLOOP_GAIN0_MODE0, 0x3f),
1021         QMP_PHY_INIT_CFG(QSERDES_V6_COM_INTEGLOOP_GAIN1_MODE0, 0x00),
1022         QMP_PHY_INIT_CFG(QSERDES_V6_COM_VCO_TUNE_MAP, 0x00),
1023         QMP_PHY_INIT_CFG(QSERDES_V6_COM_BG_TIMER, 0x0a),
1024         QMP_PHY_INIT_CFG(QSERDES_V6_COM_PLL_CORE_CLK_DIV_MODE0, 0x14),
1025         QMP_PHY_INIT_CFG(QSERDES_V6_COM_VCO_TUNE_CTRL, 0x00),
1026         QMP_PHY_INIT_CFG(QSERDES_V6_COM_PLL_BIAS_EN_CLK_BUFLR_EN, 0x17),
1027         QMP_PHY_INIT_CFG(QSERDES_V6_COM_CORE_CLK_EN, 0x0f),
1028 };
1029
1030 static const struct qmp_phy_init_tbl qmp_v6_dp_tx_tbl[] = {
1031         QMP_PHY_INIT_CFG(QSERDES_V6_TX_VMODE_CTRL1, 0x40),
1032         QMP_PHY_INIT_CFG(QSERDES_V6_TX_PRE_STALL_LDO_BOOST_EN, 0x30),
1033         QMP_PHY_INIT_CFG(QSERDES_V6_TX_INTERFACE_SELECT, 0x3b),
1034         QMP_PHY_INIT_CFG(QSERDES_V6_TX_CLKBUF_ENABLE, 0x0f),
1035         QMP_PHY_INIT_CFG(QSERDES_V6_TX_RESET_TSYNC_EN, 0x03),
1036         QMP_PHY_INIT_CFG(QSERDES_V6_TX_TRAN_DRVR_EMP_EN, 0x0f),
1037         QMP_PHY_INIT_CFG(QSERDES_V6_TX_PARRATE_REC_DETECT_IDLE_EN, 0x00),
1038         QMP_PHY_INIT_CFG(QSERDES_V6_TX_TX_INTERFACE_MODE, 0x00),
1039         QMP_PHY_INIT_CFG(QSERDES_V6_TX_RES_CODE_LANE_OFFSET_TX, 0x0c),
1040         QMP_PHY_INIT_CFG(QSERDES_V6_TX_RES_CODE_LANE_OFFSET_RX, 0x0c),
1041         QMP_PHY_INIT_CFG(QSERDES_V6_TX_TX_BAND, 0x4),
1042 };
1043
1044 static const struct qmp_phy_init_tbl qmp_v6_dp_serdes_tbl_rbr[] = {
1045         QMP_PHY_INIT_CFG(QSERDES_V6_COM_HSCLK_SEL_1, 0x05),
1046         QMP_PHY_INIT_CFG(QSERDES_V6_COM_DEC_START_MODE0, 0x34),
1047         QMP_PHY_INIT_CFG(QSERDES_V6_COM_DIV_FRAC_START2_MODE0, 0xc0),
1048         QMP_PHY_INIT_CFG(QSERDES_V6_COM_DIV_FRAC_START3_MODE0, 0x0b),
1049         QMP_PHY_INIT_CFG(QSERDES_V6_COM_LOCK_CMP1_MODE0, 0x37),
1050         QMP_PHY_INIT_CFG(QSERDES_V6_COM_LOCK_CMP2_MODE0, 0x04),
1051         QMP_PHY_INIT_CFG(QSERDES_V6_COM_LOCK_CMP_EN, 0x04),
1052         QMP_PHY_INIT_CFG(QSERDES_V6_COM_BIN_VCOCAL_CMP_CODE1_MODE0, 0x71),
1053         QMP_PHY_INIT_CFG(QSERDES_V6_COM_BIN_VCOCAL_CMP_CODE2_MODE0, 0x0c),
1054 };
1055
1056 static const struct qmp_phy_init_tbl qmp_v6_dp_serdes_tbl_hbr[] = {
1057         QMP_PHY_INIT_CFG(QSERDES_V6_COM_HSCLK_SEL_1, 0x03),
1058         QMP_PHY_INIT_CFG(QSERDES_V6_COM_DEC_START_MODE0, 0x34),
1059         QMP_PHY_INIT_CFG(QSERDES_V6_COM_DIV_FRAC_START2_MODE0, 0xc0),
1060         QMP_PHY_INIT_CFG(QSERDES_V6_COM_DIV_FRAC_START3_MODE0, 0x0b),
1061         QMP_PHY_INIT_CFG(QSERDES_V6_COM_LOCK_CMP1_MODE0, 0x07),
1062         QMP_PHY_INIT_CFG(QSERDES_V6_COM_LOCK_CMP2_MODE0, 0x07),
1063         QMP_PHY_INIT_CFG(QSERDES_V6_COM_LOCK_CMP_EN, 0x08),
1064         QMP_PHY_INIT_CFG(QSERDES_V6_COM_BIN_VCOCAL_CMP_CODE1_MODE0, 0x71),
1065         QMP_PHY_INIT_CFG(QSERDES_V6_COM_BIN_VCOCAL_CMP_CODE2_MODE0, 0x0c),
1066 };
1067
1068 static const struct qmp_phy_init_tbl qmp_v6_dp_serdes_tbl_hbr2[] = {
1069         QMP_PHY_INIT_CFG(QSERDES_V6_COM_HSCLK_SEL_1, 0x01),
1070         QMP_PHY_INIT_CFG(QSERDES_V6_COM_DEC_START_MODE0, 0x46),
1071         QMP_PHY_INIT_CFG(QSERDES_V6_COM_DIV_FRAC_START2_MODE0, 0x00),
1072         QMP_PHY_INIT_CFG(QSERDES_V6_COM_DIV_FRAC_START3_MODE0, 0x05),
1073         QMP_PHY_INIT_CFG(QSERDES_V6_COM_LOCK_CMP1_MODE0, 0x0f),
1074         QMP_PHY_INIT_CFG(QSERDES_V6_COM_LOCK_CMP2_MODE0, 0x0e),
1075         QMP_PHY_INIT_CFG(QSERDES_V6_COM_LOCK_CMP_EN, 0x08),
1076         QMP_PHY_INIT_CFG(QSERDES_V6_COM_BIN_VCOCAL_CMP_CODE1_MODE0, 0x97),
1077         QMP_PHY_INIT_CFG(QSERDES_V6_COM_BIN_VCOCAL_CMP_CODE2_MODE0, 0x10),
1078 };
1079
1080 static const struct qmp_phy_init_tbl qmp_v6_dp_serdes_tbl_hbr3[] = {
1081         QMP_PHY_INIT_CFG(QSERDES_V6_COM_HSCLK_SEL_1, 0x00),
1082         QMP_PHY_INIT_CFG(QSERDES_V6_COM_DEC_START_MODE0, 0x34),
1083         QMP_PHY_INIT_CFG(QSERDES_V6_COM_DIV_FRAC_START2_MODE0, 0xc0),
1084         QMP_PHY_INIT_CFG(QSERDES_V6_COM_DIV_FRAC_START3_MODE0, 0x0b),
1085         QMP_PHY_INIT_CFG(QSERDES_V6_COM_LOCK_CMP1_MODE0, 0x17),
1086         QMP_PHY_INIT_CFG(QSERDES_V6_COM_LOCK_CMP2_MODE0, 0x15),
1087         QMP_PHY_INIT_CFG(QSERDES_V6_COM_LOCK_CMP_EN, 0x08),
1088         QMP_PHY_INIT_CFG(QSERDES_V6_COM_BIN_VCOCAL_CMP_CODE1_MODE0, 0x71),
1089         QMP_PHY_INIT_CFG(QSERDES_V6_COM_BIN_VCOCAL_CMP_CODE2_MODE0, 0x0c),
1090 };
1091
1092 static const struct qmp_phy_init_tbl sc8280xp_usb43dp_serdes_tbl[] = {
1093         QMP_PHY_INIT_CFG(QSERDES_V5_COM_SSC_EN_CENTER, 0x01),
1094         QMP_PHY_INIT_CFG(QSERDES_V5_COM_SSC_PER1, 0x31),
1095         QMP_PHY_INIT_CFG(QSERDES_V5_COM_SSC_PER2, 0x01),
1096         QMP_PHY_INIT_CFG(QSERDES_V5_COM_SSC_STEP_SIZE1_MODE0, 0xfd),
1097         QMP_PHY_INIT_CFG(QSERDES_V5_COM_SSC_STEP_SIZE2_MODE0, 0x0d),
1098         QMP_PHY_INIT_CFG(QSERDES_V5_COM_SSC_STEP_SIZE1_MODE1, 0xfd),
1099         QMP_PHY_INIT_CFG(QSERDES_V5_COM_SSC_STEP_SIZE2_MODE1, 0x0d),
1100         QMP_PHY_INIT_CFG(QSERDES_V5_COM_SYSCLK_BUF_ENABLE, 0x0a),
1101         QMP_PHY_INIT_CFG(QSERDES_V5_COM_CP_CTRL_MODE0, 0x02),
1102         QMP_PHY_INIT_CFG(QSERDES_V5_COM_CP_CTRL_MODE1, 0x02),
1103         QMP_PHY_INIT_CFG(QSERDES_V5_COM_PLL_RCTRL_MODE0, 0x16),
1104         QMP_PHY_INIT_CFG(QSERDES_V5_COM_PLL_RCTRL_MODE1, 0x16),
1105         QMP_PHY_INIT_CFG(QSERDES_V5_COM_PLL_CCTRL_MODE0, 0x36),
1106         QMP_PHY_INIT_CFG(QSERDES_V5_COM_PLL_CCTRL_MODE1, 0x36),
1107         QMP_PHY_INIT_CFG(QSERDES_V5_COM_SYSCLK_EN_SEL, 0x1a),
1108         QMP_PHY_INIT_CFG(QSERDES_V5_COM_LOCK_CMP_EN, 0x04),
1109         QMP_PHY_INIT_CFG(QSERDES_V5_COM_LOCK_CMP1_MODE0, 0x14),
1110         QMP_PHY_INIT_CFG(QSERDES_V5_COM_LOCK_CMP2_MODE0, 0x34),
1111         QMP_PHY_INIT_CFG(QSERDES_V5_COM_LOCK_CMP1_MODE1, 0x34),
1112         QMP_PHY_INIT_CFG(QSERDES_V5_COM_LOCK_CMP2_MODE1, 0x82),
1113         QMP_PHY_INIT_CFG(QSERDES_V5_COM_DEC_START_MODE0, 0x04),
1114         QMP_PHY_INIT_CFG(QSERDES_V5_COM_DEC_START_MSB_MODE0, 0x01),
1115         QMP_PHY_INIT_CFG(QSERDES_V5_COM_DEC_START_MODE1, 0x04),
1116         QMP_PHY_INIT_CFG(QSERDES_V5_COM_DEC_START_MSB_MODE1, 0x01),
1117         QMP_PHY_INIT_CFG(QSERDES_V5_COM_DIV_FRAC_START1_MODE0, 0x55),
1118         QMP_PHY_INIT_CFG(QSERDES_V5_COM_DIV_FRAC_START2_MODE0, 0xd5),
1119         QMP_PHY_INIT_CFG(QSERDES_V5_COM_DIV_FRAC_START3_MODE0, 0x05),
1120         QMP_PHY_INIT_CFG(QSERDES_V5_COM_DIV_FRAC_START1_MODE1, 0x55),
1121         QMP_PHY_INIT_CFG(QSERDES_V5_COM_DIV_FRAC_START2_MODE1, 0xd5),
1122         QMP_PHY_INIT_CFG(QSERDES_V5_COM_DIV_FRAC_START3_MODE1, 0x05),
1123         QMP_PHY_INIT_CFG(QSERDES_V5_COM_VCO_TUNE_MAP, 0x02),
1124         QMP_PHY_INIT_CFG(QSERDES_V5_COM_VCO_TUNE1_MODE0, 0xd4),
1125         QMP_PHY_INIT_CFG(QSERDES_V5_COM_VCO_TUNE2_MODE0, 0x00),
1126         QMP_PHY_INIT_CFG(QSERDES_V5_COM_VCO_TUNE1_MODE1, 0xd4),
1127         QMP_PHY_INIT_CFG(QSERDES_V5_COM_VCO_TUNE2_MODE1, 0x00),
1128         QMP_PHY_INIT_CFG(QSERDES_V5_COM_HSCLK_SEL, 0x13),
1129         QMP_PHY_INIT_CFG(QSERDES_V5_COM_HSCLK_HS_SWITCH_SEL, 0x00),
1130         QMP_PHY_INIT_CFG(QSERDES_V5_COM_CORECLK_DIV_MODE0, 0x0a),
1131         QMP_PHY_INIT_CFG(QSERDES_V5_COM_CORECLK_DIV_MODE1, 0x04),
1132         QMP_PHY_INIT_CFG(QSERDES_V5_COM_CORE_CLK_EN, 0x60),
1133         QMP_PHY_INIT_CFG(QSERDES_V5_COM_CMN_CONFIG, 0x76),
1134         QMP_PHY_INIT_CFG(QSERDES_V5_COM_PLL_IVCO, 0xff),
1135         QMP_PHY_INIT_CFG(QSERDES_V5_COM_INTEGLOOP_GAIN0_MODE0, 0x20),
1136         QMP_PHY_INIT_CFG(QSERDES_V5_COM_INTEGLOOP_GAIN0_MODE1, 0x20),
1137         QMP_PHY_INIT_CFG(QSERDES_V5_COM_VCO_TUNE_INITVAL2, 0x00),
1138         QMP_PHY_INIT_CFG(QSERDES_V5_COM_VCO_TUNE_MAXVAL2, 0x01),
1139         QMP_PHY_INIT_CFG(QSERDES_V5_COM_SVS_MODE_CLK_SEL, 0x0a),
1140 };
1141
1142 static const struct qmp_phy_init_tbl sc8280xp_usb43dp_tx_tbl[] = {
1143         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_TX_LANE_MODE_1, 0x05),
1144         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_TX_LANE_MODE_2, 0xc2),
1145         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_TX_LANE_MODE_3, 0x10),
1146         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_TX_RES_CODE_LANE_OFFSET_TX, 0x1f),
1147         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_TX_RES_CODE_LANE_OFFSET_RX, 0x0a),
1148 };
1149
1150 static const struct qmp_phy_init_tbl sc8280xp_usb43dp_rx_tbl[] = {
1151         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_SIGDET_CNTRL, 0x04),
1152         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_SIGDET_DEGLITCH_CNTRL, 0x0e),
1153         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_SIGDET_ENABLES, 0x00),
1154         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_RX_MODE_RATE_0_1_B0, 0xd2),
1155         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_RX_MODE_RATE_0_1_B1, 0xd2),
1156         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_RX_MODE_RATE_0_1_B2, 0xdb),
1157         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_RX_MODE_RATE_0_1_B3, 0x21),
1158         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_RX_MODE_RATE_0_1_B4, 0x3f),
1159         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_RX_MODE_RATE_0_1_B5, 0x80),
1160         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_RX_MODE_RATE_0_1_B6, 0x45),
1161         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_RX_MODE_RATE_0_1_B7, 0x00),
1162         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_RX_MODE_RATE2_B0, 0x6b),
1163         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_RX_MODE_RATE2_B1, 0x63),
1164         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_RX_MODE_RATE2_B2, 0xb6),
1165         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_RX_MODE_RATE2_B3, 0x23),
1166         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_RX_MODE_RATE2_B4, 0x35),
1167         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_RX_MODE_RATE2_B5, 0x30),
1168         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_RX_MODE_RATE2_B6, 0x8e),
1169         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_RX_MODE_RATE2_B7, 0x00),
1170         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_RX_IVCM_CAL_CODE_OVERRIDE, 0x00),
1171         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_RX_IVCM_CAL_CTRL2, 0x80),
1172         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_RX_SUMMER_CAL_SPD_MODE, 0x1b),
1173         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_DFE_CTLE_POST_CAL_OFFSET, 0x38),
1174         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_UCDR_PI_CONTROLS, 0x15),
1175         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_UCDR_SB2_GAIN2_RATE2, 0x0a),
1176         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_RX_IVCM_POSTCAL_OFFSET, 0x7c),
1177         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_VGA_CAL_CNTRL1, 0x00),
1178         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_VGA_CAL_MAN_VAL, 0x0d),
1179         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_DFE_DAC_ENABLE1, 0x00),
1180         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_DFE_3, 0x45),
1181         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_GM_CAL, 0x09),
1182         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_UCDR_FO_GAIN_RATE2, 0x09),
1183         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_UCDR_SO_GAIN_RATE2, 0x05),
1184         QMP_PHY_INIT_CFG(QSERDES_V5_5NM_RX_Q_PI_INTRINSIC_BIAS_RATE32, 0x3f),
1185 };
1186
1187 static const struct qmp_phy_init_tbl sc8280xp_usb43dp_pcs_tbl[] = {
1188         QMP_PHY_INIT_CFG(QPHY_V5_PCS_RCVR_DTCT_DLY_P1U2_L, 0xe7),
1189         QMP_PHY_INIT_CFG(QPHY_V5_PCS_RCVR_DTCT_DLY_P1U2_H, 0x03),
1190         QMP_PHY_INIT_CFG(QPHY_V5_PCS_LOCK_DETECT_CONFIG1, 0xd0),
1191         QMP_PHY_INIT_CFG(QPHY_V5_PCS_LOCK_DETECT_CONFIG2, 0x07),
1192         QMP_PHY_INIT_CFG(QPHY_V5_PCS_LOCK_DETECT_CONFIG3, 0x20),
1193         QMP_PHY_INIT_CFG(QPHY_V5_PCS_LOCK_DETECT_CONFIG6, 0x13),
1194         QMP_PHY_INIT_CFG(QPHY_V5_PCS_REFGEN_REQ_CONFIG1, 0x21),
1195         QMP_PHY_INIT_CFG(QPHY_V5_PCS_RX_SIGDET_LVL, 0xaa),
1196         QMP_PHY_INIT_CFG(QPHY_V5_PCS_RX_CONFIG, 0x0a),
1197         QMP_PHY_INIT_CFG(QPHY_V5_PCS_ALIGN_DETECT_CONFIG1, 0x88),
1198         QMP_PHY_INIT_CFG(QPHY_V5_PCS_ALIGN_DETECT_CONFIG2, 0x13),
1199         QMP_PHY_INIT_CFG(QPHY_V5_PCS_PCS_TX_RX_CONFIG, 0x0c),
1200         QMP_PHY_INIT_CFG(QPHY_V5_PCS_EQ_CONFIG1, 0x4b),
1201         QMP_PHY_INIT_CFG(QPHY_V5_PCS_EQ_CONFIG5, 0x10),
1202         QMP_PHY_INIT_CFG(QPHY_V5_PCS_USB3_LFPS_DET_HIGH_COUNT_VAL, 0xf8),
1203         QMP_PHY_INIT_CFG(QPHY_V5_PCS_USB3_RXEQTRAINING_DFE_TIME_S2, 0x07),
1204 };
1205
1206 /* list of regulators */
1207 struct qmp_regulator_data {
1208         const char *name;
1209         unsigned int enable_load;
1210 };
1211
1212 static struct qmp_regulator_data qmp_phy_vreg_l[] = {
1213         { .name = "vdda-phy", .enable_load = 21800 },
1214         { .name = "vdda-pll", .enable_load = 36000 },
1215 };
1216
1217 static const u8 qmp_dp_v3_pre_emphasis_hbr3_hbr2[4][4] = {
1218         { 0x00, 0x0c, 0x15, 0x1a },
1219         { 0x02, 0x0e, 0x16, 0xff },
1220         { 0x02, 0x11, 0xff, 0xff },
1221         { 0x04, 0xff, 0xff, 0xff }
1222 };
1223
1224 static const u8 qmp_dp_v3_voltage_swing_hbr3_hbr2[4][4] = {
1225         { 0x02, 0x12, 0x16, 0x1a },
1226         { 0x09, 0x19, 0x1f, 0xff },
1227         { 0x10, 0x1f, 0xff, 0xff },
1228         { 0x1f, 0xff, 0xff, 0xff }
1229 };
1230
1231 static const u8 qmp_dp_v3_pre_emphasis_hbr_rbr[4][4] = {
1232         { 0x00, 0x0c, 0x14, 0x19 },
1233         { 0x00, 0x0b, 0x12, 0xff },
1234         { 0x00, 0x0b, 0xff, 0xff },
1235         { 0x04, 0xff, 0xff, 0xff }
1236 };
1237
1238 static const u8 qmp_dp_v3_voltage_swing_hbr_rbr[4][4] = {
1239         { 0x08, 0x0f, 0x16, 0x1f },
1240         { 0x11, 0x1e, 0x1f, 0xff },
1241         { 0x19, 0x1f, 0xff, 0xff },
1242         { 0x1f, 0xff, 0xff, 0xff }
1243 };
1244
1245 static const u8 qmp_dp_v4_pre_emphasis_hbr3_hbr2[4][4] = {
1246         { 0x00, 0x0c, 0x15, 0x1b },
1247         { 0x02, 0x0e, 0x16, 0xff },
1248         { 0x02, 0x11, 0xff, 0xff },
1249         { 0x04, 0xff, 0xff, 0xff }
1250 };
1251
1252 static const u8 qmp_dp_v4_pre_emphasis_hbr_rbr[4][4] = {
1253         { 0x00, 0x0d, 0x14, 0x1a },
1254         { 0x00, 0x0e, 0x15, 0xff },
1255         { 0x00, 0x0d, 0xff, 0xff },
1256         { 0x03, 0xff, 0xff, 0xff }
1257 };
1258
1259 static const u8 qmp_dp_v4_voltage_swing_hbr_rbr[4][4] = {
1260         { 0x08, 0x0f, 0x16, 0x1f },
1261         { 0x11, 0x1e, 0x1f, 0xff },
1262         { 0x16, 0x1f, 0xff, 0xff },
1263         { 0x1f, 0xff, 0xff, 0xff }
1264 };
1265
1266 static const u8 qmp_dp_v5_pre_emphasis_hbr3_hbr2[4][4] = {
1267         { 0x20, 0x2c, 0x35, 0x3b },
1268         { 0x22, 0x2e, 0x36, 0xff },
1269         { 0x22, 0x31, 0xff, 0xff },
1270         { 0x24, 0xff, 0xff, 0xff }
1271 };
1272
1273 static const u8 qmp_dp_v5_voltage_swing_hbr3_hbr2[4][4] = {
1274         { 0x22, 0x32, 0x36, 0x3a },
1275         { 0x29, 0x39, 0x3f, 0xff },
1276         { 0x30, 0x3f, 0xff, 0xff },
1277         { 0x3f, 0xff, 0xff, 0xff }
1278 };
1279
1280 static const u8 qmp_dp_v5_pre_emphasis_hbr_rbr[4][4] = {
1281         { 0x20, 0x2d, 0x34, 0x3a },
1282         { 0x20, 0x2e, 0x35, 0xff },
1283         { 0x20, 0x2e, 0xff, 0xff },
1284         { 0x24, 0xff, 0xff, 0xff }
1285 };
1286
1287 static const u8 qmp_dp_v5_voltage_swing_hbr_rbr[4][4] = {
1288         { 0x28, 0x2f, 0x36, 0x3f },
1289         { 0x31, 0x3e, 0x3f, 0xff },
1290         { 0x36, 0x3f, 0xff, 0xff },
1291         { 0x3f, 0xff, 0xff, 0xff }
1292 };
1293
1294 static const u8 qmp_dp_v6_pre_emphasis_hbr_rbr[4][4] = {
1295         { 0x20, 0x2d, 0x34, 0x3a },
1296         { 0x20, 0x2e, 0x35, 0xff },
1297         { 0x20, 0x2e, 0xff, 0xff },
1298         { 0x22, 0xff, 0xff, 0xff }
1299 };
1300
1301 struct qmp_combo;
1302
1303 struct qmp_combo_offsets {
1304         u16 com;
1305         u16 txa;
1306         u16 rxa;
1307         u16 txb;
1308         u16 rxb;
1309         u16 usb3_serdes;
1310         u16 usb3_pcs_misc;
1311         u16 usb3_pcs;
1312         u16 usb3_pcs_usb;
1313         u16 dp_serdes;
1314         u16 dp_txa;
1315         u16 dp_txb;
1316         u16 dp_dp_phy;
1317 };
1318
1319 struct qmp_phy_cfg {
1320         const struct qmp_combo_offsets *offsets;
1321
1322         /* Init sequence for PHY blocks - serdes, tx, rx, pcs */
1323         const struct qmp_phy_init_tbl *serdes_tbl;
1324         int serdes_tbl_num;
1325         const struct qmp_phy_init_tbl *tx_tbl;
1326         int tx_tbl_num;
1327         const struct qmp_phy_init_tbl *rx_tbl;
1328         int rx_tbl_num;
1329         const struct qmp_phy_init_tbl *pcs_tbl;
1330         int pcs_tbl_num;
1331         const struct qmp_phy_init_tbl *pcs_usb_tbl;
1332         int pcs_usb_tbl_num;
1333
1334         const struct qmp_phy_init_tbl *dp_serdes_tbl;
1335         int dp_serdes_tbl_num;
1336         const struct qmp_phy_init_tbl *dp_tx_tbl;
1337         int dp_tx_tbl_num;
1338
1339         /* Init sequence for DP PHY block link rates */
1340         const struct qmp_phy_init_tbl *serdes_tbl_rbr;
1341         int serdes_tbl_rbr_num;
1342         const struct qmp_phy_init_tbl *serdes_tbl_hbr;
1343         int serdes_tbl_hbr_num;
1344         const struct qmp_phy_init_tbl *serdes_tbl_hbr2;
1345         int serdes_tbl_hbr2_num;
1346         const struct qmp_phy_init_tbl *serdes_tbl_hbr3;
1347         int serdes_tbl_hbr3_num;
1348
1349         /* DP PHY swing and pre_emphasis tables */
1350         const u8 (*swing_hbr_rbr)[4][4];
1351         const u8 (*swing_hbr3_hbr2)[4][4];
1352         const u8 (*pre_emphasis_hbr_rbr)[4][4];
1353         const u8 (*pre_emphasis_hbr3_hbr2)[4][4];
1354
1355         /* DP PHY callbacks */
1356         int (*configure_dp_phy)(struct qmp_combo *qmp);
1357         void (*configure_dp_tx)(struct qmp_combo *qmp);
1358         int (*calibrate_dp_phy)(struct qmp_combo *qmp);
1359         void (*dp_aux_init)(struct qmp_combo *qmp);
1360
1361         /* resets to be requested */
1362         const char * const *reset_list;
1363         int num_resets;
1364         /* regulators to be requested */
1365         const struct qmp_regulator_data *vreg_list;
1366         int num_vregs;
1367
1368         /* array of registers with different offsets */
1369         const unsigned int *regs;
1370
1371         /* true, if PHY needs delay after POWER_DOWN */
1372         bool has_pwrdn_delay;
1373
1374         /* Offset from PCS to PCS_USB region */
1375         unsigned int pcs_usb_offset;
1376
1377 };
1378
1379 struct qmp_combo {
1380         struct device *dev;
1381
1382         const struct qmp_phy_cfg *cfg;
1383
1384         void __iomem *com;
1385
1386         void __iomem *serdes;
1387         void __iomem *tx;
1388         void __iomem *rx;
1389         void __iomem *pcs;
1390         void __iomem *tx2;
1391         void __iomem *rx2;
1392         void __iomem *pcs_misc;
1393         void __iomem *pcs_usb;
1394
1395         void __iomem *dp_serdes;
1396         void __iomem *dp_tx;
1397         void __iomem *dp_tx2;
1398         void __iomem *dp_dp_phy;
1399
1400         struct clk *pipe_clk;
1401         struct clk_bulk_data *clks;
1402         int num_clks;
1403         struct reset_control_bulk_data *resets;
1404         struct regulator_bulk_data *vregs;
1405
1406         struct mutex phy_mutex;
1407         int init_count;
1408
1409         struct phy *usb_phy;
1410         enum phy_mode mode;
1411         unsigned int usb_init_count;
1412
1413         struct phy *dp_phy;
1414         unsigned int dp_aux_cfg;
1415         struct phy_configure_opts_dp dp_opts;
1416         unsigned int dp_init_count;
1417
1418         struct clk_fixed_rate pipe_clk_fixed;
1419         struct clk_hw dp_link_hw;
1420         struct clk_hw dp_pixel_hw;
1421
1422         struct drm_bridge bridge;
1423
1424         struct typec_switch_dev *sw;
1425         enum typec_orientation orientation;
1426 };
1427
1428 static void qmp_v3_dp_aux_init(struct qmp_combo *qmp);
1429 static void qmp_v3_configure_dp_tx(struct qmp_combo *qmp);
1430 static int qmp_v3_configure_dp_phy(struct qmp_combo *qmp);
1431 static int qmp_v3_calibrate_dp_phy(struct qmp_combo *qmp);
1432
1433 static void qmp_v4_dp_aux_init(struct qmp_combo *qmp);
1434 static void qmp_v4_configure_dp_tx(struct qmp_combo *qmp);
1435 static int qmp_v4_configure_dp_phy(struct qmp_combo *qmp);
1436 static int qmp_v4_calibrate_dp_phy(struct qmp_combo *qmp);
1437
1438 static inline void qphy_setbits(void __iomem *base, u32 offset, u32 val)
1439 {
1440         u32 reg;
1441
1442         reg = readl(base + offset);
1443         reg |= val;
1444         writel(reg, base + offset);
1445
1446         /* ensure that above write is through */
1447         readl(base + offset);
1448 }
1449
1450 static inline void qphy_clrbits(void __iomem *base, u32 offset, u32 val)
1451 {
1452         u32 reg;
1453
1454         reg = readl(base + offset);
1455         reg &= ~val;
1456         writel(reg, base + offset);
1457
1458         /* ensure that above write is through */
1459         readl(base + offset);
1460 }
1461
1462 /* list of clocks required by phy */
1463 static const char * const qmp_combo_phy_clk_l[] = {
1464         "aux", "cfg_ahb", "ref", "com_aux",
1465 };
1466
1467 /* list of resets */
1468 static const char * const msm8996_usb3phy_reset_l[] = {
1469         "phy", "common",
1470 };
1471
1472 static const char * const sc7180_usb3phy_reset_l[] = {
1473         "phy",
1474 };
1475
1476 static const struct qmp_combo_offsets qmp_combo_offsets_v3 = {
1477         .com            = 0x0000,
1478         .txa            = 0x1200,
1479         .rxa            = 0x1400,
1480         .txb            = 0x1600,
1481         .rxb            = 0x1800,
1482         .usb3_serdes    = 0x1000,
1483         .usb3_pcs_misc  = 0x1a00,
1484         .usb3_pcs       = 0x1c00,
1485         .usb3_pcs_usb   = 0x1f00,
1486         .dp_serdes      = 0x2000,
1487         .dp_txa         = 0x2200,
1488         .dp_txb         = 0x2600,
1489         .dp_dp_phy      = 0x2a00,
1490 };
1491
1492 static const struct qmp_combo_offsets qmp_combo_offsets_v5 = {
1493         .com            = 0x0000,
1494         .txa            = 0x0400,
1495         .rxa            = 0x0600,
1496         .txb            = 0x0a00,
1497         .rxb            = 0x0c00,
1498         .usb3_serdes    = 0x1000,
1499         .usb3_pcs_misc  = 0x1200,
1500         .usb3_pcs       = 0x1400,
1501         .usb3_pcs_usb   = 0x1700,
1502         .dp_serdes      = 0x2000,
1503         .dp_dp_phy      = 0x2200,
1504 };
1505
1506 static const struct qmp_phy_cfg sc7180_usb3dpphy_cfg = {
1507         .offsets                = &qmp_combo_offsets_v3,
1508
1509         .serdes_tbl             = qmp_v3_usb3_serdes_tbl,
1510         .serdes_tbl_num         = ARRAY_SIZE(qmp_v3_usb3_serdes_tbl),
1511         .tx_tbl                 = qmp_v3_usb3_tx_tbl,
1512         .tx_tbl_num             = ARRAY_SIZE(qmp_v3_usb3_tx_tbl),
1513         .rx_tbl                 = qmp_v3_usb3_rx_tbl,
1514         .rx_tbl_num             = ARRAY_SIZE(qmp_v3_usb3_rx_tbl),
1515         .pcs_tbl                = qmp_v3_usb3_pcs_tbl,
1516         .pcs_tbl_num            = ARRAY_SIZE(qmp_v3_usb3_pcs_tbl),
1517
1518         .dp_serdes_tbl          = qmp_v3_dp_serdes_tbl,
1519         .dp_serdes_tbl_num      = ARRAY_SIZE(qmp_v3_dp_serdes_tbl),
1520         .dp_tx_tbl              = qmp_v3_dp_tx_tbl,
1521         .dp_tx_tbl_num          = ARRAY_SIZE(qmp_v3_dp_tx_tbl),
1522
1523         .serdes_tbl_rbr         = qmp_v3_dp_serdes_tbl_rbr,
1524         .serdes_tbl_rbr_num     = ARRAY_SIZE(qmp_v3_dp_serdes_tbl_rbr),
1525         .serdes_tbl_hbr         = qmp_v3_dp_serdes_tbl_hbr,
1526         .serdes_tbl_hbr_num     = ARRAY_SIZE(qmp_v3_dp_serdes_tbl_hbr),
1527         .serdes_tbl_hbr2        = qmp_v3_dp_serdes_tbl_hbr2,
1528         .serdes_tbl_hbr2_num    = ARRAY_SIZE(qmp_v3_dp_serdes_tbl_hbr2),
1529         .serdes_tbl_hbr3        = qmp_v3_dp_serdes_tbl_hbr3,
1530         .serdes_tbl_hbr3_num    = ARRAY_SIZE(qmp_v3_dp_serdes_tbl_hbr3),
1531
1532         .swing_hbr_rbr          = &qmp_dp_v3_voltage_swing_hbr_rbr,
1533         .pre_emphasis_hbr_rbr   = &qmp_dp_v3_pre_emphasis_hbr_rbr,
1534         .swing_hbr3_hbr2        = &qmp_dp_v3_voltage_swing_hbr3_hbr2,
1535         .pre_emphasis_hbr3_hbr2 = &qmp_dp_v3_pre_emphasis_hbr3_hbr2,
1536
1537         .dp_aux_init            = qmp_v3_dp_aux_init,
1538         .configure_dp_tx        = qmp_v3_configure_dp_tx,
1539         .configure_dp_phy       = qmp_v3_configure_dp_phy,
1540         .calibrate_dp_phy       = qmp_v3_calibrate_dp_phy,
1541
1542         .reset_list             = sc7180_usb3phy_reset_l,
1543         .num_resets             = ARRAY_SIZE(sc7180_usb3phy_reset_l),
1544         .vreg_list              = qmp_phy_vreg_l,
1545         .num_vregs              = ARRAY_SIZE(qmp_phy_vreg_l),
1546         .regs                   = qmp_v3_usb3phy_regs_layout,
1547
1548         .has_pwrdn_delay        = true,
1549 };
1550
1551 static const struct qmp_phy_cfg sdm845_usb3dpphy_cfg = {
1552         .offsets                = &qmp_combo_offsets_v3,
1553
1554         .serdes_tbl             = qmp_v3_usb3_serdes_tbl,
1555         .serdes_tbl_num         = ARRAY_SIZE(qmp_v3_usb3_serdes_tbl),
1556         .tx_tbl                 = qmp_v3_usb3_tx_tbl,
1557         .tx_tbl_num             = ARRAY_SIZE(qmp_v3_usb3_tx_tbl),
1558         .rx_tbl                 = qmp_v3_usb3_rx_tbl,
1559         .rx_tbl_num             = ARRAY_SIZE(qmp_v3_usb3_rx_tbl),
1560         .pcs_tbl                = qmp_v3_usb3_pcs_tbl,
1561         .pcs_tbl_num            = ARRAY_SIZE(qmp_v3_usb3_pcs_tbl),
1562
1563         .dp_serdes_tbl          = qmp_v3_dp_serdes_tbl,
1564         .dp_serdes_tbl_num      = ARRAY_SIZE(qmp_v3_dp_serdes_tbl),
1565         .dp_tx_tbl              = qmp_v3_dp_tx_tbl,
1566         .dp_tx_tbl_num          = ARRAY_SIZE(qmp_v3_dp_tx_tbl),
1567
1568         .serdes_tbl_rbr         = qmp_v3_dp_serdes_tbl_rbr,
1569         .serdes_tbl_rbr_num     = ARRAY_SIZE(qmp_v3_dp_serdes_tbl_rbr),
1570         .serdes_tbl_hbr         = qmp_v3_dp_serdes_tbl_hbr,
1571         .serdes_tbl_hbr_num     = ARRAY_SIZE(qmp_v3_dp_serdes_tbl_hbr),
1572         .serdes_tbl_hbr2        = qmp_v3_dp_serdes_tbl_hbr2,
1573         .serdes_tbl_hbr2_num    = ARRAY_SIZE(qmp_v3_dp_serdes_tbl_hbr2),
1574         .serdes_tbl_hbr3        = qmp_v3_dp_serdes_tbl_hbr3,
1575         .serdes_tbl_hbr3_num    = ARRAY_SIZE(qmp_v3_dp_serdes_tbl_hbr3),
1576
1577         .swing_hbr_rbr          = &qmp_dp_v3_voltage_swing_hbr_rbr,
1578         .pre_emphasis_hbr_rbr   = &qmp_dp_v3_pre_emphasis_hbr_rbr,
1579         .swing_hbr3_hbr2        = &qmp_dp_v3_voltage_swing_hbr3_hbr2,
1580         .pre_emphasis_hbr3_hbr2 = &qmp_dp_v3_pre_emphasis_hbr3_hbr2,
1581
1582         .dp_aux_init            = qmp_v3_dp_aux_init,
1583         .configure_dp_tx        = qmp_v3_configure_dp_tx,
1584         .configure_dp_phy       = qmp_v3_configure_dp_phy,
1585         .calibrate_dp_phy       = qmp_v3_calibrate_dp_phy,
1586
1587         .reset_list             = msm8996_usb3phy_reset_l,
1588         .num_resets             = ARRAY_SIZE(msm8996_usb3phy_reset_l),
1589         .vreg_list              = qmp_phy_vreg_l,
1590         .num_vregs              = ARRAY_SIZE(qmp_phy_vreg_l),
1591         .regs                   = qmp_v3_usb3phy_regs_layout,
1592
1593         .has_pwrdn_delay        = true,
1594 };
1595
1596 static const struct qmp_phy_cfg sc8180x_usb3dpphy_cfg = {
1597         .offsets                = &qmp_combo_offsets_v3,
1598
1599         .serdes_tbl             = sm8150_usb3_serdes_tbl,
1600         .serdes_tbl_num         = ARRAY_SIZE(sm8150_usb3_serdes_tbl),
1601         .tx_tbl                 = sm8150_usb3_tx_tbl,
1602         .tx_tbl_num             = ARRAY_SIZE(sm8150_usb3_tx_tbl),
1603         .rx_tbl                 = sm8150_usb3_rx_tbl,
1604         .rx_tbl_num             = ARRAY_SIZE(sm8150_usb3_rx_tbl),
1605         .pcs_tbl                = sm8150_usb3_pcs_tbl,
1606         .pcs_tbl_num            = ARRAY_SIZE(sm8150_usb3_pcs_tbl),
1607         .pcs_usb_tbl            = sm8150_usb3_pcs_usb_tbl,
1608         .pcs_usb_tbl_num        = ARRAY_SIZE(sm8150_usb3_pcs_usb_tbl),
1609
1610         .dp_serdes_tbl          = qmp_v4_dp_serdes_tbl,
1611         .dp_serdes_tbl_num      = ARRAY_SIZE(qmp_v4_dp_serdes_tbl),
1612         .dp_tx_tbl              = qmp_v4_dp_tx_tbl,
1613         .dp_tx_tbl_num          = ARRAY_SIZE(qmp_v4_dp_tx_tbl),
1614
1615         .serdes_tbl_rbr         = qmp_v4_dp_serdes_tbl_rbr,
1616         .serdes_tbl_rbr_num     = ARRAY_SIZE(qmp_v4_dp_serdes_tbl_rbr),
1617         .serdes_tbl_hbr         = qmp_v4_dp_serdes_tbl_hbr,
1618         .serdes_tbl_hbr_num     = ARRAY_SIZE(qmp_v4_dp_serdes_tbl_hbr),
1619         .serdes_tbl_hbr2        = qmp_v4_dp_serdes_tbl_hbr2,
1620         .serdes_tbl_hbr2_num    = ARRAY_SIZE(qmp_v4_dp_serdes_tbl_hbr2),
1621         .serdes_tbl_hbr3        = qmp_v4_dp_serdes_tbl_hbr3,
1622         .serdes_tbl_hbr3_num    = ARRAY_SIZE(qmp_v4_dp_serdes_tbl_hbr3),
1623
1624         .swing_hbr_rbr          = &qmp_dp_v3_voltage_swing_hbr_rbr,
1625         .pre_emphasis_hbr_rbr   = &qmp_dp_v3_pre_emphasis_hbr_rbr,
1626         .swing_hbr3_hbr2        = &qmp_dp_v3_voltage_swing_hbr3_hbr2,
1627         .pre_emphasis_hbr3_hbr2 = &qmp_dp_v3_pre_emphasis_hbr3_hbr2,
1628
1629         .dp_aux_init            = qmp_v4_dp_aux_init,
1630         .configure_dp_tx        = qmp_v4_configure_dp_tx,
1631         .configure_dp_phy       = qmp_v4_configure_dp_phy,
1632         .calibrate_dp_phy       = qmp_v4_calibrate_dp_phy,
1633
1634         .reset_list             = msm8996_usb3phy_reset_l,
1635         .num_resets             = ARRAY_SIZE(msm8996_usb3phy_reset_l),
1636         .vreg_list              = qmp_phy_vreg_l,
1637         .num_vregs              = ARRAY_SIZE(qmp_phy_vreg_l),
1638         .regs                   = qmp_v45_usb3phy_regs_layout,
1639         .pcs_usb_offset         = 0x300,
1640
1641         .has_pwrdn_delay        = true,
1642 };
1643
1644 static const struct qmp_phy_cfg sc8280xp_usb43dpphy_cfg = {
1645         .offsets                = &qmp_combo_offsets_v5,
1646
1647         .serdes_tbl             = sc8280xp_usb43dp_serdes_tbl,
1648         .serdes_tbl_num         = ARRAY_SIZE(sc8280xp_usb43dp_serdes_tbl),
1649         .tx_tbl                 = sc8280xp_usb43dp_tx_tbl,
1650         .tx_tbl_num             = ARRAY_SIZE(sc8280xp_usb43dp_tx_tbl),
1651         .rx_tbl                 = sc8280xp_usb43dp_rx_tbl,
1652         .rx_tbl_num             = ARRAY_SIZE(sc8280xp_usb43dp_rx_tbl),
1653         .pcs_tbl                = sc8280xp_usb43dp_pcs_tbl,
1654         .pcs_tbl_num            = ARRAY_SIZE(sc8280xp_usb43dp_pcs_tbl),
1655
1656         .dp_serdes_tbl          = qmp_v5_dp_serdes_tbl,
1657         .dp_serdes_tbl_num      = ARRAY_SIZE(qmp_v5_dp_serdes_tbl),
1658         .dp_tx_tbl              = qmp_v5_5nm_dp_tx_tbl,
1659         .dp_tx_tbl_num          = ARRAY_SIZE(qmp_v5_5nm_dp_tx_tbl),
1660
1661         .serdes_tbl_rbr         = qmp_v4_dp_serdes_tbl_rbr,
1662         .serdes_tbl_rbr_num     = ARRAY_SIZE(qmp_v4_dp_serdes_tbl_rbr),
1663         .serdes_tbl_hbr         = qmp_v4_dp_serdes_tbl_hbr,
1664         .serdes_tbl_hbr_num     = ARRAY_SIZE(qmp_v4_dp_serdes_tbl_hbr),
1665         .serdes_tbl_hbr2        = qmp_v4_dp_serdes_tbl_hbr2,
1666         .serdes_tbl_hbr2_num    = ARRAY_SIZE(qmp_v4_dp_serdes_tbl_hbr2),
1667         .serdes_tbl_hbr3        = qmp_v4_dp_serdes_tbl_hbr3,
1668         .serdes_tbl_hbr3_num    = ARRAY_SIZE(qmp_v4_dp_serdes_tbl_hbr3),
1669
1670         .swing_hbr_rbr          = &qmp_dp_v5_voltage_swing_hbr_rbr,
1671         .pre_emphasis_hbr_rbr   = &qmp_dp_v5_pre_emphasis_hbr_rbr,
1672         .swing_hbr3_hbr2        = &qmp_dp_v5_voltage_swing_hbr3_hbr2,
1673         .pre_emphasis_hbr3_hbr2 = &qmp_dp_v5_pre_emphasis_hbr3_hbr2,
1674
1675         .dp_aux_init            = qmp_v4_dp_aux_init,
1676         .configure_dp_tx        = qmp_v4_configure_dp_tx,
1677         .configure_dp_phy       = qmp_v4_configure_dp_phy,
1678         .calibrate_dp_phy       = qmp_v4_calibrate_dp_phy,
1679
1680         .reset_list             = msm8996_usb3phy_reset_l,
1681         .num_resets             = ARRAY_SIZE(msm8996_usb3phy_reset_l),
1682         .vreg_list              = qmp_phy_vreg_l,
1683         .num_vregs              = ARRAY_SIZE(qmp_phy_vreg_l),
1684         .regs                   = qmp_v5_5nm_usb3phy_regs_layout,
1685 };
1686
1687 static const struct qmp_phy_cfg sm6350_usb3dpphy_cfg = {
1688         .offsets                = &qmp_combo_offsets_v3,
1689
1690         .serdes_tbl             = qmp_v3_usb3_serdes_tbl,
1691         .serdes_tbl_num         = ARRAY_SIZE(qmp_v3_usb3_serdes_tbl),
1692         .tx_tbl                 = qmp_v3_usb3_tx_tbl,
1693         .tx_tbl_num             = ARRAY_SIZE(qmp_v3_usb3_tx_tbl),
1694         .rx_tbl                 = sm6350_usb3_rx_tbl,
1695         .rx_tbl_num             = ARRAY_SIZE(sm6350_usb3_rx_tbl),
1696         .pcs_tbl                = sm6350_usb3_pcs_tbl,
1697         .pcs_tbl_num            = ARRAY_SIZE(sm6350_usb3_pcs_tbl),
1698
1699         .dp_serdes_tbl          = qmp_v3_dp_serdes_tbl,
1700         .dp_serdes_tbl_num      = ARRAY_SIZE(qmp_v3_dp_serdes_tbl),
1701         .dp_tx_tbl              = qmp_v3_dp_tx_tbl,
1702         .dp_tx_tbl_num          = ARRAY_SIZE(qmp_v3_dp_tx_tbl),
1703
1704         .serdes_tbl_rbr         = qmp_v3_dp_serdes_tbl_rbr,
1705         .serdes_tbl_rbr_num     = ARRAY_SIZE(qmp_v3_dp_serdes_tbl_rbr),
1706         .serdes_tbl_hbr         = qmp_v3_dp_serdes_tbl_hbr,
1707         .serdes_tbl_hbr_num     = ARRAY_SIZE(qmp_v3_dp_serdes_tbl_hbr),
1708         .serdes_tbl_hbr2        = qmp_v3_dp_serdes_tbl_hbr2,
1709         .serdes_tbl_hbr2_num    = ARRAY_SIZE(qmp_v3_dp_serdes_tbl_hbr2),
1710         .serdes_tbl_hbr3        = qmp_v3_dp_serdes_tbl_hbr3,
1711         .serdes_tbl_hbr3_num    = ARRAY_SIZE(qmp_v3_dp_serdes_tbl_hbr3),
1712
1713         .swing_hbr_rbr          = &qmp_dp_v3_voltage_swing_hbr_rbr,
1714         .pre_emphasis_hbr_rbr   = &qmp_dp_v3_pre_emphasis_hbr_rbr,
1715         .swing_hbr3_hbr2        = &qmp_dp_v3_voltage_swing_hbr3_hbr2,
1716         .pre_emphasis_hbr3_hbr2 = &qmp_dp_v3_pre_emphasis_hbr3_hbr2,
1717
1718         .dp_aux_init            = qmp_v3_dp_aux_init,
1719         .configure_dp_tx        = qmp_v3_configure_dp_tx,
1720         .configure_dp_phy       = qmp_v3_configure_dp_phy,
1721         .calibrate_dp_phy       = qmp_v3_calibrate_dp_phy,
1722
1723         .reset_list             = msm8996_usb3phy_reset_l,
1724         .num_resets             = ARRAY_SIZE(msm8996_usb3phy_reset_l),
1725         .vreg_list              = qmp_phy_vreg_l,
1726         .num_vregs              = ARRAY_SIZE(qmp_phy_vreg_l),
1727         .regs                   = qmp_v3_usb3phy_regs_layout,
1728 };
1729
1730 static const struct qmp_phy_cfg sm8250_usb3dpphy_cfg = {
1731         .offsets                = &qmp_combo_offsets_v3,
1732
1733         .serdes_tbl             = sm8150_usb3_serdes_tbl,
1734         .serdes_tbl_num         = ARRAY_SIZE(sm8150_usb3_serdes_tbl),
1735         .tx_tbl                 = sm8250_usb3_tx_tbl,
1736         .tx_tbl_num             = ARRAY_SIZE(sm8250_usb3_tx_tbl),
1737         .rx_tbl                 = sm8250_usb3_rx_tbl,
1738         .rx_tbl_num             = ARRAY_SIZE(sm8250_usb3_rx_tbl),
1739         .pcs_tbl                = sm8250_usb3_pcs_tbl,
1740         .pcs_tbl_num            = ARRAY_SIZE(sm8250_usb3_pcs_tbl),
1741         .pcs_usb_tbl            = sm8250_usb3_pcs_usb_tbl,
1742         .pcs_usb_tbl_num        = ARRAY_SIZE(sm8250_usb3_pcs_usb_tbl),
1743
1744         .dp_serdes_tbl          = qmp_v4_dp_serdes_tbl,
1745         .dp_serdes_tbl_num      = ARRAY_SIZE(qmp_v4_dp_serdes_tbl),
1746         .dp_tx_tbl              = qmp_v4_dp_tx_tbl,
1747         .dp_tx_tbl_num          = ARRAY_SIZE(qmp_v4_dp_tx_tbl),
1748
1749         .serdes_tbl_rbr         = qmp_v4_dp_serdes_tbl_rbr,
1750         .serdes_tbl_rbr_num     = ARRAY_SIZE(qmp_v4_dp_serdes_tbl_rbr),
1751         .serdes_tbl_hbr         = qmp_v4_dp_serdes_tbl_hbr,
1752         .serdes_tbl_hbr_num     = ARRAY_SIZE(qmp_v4_dp_serdes_tbl_hbr),
1753         .serdes_tbl_hbr2        = qmp_v4_dp_serdes_tbl_hbr2,
1754         .serdes_tbl_hbr2_num    = ARRAY_SIZE(qmp_v4_dp_serdes_tbl_hbr2),
1755         .serdes_tbl_hbr3        = qmp_v4_dp_serdes_tbl_hbr3,
1756         .serdes_tbl_hbr3_num    = ARRAY_SIZE(qmp_v4_dp_serdes_tbl_hbr3),
1757
1758         .swing_hbr_rbr          = &qmp_dp_v3_voltage_swing_hbr_rbr,
1759         .pre_emphasis_hbr_rbr   = &qmp_dp_v3_pre_emphasis_hbr_rbr,
1760         .swing_hbr3_hbr2        = &qmp_dp_v3_voltage_swing_hbr3_hbr2,
1761         .pre_emphasis_hbr3_hbr2 = &qmp_dp_v3_pre_emphasis_hbr3_hbr2,
1762
1763         .dp_aux_init            = qmp_v4_dp_aux_init,
1764         .configure_dp_tx        = qmp_v4_configure_dp_tx,
1765         .configure_dp_phy       = qmp_v4_configure_dp_phy,
1766         .calibrate_dp_phy       = qmp_v4_calibrate_dp_phy,
1767
1768         .reset_list             = msm8996_usb3phy_reset_l,
1769         .num_resets             = ARRAY_SIZE(msm8996_usb3phy_reset_l),
1770         .vreg_list              = qmp_phy_vreg_l,
1771         .num_vregs              = ARRAY_SIZE(qmp_phy_vreg_l),
1772         .regs                   = qmp_v45_usb3phy_regs_layout,
1773         .pcs_usb_offset         = 0x300,
1774
1775         .has_pwrdn_delay        = true,
1776 };
1777
1778 static const struct qmp_phy_cfg sm8350_usb3dpphy_cfg = {
1779         .offsets                = &qmp_combo_offsets_v3,
1780
1781         .serdes_tbl             = sm8150_usb3_serdes_tbl,
1782         .serdes_tbl_num         = ARRAY_SIZE(sm8150_usb3_serdes_tbl),
1783         .tx_tbl                 = sm8350_usb3_tx_tbl,
1784         .tx_tbl_num             = ARRAY_SIZE(sm8350_usb3_tx_tbl),
1785         .rx_tbl                 = sm8350_usb3_rx_tbl,
1786         .rx_tbl_num             = ARRAY_SIZE(sm8350_usb3_rx_tbl),
1787         .pcs_tbl                = sm8350_usb3_pcs_tbl,
1788         .pcs_tbl_num            = ARRAY_SIZE(sm8350_usb3_pcs_tbl),
1789         .pcs_usb_tbl            = sm8350_usb3_pcs_usb_tbl,
1790         .pcs_usb_tbl_num        = ARRAY_SIZE(sm8350_usb3_pcs_usb_tbl),
1791
1792         .dp_serdes_tbl          = qmp_v4_dp_serdes_tbl,
1793         .dp_serdes_tbl_num      = ARRAY_SIZE(qmp_v4_dp_serdes_tbl),
1794         .dp_tx_tbl              = qmp_v5_dp_tx_tbl,
1795         .dp_tx_tbl_num          = ARRAY_SIZE(qmp_v5_dp_tx_tbl),
1796
1797         .serdes_tbl_rbr         = qmp_v4_dp_serdes_tbl_rbr,
1798         .serdes_tbl_rbr_num     = ARRAY_SIZE(qmp_v4_dp_serdes_tbl_rbr),
1799         .serdes_tbl_hbr         = qmp_v4_dp_serdes_tbl_hbr,
1800         .serdes_tbl_hbr_num     = ARRAY_SIZE(qmp_v4_dp_serdes_tbl_hbr),
1801         .serdes_tbl_hbr2        = qmp_v4_dp_serdes_tbl_hbr2,
1802         .serdes_tbl_hbr2_num    = ARRAY_SIZE(qmp_v4_dp_serdes_tbl_hbr2),
1803         .serdes_tbl_hbr3        = qmp_v4_dp_serdes_tbl_hbr3,
1804         .serdes_tbl_hbr3_num    = ARRAY_SIZE(qmp_v4_dp_serdes_tbl_hbr3),
1805
1806         .swing_hbr_rbr          = &qmp_dp_v4_voltage_swing_hbr_rbr,
1807         .pre_emphasis_hbr_rbr   = &qmp_dp_v4_pre_emphasis_hbr_rbr,
1808         .swing_hbr3_hbr2        = &qmp_dp_v3_voltage_swing_hbr3_hbr2,
1809         .pre_emphasis_hbr3_hbr2 = &qmp_dp_v4_pre_emphasis_hbr3_hbr2,
1810
1811         .dp_aux_init            = qmp_v4_dp_aux_init,
1812         .configure_dp_tx        = qmp_v4_configure_dp_tx,
1813         .configure_dp_phy       = qmp_v4_configure_dp_phy,
1814         .calibrate_dp_phy       = qmp_v4_calibrate_dp_phy,
1815
1816         .reset_list             = msm8996_usb3phy_reset_l,
1817         .num_resets             = ARRAY_SIZE(msm8996_usb3phy_reset_l),
1818         .vreg_list              = qmp_phy_vreg_l,
1819         .num_vregs              = ARRAY_SIZE(qmp_phy_vreg_l),
1820         .regs                   = qmp_v45_usb3phy_regs_layout,
1821
1822         .has_pwrdn_delay        = true,
1823 };
1824
1825 static const struct qmp_phy_cfg sm8550_usb3dpphy_cfg = {
1826         .offsets                = &qmp_combo_offsets_v3,
1827
1828         .serdes_tbl             = sm8550_usb3_serdes_tbl,
1829         .serdes_tbl_num         = ARRAY_SIZE(sm8550_usb3_serdes_tbl),
1830         .tx_tbl                 = sm8550_usb3_tx_tbl,
1831         .tx_tbl_num             = ARRAY_SIZE(sm8550_usb3_tx_tbl),
1832         .rx_tbl                 = sm8550_usb3_rx_tbl,
1833         .rx_tbl_num             = ARRAY_SIZE(sm8550_usb3_rx_tbl),
1834         .pcs_tbl                = sm8550_usb3_pcs_tbl,
1835         .pcs_tbl_num            = ARRAY_SIZE(sm8550_usb3_pcs_tbl),
1836         .pcs_usb_tbl            = sm8550_usb3_pcs_usb_tbl,
1837         .pcs_usb_tbl_num        = ARRAY_SIZE(sm8550_usb3_pcs_usb_tbl),
1838
1839         .dp_serdes_tbl          = qmp_v6_dp_serdes_tbl,
1840         .dp_serdes_tbl_num      = ARRAY_SIZE(qmp_v6_dp_serdes_tbl),
1841         .dp_tx_tbl              = qmp_v6_dp_tx_tbl,
1842         .dp_tx_tbl_num          = ARRAY_SIZE(qmp_v6_dp_tx_tbl),
1843
1844         .serdes_tbl_rbr         = qmp_v6_dp_serdes_tbl_rbr,
1845         .serdes_tbl_rbr_num     = ARRAY_SIZE(qmp_v6_dp_serdes_tbl_rbr),
1846         .serdes_tbl_hbr         = qmp_v6_dp_serdes_tbl_hbr,
1847         .serdes_tbl_hbr_num     = ARRAY_SIZE(qmp_v6_dp_serdes_tbl_hbr),
1848         .serdes_tbl_hbr2        = qmp_v6_dp_serdes_tbl_hbr2,
1849         .serdes_tbl_hbr2_num    = ARRAY_SIZE(qmp_v6_dp_serdes_tbl_hbr2),
1850         .serdes_tbl_hbr3        = qmp_v6_dp_serdes_tbl_hbr3,
1851         .serdes_tbl_hbr3_num    = ARRAY_SIZE(qmp_v6_dp_serdes_tbl_hbr3),
1852
1853         .swing_hbr_rbr          = &qmp_dp_v5_voltage_swing_hbr_rbr,
1854         .pre_emphasis_hbr_rbr   = &qmp_dp_v6_pre_emphasis_hbr_rbr,
1855         .swing_hbr3_hbr2        = &qmp_dp_v5_voltage_swing_hbr3_hbr2,
1856         .pre_emphasis_hbr3_hbr2 = &qmp_dp_v5_pre_emphasis_hbr3_hbr2,
1857
1858         .dp_aux_init            = qmp_v4_dp_aux_init,
1859         .configure_dp_tx        = qmp_v4_configure_dp_tx,
1860         .configure_dp_phy       = qmp_v4_configure_dp_phy,
1861         .calibrate_dp_phy       = qmp_v4_calibrate_dp_phy,
1862
1863         .regs                   = qmp_v6_usb3phy_regs_layout,
1864         .reset_list             = msm8996_usb3phy_reset_l,
1865         .num_resets             = ARRAY_SIZE(msm8996_usb3phy_reset_l),
1866         .vreg_list              = qmp_phy_vreg_l,
1867         .num_vregs              = ARRAY_SIZE(qmp_phy_vreg_l),
1868 };
1869
1870 static void qmp_combo_configure_lane(void __iomem *base,
1871                                         const struct qmp_phy_init_tbl tbl[],
1872                                         int num,
1873                                         u8 lane_mask)
1874 {
1875         int i;
1876         const struct qmp_phy_init_tbl *t = tbl;
1877
1878         if (!t)
1879                 return;
1880
1881         for (i = 0; i < num; i++, t++) {
1882                 if (!(t->lane_mask & lane_mask))
1883                         continue;
1884
1885                 writel(t->val, base + t->offset);
1886         }
1887 }
1888
1889 static void qmp_combo_configure(void __iomem *base,
1890                                    const struct qmp_phy_init_tbl tbl[],
1891                                    int num)
1892 {
1893         qmp_combo_configure_lane(base, tbl, num, 0xff);
1894 }
1895
1896 static int qmp_combo_dp_serdes_init(struct qmp_combo *qmp)
1897 {
1898         const struct qmp_phy_cfg *cfg = qmp->cfg;
1899         void __iomem *serdes = qmp->dp_serdes;
1900         const struct phy_configure_opts_dp *dp_opts = &qmp->dp_opts;
1901
1902         qmp_combo_configure(serdes, cfg->dp_serdes_tbl, cfg->dp_serdes_tbl_num);
1903
1904         switch (dp_opts->link_rate) {
1905         case 1620:
1906                 qmp_combo_configure(serdes, cfg->serdes_tbl_rbr,
1907                                 cfg->serdes_tbl_rbr_num);
1908                 break;
1909         case 2700:
1910                 qmp_combo_configure(serdes, cfg->serdes_tbl_hbr,
1911                                 cfg->serdes_tbl_hbr_num);
1912                 break;
1913         case 5400:
1914                 qmp_combo_configure(serdes, cfg->serdes_tbl_hbr2,
1915                                 cfg->serdes_tbl_hbr2_num);
1916                 break;
1917         case 8100:
1918                 qmp_combo_configure(serdes, cfg->serdes_tbl_hbr3,
1919                                 cfg->serdes_tbl_hbr3_num);
1920                 break;
1921         default:
1922                 /* Other link rates aren't supported */
1923                 return -EINVAL;
1924         }
1925
1926         return 0;
1927 }
1928
1929 static void qmp_v3_dp_aux_init(struct qmp_combo *qmp)
1930 {
1931         const struct qmp_phy_cfg *cfg = qmp->cfg;
1932
1933         writel(DP_PHY_PD_CTL_PWRDN | DP_PHY_PD_CTL_AUX_PWRDN |
1934                DP_PHY_PD_CTL_PLL_PWRDN | DP_PHY_PD_CTL_DP_CLAMP_EN,
1935                qmp->dp_dp_phy + QSERDES_DP_PHY_PD_CTL);
1936
1937         /* Turn on BIAS current for PHY/PLL */
1938         writel(QSERDES_V3_COM_BIAS_EN | QSERDES_V3_COM_BIAS_EN_MUX |
1939                QSERDES_V3_COM_CLKBUF_L_EN | QSERDES_V3_COM_EN_SYSCLK_TX_SEL,
1940                qmp->dp_serdes + cfg->regs[QPHY_COM_BIAS_EN_CLKBUFLR_EN]);
1941
1942         writel(DP_PHY_PD_CTL_PSR_PWRDN, qmp->dp_dp_phy + QSERDES_DP_PHY_PD_CTL);
1943
1944         writel(DP_PHY_PD_CTL_PWRDN | DP_PHY_PD_CTL_AUX_PWRDN |
1945                DP_PHY_PD_CTL_LANE_0_1_PWRDN |
1946                DP_PHY_PD_CTL_LANE_2_3_PWRDN | DP_PHY_PD_CTL_PLL_PWRDN |
1947                DP_PHY_PD_CTL_DP_CLAMP_EN,
1948                qmp->dp_dp_phy + QSERDES_DP_PHY_PD_CTL);
1949
1950         writel(QSERDES_V3_COM_BIAS_EN |
1951                QSERDES_V3_COM_BIAS_EN_MUX | QSERDES_V3_COM_CLKBUF_R_EN |
1952                QSERDES_V3_COM_CLKBUF_L_EN | QSERDES_V3_COM_EN_SYSCLK_TX_SEL |
1953                QSERDES_V3_COM_CLKBUF_RX_DRIVE_L,
1954                qmp->dp_serdes + cfg->regs[QPHY_COM_BIAS_EN_CLKBUFLR_EN]);
1955
1956         writel(0x00, qmp->dp_dp_phy + QSERDES_DP_PHY_AUX_CFG0);
1957         writel(0x13, qmp->dp_dp_phy + QSERDES_DP_PHY_AUX_CFG1);
1958         writel(0x24, qmp->dp_dp_phy + QSERDES_DP_PHY_AUX_CFG2);
1959         writel(0x00, qmp->dp_dp_phy + QSERDES_DP_PHY_AUX_CFG3);
1960         writel(0x0a, qmp->dp_dp_phy + QSERDES_DP_PHY_AUX_CFG4);
1961         writel(0x26, qmp->dp_dp_phy + QSERDES_DP_PHY_AUX_CFG5);
1962         writel(0x0a, qmp->dp_dp_phy + QSERDES_DP_PHY_AUX_CFG6);
1963         writel(0x03, qmp->dp_dp_phy + QSERDES_DP_PHY_AUX_CFG7);
1964         writel(0xbb, qmp->dp_dp_phy + QSERDES_DP_PHY_AUX_CFG8);
1965         writel(0x03, qmp->dp_dp_phy + QSERDES_DP_PHY_AUX_CFG9);
1966         qmp->dp_aux_cfg = 0;
1967
1968         writel(PHY_AUX_STOP_ERR_MASK | PHY_AUX_DEC_ERR_MASK |
1969                PHY_AUX_SYNC_ERR_MASK | PHY_AUX_ALIGN_ERR_MASK |
1970                PHY_AUX_REQ_ERR_MASK,
1971                qmp->dp_dp_phy + QSERDES_V3_DP_PHY_AUX_INTERRUPT_MASK);
1972 }
1973
1974 static int qmp_combo_configure_dp_swing(struct qmp_combo *qmp)
1975 {
1976         const struct phy_configure_opts_dp *dp_opts = &qmp->dp_opts;
1977         const struct qmp_phy_cfg *cfg = qmp->cfg;
1978         unsigned int v_level = 0, p_level = 0;
1979         u8 voltage_swing_cfg, pre_emphasis_cfg;
1980         int i;
1981
1982         for (i = 0; i < dp_opts->lanes; i++) {
1983                 v_level = max(v_level, dp_opts->voltage[i]);
1984                 p_level = max(p_level, dp_opts->pre[i]);
1985         }
1986
1987         if (dp_opts->link_rate <= 2700) {
1988                 voltage_swing_cfg = (*cfg->swing_hbr_rbr)[v_level][p_level];
1989                 pre_emphasis_cfg = (*cfg->pre_emphasis_hbr_rbr)[v_level][p_level];
1990         } else {
1991                 voltage_swing_cfg = (*cfg->swing_hbr3_hbr2)[v_level][p_level];
1992                 pre_emphasis_cfg = (*cfg->pre_emphasis_hbr3_hbr2)[v_level][p_level];
1993         }
1994
1995         /* TODO: Move check to config check */
1996         if (voltage_swing_cfg == 0xFF && pre_emphasis_cfg == 0xFF)
1997                 return -EINVAL;
1998
1999         /* Enable MUX to use Cursor values from these registers */
2000         voltage_swing_cfg |= DP_PHY_TXn_TX_DRV_LVL_MUX_EN;
2001         pre_emphasis_cfg |= DP_PHY_TXn_TX_EMP_POST1_LVL_MUX_EN;
2002
2003         writel(voltage_swing_cfg, qmp->dp_tx + cfg->regs[QPHY_TX_TX_DRV_LVL]);
2004         writel(pre_emphasis_cfg, qmp->dp_tx + cfg->regs[QPHY_TX_TX_EMP_POST1_LVL]);
2005         writel(voltage_swing_cfg, qmp->dp_tx2 + cfg->regs[QPHY_TX_TX_DRV_LVL]);
2006         writel(pre_emphasis_cfg, qmp->dp_tx2 + cfg->regs[QPHY_TX_TX_EMP_POST1_LVL]);
2007
2008         return 0;
2009 }
2010
2011 static void qmp_v3_configure_dp_tx(struct qmp_combo *qmp)
2012 {
2013         const struct phy_configure_opts_dp *dp_opts = &qmp->dp_opts;
2014         u32 bias_en, drvr_en;
2015
2016         if (qmp_combo_configure_dp_swing(qmp) < 0)
2017                 return;
2018
2019         if (dp_opts->lanes == 1) {
2020                 bias_en = 0x3e;
2021                 drvr_en = 0x13;
2022         } else {
2023                 bias_en = 0x3f;
2024                 drvr_en = 0x10;
2025         }
2026
2027         writel(drvr_en, qmp->dp_tx + QSERDES_V3_TX_HIGHZ_DRVR_EN);
2028         writel(bias_en, qmp->dp_tx + QSERDES_V3_TX_TRANSCEIVER_BIAS_EN);
2029         writel(drvr_en, qmp->dp_tx2 + QSERDES_V3_TX_HIGHZ_DRVR_EN);
2030         writel(bias_en, qmp->dp_tx2 + QSERDES_V3_TX_TRANSCEIVER_BIAS_EN);
2031 }
2032
2033 static bool qmp_combo_configure_dp_mode(struct qmp_combo *qmp)
2034 {
2035         bool reverse = (qmp->orientation == TYPEC_ORIENTATION_REVERSE);
2036         const struct phy_configure_opts_dp *dp_opts = &qmp->dp_opts;
2037         u32 val;
2038
2039         val = DP_PHY_PD_CTL_PWRDN | DP_PHY_PD_CTL_AUX_PWRDN |
2040               DP_PHY_PD_CTL_PLL_PWRDN | DP_PHY_PD_CTL_DP_CLAMP_EN;
2041
2042         if (dp_opts->lanes == 4 || reverse)
2043                 val |= DP_PHY_PD_CTL_LANE_0_1_PWRDN;
2044         if (dp_opts->lanes == 4 || !reverse)
2045                 val |= DP_PHY_PD_CTL_LANE_2_3_PWRDN;
2046
2047         writel(val, qmp->dp_dp_phy + QSERDES_DP_PHY_PD_CTL);
2048
2049         if (reverse)
2050                 writel(0x4c, qmp->pcs + QSERDES_DP_PHY_MODE);
2051         else
2052                 writel(0x5c, qmp->pcs + QSERDES_DP_PHY_MODE);
2053
2054         return reverse;
2055 }
2056
2057 static int qmp_combo_configure_dp_clocks(struct qmp_combo *qmp)
2058 {
2059         const struct phy_configure_opts_dp *dp_opts = &qmp->dp_opts;
2060         u32 phy_vco_div;
2061         unsigned long pixel_freq;
2062
2063         switch (dp_opts->link_rate) {
2064         case 1620:
2065                 phy_vco_div = 0x1;
2066                 pixel_freq = 1620000000UL / 2;
2067                 break;
2068         case 2700:
2069                 phy_vco_div = 0x1;
2070                 pixel_freq = 2700000000UL / 2;
2071                 break;
2072         case 5400:
2073                 phy_vco_div = 0x2;
2074                 pixel_freq = 5400000000UL / 4;
2075                 break;
2076         case 8100:
2077                 phy_vco_div = 0x0;
2078                 pixel_freq = 8100000000UL / 6;
2079                 break;
2080         default:
2081                 /* Other link rates aren't supported */
2082                 return -EINVAL;
2083         }
2084         writel(phy_vco_div, qmp->dp_dp_phy + QSERDES_V4_DP_PHY_VCO_DIV);
2085
2086         clk_set_rate(qmp->dp_link_hw.clk, dp_opts->link_rate * 100000);
2087         clk_set_rate(qmp->dp_pixel_hw.clk, pixel_freq);
2088
2089         return 0;
2090 }
2091
2092 static int qmp_v3_configure_dp_phy(struct qmp_combo *qmp)
2093 {
2094         const struct qmp_phy_cfg *cfg = qmp->cfg;
2095         u32 status;
2096         int ret;
2097
2098         qmp_combo_configure_dp_mode(qmp);
2099
2100         writel(0x05, qmp->dp_dp_phy + QSERDES_V3_DP_PHY_TX0_TX1_LANE_CTL);
2101         writel(0x05, qmp->dp_dp_phy + QSERDES_V3_DP_PHY_TX2_TX3_LANE_CTL);
2102
2103         ret = qmp_combo_configure_dp_clocks(qmp);
2104         if (ret)
2105                 return ret;
2106
2107         writel(0x04, qmp->dp_dp_phy + QSERDES_DP_PHY_AUX_CFG2);
2108         writel(0x01, qmp->dp_dp_phy + QSERDES_DP_PHY_CFG);
2109         writel(0x05, qmp->dp_dp_phy + QSERDES_DP_PHY_CFG);
2110         writel(0x01, qmp->dp_dp_phy + QSERDES_DP_PHY_CFG);
2111         writel(0x09, qmp->dp_dp_phy + QSERDES_DP_PHY_CFG);
2112
2113         writel(0x20, qmp->dp_serdes + cfg->regs[QPHY_COM_RESETSM_CNTRL]);
2114
2115         if (readl_poll_timeout(qmp->dp_serdes + cfg->regs[QPHY_COM_C_READY_STATUS],
2116                         status,
2117                         ((status & BIT(0)) > 0),
2118                         500,
2119                         10000))
2120                 return -ETIMEDOUT;
2121
2122         writel(0x19, qmp->dp_dp_phy + QSERDES_DP_PHY_CFG);
2123
2124         if (readl_poll_timeout(qmp->dp_dp_phy + cfg->regs[QPHY_DP_PHY_STATUS],
2125                         status,
2126                         ((status & BIT(1)) > 0),
2127                         500,
2128                         10000))
2129                 return -ETIMEDOUT;
2130
2131         writel(0x18, qmp->dp_dp_phy + QSERDES_DP_PHY_CFG);
2132         udelay(2000);
2133         writel(0x19, qmp->dp_dp_phy + QSERDES_DP_PHY_CFG);
2134
2135         return readl_poll_timeout(qmp->dp_dp_phy + cfg->regs[QPHY_DP_PHY_STATUS],
2136                         status,
2137                         ((status & BIT(1)) > 0),
2138                         500,
2139                         10000);
2140 }
2141
2142 /*
2143  * We need to calibrate the aux setting here as many times
2144  * as the caller tries
2145  */
2146 static int qmp_v3_calibrate_dp_phy(struct qmp_combo *qmp)
2147 {
2148         static const u8 cfg1_settings[] = { 0x13, 0x23, 0x1d };
2149         u8 val;
2150
2151         qmp->dp_aux_cfg++;
2152         qmp->dp_aux_cfg %= ARRAY_SIZE(cfg1_settings);
2153         val = cfg1_settings[qmp->dp_aux_cfg];
2154
2155         writel(val, qmp->dp_dp_phy + QSERDES_DP_PHY_AUX_CFG1);
2156
2157         return 0;
2158 }
2159
2160 static void qmp_v4_dp_aux_init(struct qmp_combo *qmp)
2161 {
2162         const struct qmp_phy_cfg *cfg = qmp->cfg;
2163
2164         writel(DP_PHY_PD_CTL_PWRDN | DP_PHY_PD_CTL_PSR_PWRDN | DP_PHY_PD_CTL_AUX_PWRDN |
2165                DP_PHY_PD_CTL_PLL_PWRDN | DP_PHY_PD_CTL_DP_CLAMP_EN,
2166                qmp->dp_dp_phy + QSERDES_DP_PHY_PD_CTL);
2167
2168         /* Turn on BIAS current for PHY/PLL */
2169         writel(0x17, qmp->dp_serdes + cfg->regs[QPHY_COM_BIAS_EN_CLKBUFLR_EN]);
2170
2171         writel(0x00, qmp->dp_dp_phy + QSERDES_DP_PHY_AUX_CFG0);
2172         writel(0x13, qmp->dp_dp_phy + QSERDES_DP_PHY_AUX_CFG1);
2173         writel(0xa4, qmp->dp_dp_phy + QSERDES_DP_PHY_AUX_CFG2);
2174         writel(0x00, qmp->dp_dp_phy + QSERDES_DP_PHY_AUX_CFG3);
2175         writel(0x0a, qmp->dp_dp_phy + QSERDES_DP_PHY_AUX_CFG4);
2176         writel(0x26, qmp->dp_dp_phy + QSERDES_DP_PHY_AUX_CFG5);
2177         writel(0x0a, qmp->dp_dp_phy + QSERDES_DP_PHY_AUX_CFG6);
2178         writel(0x03, qmp->dp_dp_phy + QSERDES_DP_PHY_AUX_CFG7);
2179         writel(0xb7, qmp->dp_dp_phy + QSERDES_DP_PHY_AUX_CFG8);
2180         writel(0x03, qmp->dp_dp_phy + QSERDES_DP_PHY_AUX_CFG9);
2181         qmp->dp_aux_cfg = 0;
2182
2183         writel(PHY_AUX_STOP_ERR_MASK | PHY_AUX_DEC_ERR_MASK |
2184                PHY_AUX_SYNC_ERR_MASK | PHY_AUX_ALIGN_ERR_MASK |
2185                PHY_AUX_REQ_ERR_MASK,
2186                qmp->dp_dp_phy + QSERDES_V4_DP_PHY_AUX_INTERRUPT_MASK);
2187 }
2188
2189 static void qmp_v4_configure_dp_tx(struct qmp_combo *qmp)
2190 {
2191         const struct qmp_phy_cfg *cfg = qmp->cfg;
2192
2193         /* Program default values before writing proper values */
2194         writel(0x27, qmp->dp_tx + cfg->regs[QPHY_TX_TX_DRV_LVL]);
2195         writel(0x27, qmp->dp_tx2 + cfg->regs[QPHY_TX_TX_DRV_LVL]);
2196
2197         writel(0x20, qmp->dp_tx + cfg->regs[QPHY_TX_TX_EMP_POST1_LVL]);
2198         writel(0x20, qmp->dp_tx2 + cfg->regs[QPHY_TX_TX_EMP_POST1_LVL]);
2199
2200         qmp_combo_configure_dp_swing(qmp);
2201 }
2202
2203 static int qmp_v456_configure_dp_phy(struct qmp_combo *qmp)
2204 {
2205         const struct qmp_phy_cfg *cfg = qmp->cfg;
2206         u32 status;
2207         int ret;
2208
2209         writel(0x0f, qmp->dp_dp_phy + QSERDES_V4_DP_PHY_CFG_1);
2210
2211         qmp_combo_configure_dp_mode(qmp);
2212
2213         writel(0x13, qmp->dp_dp_phy + QSERDES_DP_PHY_AUX_CFG1);
2214         writel(0xa4, qmp->dp_dp_phy + QSERDES_DP_PHY_AUX_CFG2);
2215
2216         writel(0x05, qmp->dp_dp_phy + QSERDES_V4_DP_PHY_TX0_TX1_LANE_CTL);
2217         writel(0x05, qmp->dp_dp_phy + QSERDES_V4_DP_PHY_TX2_TX3_LANE_CTL);
2218
2219         ret = qmp_combo_configure_dp_clocks(qmp);
2220         if (ret)
2221                 return ret;
2222
2223         writel(0x01, qmp->dp_dp_phy + QSERDES_DP_PHY_CFG);
2224         writel(0x05, qmp->dp_dp_phy + QSERDES_DP_PHY_CFG);
2225         writel(0x01, qmp->dp_dp_phy + QSERDES_DP_PHY_CFG);
2226         writel(0x09, qmp->dp_dp_phy + QSERDES_DP_PHY_CFG);
2227
2228         writel(0x20, qmp->dp_serdes + cfg->regs[QPHY_COM_RESETSM_CNTRL]);
2229
2230         if (readl_poll_timeout(qmp->dp_serdes + cfg->regs[QPHY_COM_C_READY_STATUS],
2231                         status,
2232                         ((status & BIT(0)) > 0),
2233                         500,
2234                         10000))
2235                 return -ETIMEDOUT;
2236
2237         if (readl_poll_timeout(qmp->dp_serdes + cfg->regs[QPHY_COM_CMN_STATUS],
2238                         status,
2239                         ((status & BIT(0)) > 0),
2240                         500,
2241                         10000))
2242                 return -ETIMEDOUT;
2243
2244         if (readl_poll_timeout(qmp->dp_serdes + cfg->regs[QPHY_COM_CMN_STATUS],
2245                         status,
2246                         ((status & BIT(1)) > 0),
2247                         500,
2248                         10000))
2249                 return -ETIMEDOUT;
2250
2251         writel(0x19, qmp->dp_dp_phy + QSERDES_DP_PHY_CFG);
2252
2253         if (readl_poll_timeout(qmp->dp_dp_phy + cfg->regs[QPHY_DP_PHY_STATUS],
2254                         status,
2255                         ((status & BIT(0)) > 0),
2256                         500,
2257                         10000))
2258                 return -ETIMEDOUT;
2259
2260         if (readl_poll_timeout(qmp->dp_dp_phy + cfg->regs[QPHY_DP_PHY_STATUS],
2261                         status,
2262                         ((status & BIT(1)) > 0),
2263                         500,
2264                         10000))
2265                 return -ETIMEDOUT;
2266
2267         return 0;
2268 }
2269
2270 static int qmp_v4_configure_dp_phy(struct qmp_combo *qmp)
2271 {
2272         const struct qmp_phy_cfg *cfg = qmp->cfg;
2273         bool reverse = (qmp->orientation == TYPEC_ORIENTATION_REVERSE);
2274         const struct phy_configure_opts_dp *dp_opts = &qmp->dp_opts;
2275         u32 bias0_en, drvr0_en, bias1_en, drvr1_en;
2276         u32 status;
2277         int ret;
2278
2279         ret = qmp_v456_configure_dp_phy(qmp);
2280         if (ret < 0)
2281                 return ret;
2282
2283         /*
2284          * At least for 7nm DP PHY this has to be done after enabling link
2285          * clock.
2286          */
2287
2288         if (dp_opts->lanes == 1) {
2289                 bias0_en = reverse ? 0x3e : 0x15;
2290                 bias1_en = reverse ? 0x15 : 0x3e;
2291                 drvr0_en = reverse ? 0x13 : 0x10;
2292                 drvr1_en = reverse ? 0x10 : 0x13;
2293         } else if (dp_opts->lanes == 2) {
2294                 bias0_en = reverse ? 0x3f : 0x15;
2295                 bias1_en = reverse ? 0x15 : 0x3f;
2296                 drvr0_en = 0x10;
2297                 drvr1_en = 0x10;
2298         } else {
2299                 bias0_en = 0x3f;
2300                 bias1_en = 0x3f;
2301                 drvr0_en = 0x10;
2302                 drvr1_en = 0x10;
2303         }
2304
2305         writel(drvr0_en, qmp->dp_tx + cfg->regs[QPHY_TX_HIGHZ_DRVR_EN]);
2306         writel(bias0_en, qmp->dp_tx + cfg->regs[QPHY_TX_TRANSCEIVER_BIAS_EN]);
2307         writel(drvr1_en, qmp->dp_tx2 + cfg->regs[QPHY_TX_HIGHZ_DRVR_EN]);
2308         writel(bias1_en, qmp->dp_tx2 + cfg->regs[QPHY_TX_TRANSCEIVER_BIAS_EN]);
2309
2310         writel(0x18, qmp->dp_dp_phy + QSERDES_DP_PHY_CFG);
2311         udelay(2000);
2312         writel(0x19, qmp->dp_dp_phy + QSERDES_DP_PHY_CFG);
2313
2314         if (readl_poll_timeout(qmp->dp_dp_phy + cfg->regs[QPHY_DP_PHY_STATUS],
2315                         status,
2316                         ((status & BIT(1)) > 0),
2317                         500,
2318                         10000))
2319                 return -ETIMEDOUT;
2320
2321         writel(0x0a, qmp->dp_tx + cfg->regs[QPHY_TX_TX_POL_INV]);
2322         writel(0x0a, qmp->dp_tx2 + cfg->regs[QPHY_TX_TX_POL_INV]);
2323
2324         writel(0x27, qmp->dp_tx + cfg->regs[QPHY_TX_TX_DRV_LVL]);
2325         writel(0x27, qmp->dp_tx2 + cfg->regs[QPHY_TX_TX_DRV_LVL]);
2326
2327         writel(0x20, qmp->dp_tx + cfg->regs[QPHY_TX_TX_EMP_POST1_LVL]);
2328         writel(0x20, qmp->dp_tx2 + cfg->regs[QPHY_TX_TX_EMP_POST1_LVL]);
2329
2330         return 0;
2331
2332         return 0;
2333 }
2334
2335 /*
2336  * We need to calibrate the aux setting here as many times
2337  * as the caller tries
2338  */
2339 static int qmp_v4_calibrate_dp_phy(struct qmp_combo *qmp)
2340 {
2341         static const u8 cfg1_settings[] = { 0x20, 0x13, 0x23, 0x1d };
2342         u8 val;
2343
2344         qmp->dp_aux_cfg++;
2345         qmp->dp_aux_cfg %= ARRAY_SIZE(cfg1_settings);
2346         val = cfg1_settings[qmp->dp_aux_cfg];
2347
2348         writel(val, qmp->dp_dp_phy + QSERDES_DP_PHY_AUX_CFG1);
2349
2350         return 0;
2351 }
2352
2353 static int qmp_combo_dp_configure(struct phy *phy, union phy_configure_opts *opts)
2354 {
2355         const struct phy_configure_opts_dp *dp_opts = &opts->dp;
2356         struct qmp_combo *qmp = phy_get_drvdata(phy);
2357         const struct qmp_phy_cfg *cfg = qmp->cfg;
2358
2359         mutex_lock(&qmp->phy_mutex);
2360
2361         memcpy(&qmp->dp_opts, dp_opts, sizeof(*dp_opts));
2362         if (qmp->dp_opts.set_voltages) {
2363                 cfg->configure_dp_tx(qmp);
2364                 qmp->dp_opts.set_voltages = 0;
2365         }
2366
2367         mutex_unlock(&qmp->phy_mutex);
2368
2369         return 0;
2370 }
2371
2372 static int qmp_combo_dp_calibrate(struct phy *phy)
2373 {
2374         struct qmp_combo *qmp = phy_get_drvdata(phy);
2375         const struct qmp_phy_cfg *cfg = qmp->cfg;
2376         int ret = 0;
2377
2378         mutex_lock(&qmp->phy_mutex);
2379
2380         if (cfg->calibrate_dp_phy)
2381                 ret = cfg->calibrate_dp_phy(qmp);
2382
2383         mutex_unlock(&qmp->phy_mutex);
2384
2385         return ret;
2386 }
2387
2388 static int qmp_combo_com_init(struct qmp_combo *qmp, bool force)
2389 {
2390         const struct qmp_phy_cfg *cfg = qmp->cfg;
2391         void __iomem *com = qmp->com;
2392         int ret;
2393         u32 val;
2394
2395         if (!force && qmp->init_count++)
2396                 return 0;
2397
2398         ret = regulator_bulk_enable(cfg->num_vregs, qmp->vregs);
2399         if (ret) {
2400                 dev_err(qmp->dev, "failed to enable regulators, err=%d\n", ret);
2401                 goto err_decrement_count;
2402         }
2403
2404         ret = reset_control_bulk_assert(cfg->num_resets, qmp->resets);
2405         if (ret) {
2406                 dev_err(qmp->dev, "reset assert failed\n");
2407                 goto err_disable_regulators;
2408         }
2409
2410         ret = reset_control_bulk_deassert(cfg->num_resets, qmp->resets);
2411         if (ret) {
2412                 dev_err(qmp->dev, "reset deassert failed\n");
2413                 goto err_disable_regulators;
2414         }
2415
2416         ret = clk_bulk_prepare_enable(qmp->num_clks, qmp->clks);
2417         if (ret)
2418                 goto err_assert_reset;
2419
2420         qphy_setbits(com, QPHY_V3_DP_COM_POWER_DOWN_CTRL, SW_PWRDN);
2421
2422         /* override hardware control for reset of qmp phy */
2423         qphy_setbits(com, QPHY_V3_DP_COM_RESET_OVRD_CTRL,
2424                         SW_DPPHY_RESET_MUX | SW_DPPHY_RESET |
2425                         SW_USB3PHY_RESET_MUX | SW_USB3PHY_RESET);
2426
2427         /* Use software based port select and switch on typec orientation */
2428         val = SW_PORTSELECT_MUX;
2429         if (qmp->orientation == TYPEC_ORIENTATION_REVERSE)
2430                 val |= SW_PORTSELECT_VAL;
2431         writel(val, com + QPHY_V3_DP_COM_TYPEC_CTRL);
2432         writel(USB3_MODE | DP_MODE, com + QPHY_V3_DP_COM_PHY_MODE_CTRL);
2433
2434         /* bring both QMP USB and QMP DP PHYs PCS block out of reset */
2435         qphy_clrbits(com, QPHY_V3_DP_COM_RESET_OVRD_CTRL,
2436                         SW_DPPHY_RESET_MUX | SW_DPPHY_RESET |
2437                         SW_USB3PHY_RESET_MUX | SW_USB3PHY_RESET);
2438
2439         qphy_clrbits(com, QPHY_V3_DP_COM_SWI_CTRL, 0x03);
2440         qphy_clrbits(com, QPHY_V3_DP_COM_SW_RESET, SW_RESET);
2441
2442         qphy_setbits(qmp->pcs, cfg->regs[QPHY_PCS_POWER_DOWN_CONTROL],
2443                         SW_PWRDN);
2444
2445         return 0;
2446
2447 err_assert_reset:
2448         reset_control_bulk_assert(cfg->num_resets, qmp->resets);
2449 err_disable_regulators:
2450         regulator_bulk_disable(cfg->num_vregs, qmp->vregs);
2451 err_decrement_count:
2452         qmp->init_count--;
2453
2454         return ret;
2455 }
2456
2457 static int qmp_combo_com_exit(struct qmp_combo *qmp, bool force)
2458 {
2459         const struct qmp_phy_cfg *cfg = qmp->cfg;
2460
2461         if (!force && --qmp->init_count)
2462                 return 0;
2463
2464         reset_control_bulk_assert(cfg->num_resets, qmp->resets);
2465
2466         clk_bulk_disable_unprepare(qmp->num_clks, qmp->clks);
2467
2468         regulator_bulk_disable(cfg->num_vregs, qmp->vregs);
2469
2470         return 0;
2471 }
2472
2473 static int qmp_combo_dp_init(struct phy *phy)
2474 {
2475         struct qmp_combo *qmp = phy_get_drvdata(phy);
2476         const struct qmp_phy_cfg *cfg = qmp->cfg;
2477         int ret;
2478
2479         mutex_lock(&qmp->phy_mutex);
2480
2481         ret = qmp_combo_com_init(qmp, false);
2482         if (ret)
2483                 goto out_unlock;
2484
2485         cfg->dp_aux_init(qmp);
2486
2487         qmp->dp_init_count++;
2488
2489 out_unlock:
2490         mutex_unlock(&qmp->phy_mutex);
2491         return ret;
2492 }
2493
2494 static int qmp_combo_dp_exit(struct phy *phy)
2495 {
2496         struct qmp_combo *qmp = phy_get_drvdata(phy);
2497
2498         mutex_lock(&qmp->phy_mutex);
2499
2500         qmp_combo_com_exit(qmp, false);
2501
2502         qmp->dp_init_count--;
2503
2504         mutex_unlock(&qmp->phy_mutex);
2505
2506         return 0;
2507 }
2508
2509 static int qmp_combo_dp_power_on(struct phy *phy)
2510 {
2511         struct qmp_combo *qmp = phy_get_drvdata(phy);
2512         const struct qmp_phy_cfg *cfg = qmp->cfg;
2513         void __iomem *tx = qmp->dp_tx;
2514         void __iomem *tx2 = qmp->dp_tx2;
2515
2516         mutex_lock(&qmp->phy_mutex);
2517
2518         qmp_combo_dp_serdes_init(qmp);
2519
2520         qmp_combo_configure_lane(tx, cfg->dp_tx_tbl, cfg->dp_tx_tbl_num, 1);
2521         qmp_combo_configure_lane(tx2, cfg->dp_tx_tbl, cfg->dp_tx_tbl_num, 2);
2522
2523         /* Configure special DP tx tunings */
2524         cfg->configure_dp_tx(qmp);
2525
2526         /* Configure link rate, swing, etc. */
2527         cfg->configure_dp_phy(qmp);
2528
2529         mutex_unlock(&qmp->phy_mutex);
2530
2531         return 0;
2532 }
2533
2534 static int qmp_combo_dp_power_off(struct phy *phy)
2535 {
2536         struct qmp_combo *qmp = phy_get_drvdata(phy);
2537
2538         mutex_lock(&qmp->phy_mutex);
2539
2540         /* Assert DP PHY power down */
2541         writel(DP_PHY_PD_CTL_PSR_PWRDN, qmp->dp_dp_phy + QSERDES_DP_PHY_PD_CTL);
2542
2543         mutex_unlock(&qmp->phy_mutex);
2544
2545         return 0;
2546 }
2547
2548 static int qmp_combo_usb_power_on(struct phy *phy)
2549 {
2550         struct qmp_combo *qmp = phy_get_drvdata(phy);
2551         const struct qmp_phy_cfg *cfg = qmp->cfg;
2552         void __iomem *serdes = qmp->serdes;
2553         void __iomem *tx = qmp->tx;
2554         void __iomem *rx = qmp->rx;
2555         void __iomem *tx2 = qmp->tx2;
2556         void __iomem *rx2 = qmp->rx2;
2557         void __iomem *pcs = qmp->pcs;
2558         void __iomem *pcs_usb = qmp->pcs_usb;
2559         void __iomem *status;
2560         unsigned int val;
2561         int ret;
2562
2563         qmp_combo_configure(serdes, cfg->serdes_tbl, cfg->serdes_tbl_num);
2564
2565         ret = clk_prepare_enable(qmp->pipe_clk);
2566         if (ret) {
2567                 dev_err(qmp->dev, "pipe_clk enable failed err=%d\n", ret);
2568                 return ret;
2569         }
2570
2571         /* Tx, Rx, and PCS configurations */
2572         qmp_combo_configure_lane(tx, cfg->tx_tbl, cfg->tx_tbl_num, 1);
2573         qmp_combo_configure_lane(tx2, cfg->tx_tbl, cfg->tx_tbl_num, 2);
2574
2575         qmp_combo_configure_lane(rx, cfg->rx_tbl, cfg->rx_tbl_num, 1);
2576         qmp_combo_configure_lane(rx2, cfg->rx_tbl, cfg->rx_tbl_num, 2);
2577
2578         qmp_combo_configure(pcs, cfg->pcs_tbl, cfg->pcs_tbl_num);
2579
2580         if (pcs_usb)
2581                 qmp_combo_configure(pcs_usb, cfg->pcs_usb_tbl, cfg->pcs_usb_tbl_num);
2582
2583         if (cfg->has_pwrdn_delay)
2584                 usleep_range(10, 20);
2585
2586         /* Pull PHY out of reset state */
2587         qphy_clrbits(pcs, cfg->regs[QPHY_SW_RESET], SW_RESET);
2588
2589         /* start SerDes and Phy-Coding-Sublayer */
2590         qphy_setbits(pcs, cfg->regs[QPHY_START_CTRL], SERDES_START | PCS_START);
2591
2592         status = pcs + cfg->regs[QPHY_PCS_STATUS];
2593         ret = readl_poll_timeout(status, val, !(val & PHYSTATUS), 200,
2594                         PHY_INIT_COMPLETE_TIMEOUT);
2595         if (ret) {
2596                 dev_err(qmp->dev, "phy initialization timed-out\n");
2597                 goto err_disable_pipe_clk;
2598         }
2599
2600         return 0;
2601
2602 err_disable_pipe_clk:
2603         clk_disable_unprepare(qmp->pipe_clk);
2604
2605         return ret;
2606 }
2607
2608 static int qmp_combo_usb_power_off(struct phy *phy)
2609 {
2610         struct qmp_combo *qmp = phy_get_drvdata(phy);
2611         const struct qmp_phy_cfg *cfg = qmp->cfg;
2612
2613         clk_disable_unprepare(qmp->pipe_clk);
2614
2615         /* PHY reset */
2616         qphy_setbits(qmp->pcs, cfg->regs[QPHY_SW_RESET], SW_RESET);
2617
2618         /* stop SerDes and Phy-Coding-Sublayer */
2619         qphy_clrbits(qmp->pcs, cfg->regs[QPHY_START_CTRL],
2620                         SERDES_START | PCS_START);
2621
2622         /* Put PHY into POWER DOWN state: active low */
2623         qphy_clrbits(qmp->pcs, cfg->regs[QPHY_PCS_POWER_DOWN_CONTROL],
2624                         SW_PWRDN);
2625
2626         return 0;
2627 }
2628
2629 static int qmp_combo_usb_init(struct phy *phy)
2630 {
2631         struct qmp_combo *qmp = phy_get_drvdata(phy);
2632         int ret;
2633
2634         mutex_lock(&qmp->phy_mutex);
2635         ret = qmp_combo_com_init(qmp, false);
2636         if (ret)
2637                 goto out_unlock;
2638
2639         ret = qmp_combo_usb_power_on(phy);
2640         if (ret) {
2641                 qmp_combo_com_exit(qmp, false);
2642                 goto out_unlock;
2643         }
2644
2645         qmp->usb_init_count++;
2646
2647 out_unlock:
2648         mutex_unlock(&qmp->phy_mutex);
2649         return ret;
2650 }
2651
2652 static int qmp_combo_usb_exit(struct phy *phy)
2653 {
2654         struct qmp_combo *qmp = phy_get_drvdata(phy);
2655         int ret;
2656
2657         mutex_lock(&qmp->phy_mutex);
2658         ret = qmp_combo_usb_power_off(phy);
2659         if (ret)
2660                 goto out_unlock;
2661
2662         ret = qmp_combo_com_exit(qmp, false);
2663         if (ret)
2664                 goto out_unlock;
2665
2666         qmp->usb_init_count--;
2667
2668 out_unlock:
2669         mutex_unlock(&qmp->phy_mutex);
2670         return ret;
2671 }
2672
2673 static int qmp_combo_usb_set_mode(struct phy *phy, enum phy_mode mode, int submode)
2674 {
2675         struct qmp_combo *qmp = phy_get_drvdata(phy);
2676
2677         qmp->mode = mode;
2678
2679         return 0;
2680 }
2681
2682 static const struct phy_ops qmp_combo_usb_phy_ops = {
2683         .init           = qmp_combo_usb_init,
2684         .exit           = qmp_combo_usb_exit,
2685         .set_mode       = qmp_combo_usb_set_mode,
2686         .owner          = THIS_MODULE,
2687 };
2688
2689 static const struct phy_ops qmp_combo_dp_phy_ops = {
2690         .init           = qmp_combo_dp_init,
2691         .configure      = qmp_combo_dp_configure,
2692         .power_on       = qmp_combo_dp_power_on,
2693         .calibrate      = qmp_combo_dp_calibrate,
2694         .power_off      = qmp_combo_dp_power_off,
2695         .exit           = qmp_combo_dp_exit,
2696         .owner          = THIS_MODULE,
2697 };
2698
2699 static void qmp_combo_enable_autonomous_mode(struct qmp_combo *qmp)
2700 {
2701         const struct qmp_phy_cfg *cfg = qmp->cfg;
2702         void __iomem *pcs_usb = qmp->pcs_usb ?: qmp->pcs;
2703         void __iomem *pcs_misc = qmp->pcs_misc;
2704         u32 intr_mask;
2705
2706         if (qmp->mode == PHY_MODE_USB_HOST_SS ||
2707             qmp->mode == PHY_MODE_USB_DEVICE_SS)
2708                 intr_mask = ARCVR_DTCT_EN | ALFPS_DTCT_EN;
2709         else
2710                 intr_mask = ARCVR_DTCT_EN | ARCVR_DTCT_EVENT_SEL;
2711
2712         /* Clear any pending interrupts status */
2713         qphy_setbits(pcs_usb, cfg->regs[QPHY_PCS_LFPS_RXTERM_IRQ_CLEAR], IRQ_CLEAR);
2714         /* Writing 1 followed by 0 clears the interrupt */
2715         qphy_clrbits(pcs_usb, cfg->regs[QPHY_PCS_LFPS_RXTERM_IRQ_CLEAR], IRQ_CLEAR);
2716
2717         qphy_clrbits(pcs_usb, cfg->regs[QPHY_PCS_AUTONOMOUS_MODE_CTRL],
2718                      ARCVR_DTCT_EN | ALFPS_DTCT_EN | ARCVR_DTCT_EVENT_SEL);
2719
2720         /* Enable required PHY autonomous mode interrupts */
2721         qphy_setbits(pcs_usb, cfg->regs[QPHY_PCS_AUTONOMOUS_MODE_CTRL], intr_mask);
2722
2723         /* Enable i/o clamp_n for autonomous mode */
2724         if (pcs_misc)
2725                 qphy_clrbits(pcs_misc, QPHY_V3_PCS_MISC_CLAMP_ENABLE, CLAMP_EN);
2726 }
2727
2728 static void qmp_combo_disable_autonomous_mode(struct qmp_combo *qmp)
2729 {
2730         const struct qmp_phy_cfg *cfg = qmp->cfg;
2731         void __iomem *pcs_usb = qmp->pcs_usb ?: qmp->pcs;
2732         void __iomem *pcs_misc = qmp->pcs_misc;
2733
2734         /* Disable i/o clamp_n on resume for normal mode */
2735         if (pcs_misc)
2736                 qphy_setbits(pcs_misc, QPHY_V3_PCS_MISC_CLAMP_ENABLE, CLAMP_EN);
2737
2738         qphy_clrbits(pcs_usb, cfg->regs[QPHY_PCS_AUTONOMOUS_MODE_CTRL],
2739                      ARCVR_DTCT_EN | ARCVR_DTCT_EVENT_SEL | ALFPS_DTCT_EN);
2740
2741         qphy_setbits(pcs_usb, cfg->regs[QPHY_PCS_LFPS_RXTERM_IRQ_CLEAR], IRQ_CLEAR);
2742         /* Writing 1 followed by 0 clears the interrupt */
2743         qphy_clrbits(pcs_usb, cfg->regs[QPHY_PCS_LFPS_RXTERM_IRQ_CLEAR], IRQ_CLEAR);
2744 }
2745
2746 static int __maybe_unused qmp_combo_runtime_suspend(struct device *dev)
2747 {
2748         struct qmp_combo *qmp = dev_get_drvdata(dev);
2749
2750         dev_vdbg(dev, "Suspending QMP phy, mode:%d\n", qmp->mode);
2751
2752         if (!qmp->init_count) {
2753                 dev_vdbg(dev, "PHY not initialized, bailing out\n");
2754                 return 0;
2755         }
2756
2757         qmp_combo_enable_autonomous_mode(qmp);
2758
2759         clk_disable_unprepare(qmp->pipe_clk);
2760         clk_bulk_disable_unprepare(qmp->num_clks, qmp->clks);
2761
2762         return 0;
2763 }
2764
2765 static int __maybe_unused qmp_combo_runtime_resume(struct device *dev)
2766 {
2767         struct qmp_combo *qmp = dev_get_drvdata(dev);
2768         int ret = 0;
2769
2770         dev_vdbg(dev, "Resuming QMP phy, mode:%d\n", qmp->mode);
2771
2772         if (!qmp->init_count) {
2773                 dev_vdbg(dev, "PHY not initialized, bailing out\n");
2774                 return 0;
2775         }
2776
2777         ret = clk_bulk_prepare_enable(qmp->num_clks, qmp->clks);
2778         if (ret)
2779                 return ret;
2780
2781         ret = clk_prepare_enable(qmp->pipe_clk);
2782         if (ret) {
2783                 dev_err(dev, "pipe_clk enable failed, err=%d\n", ret);
2784                 clk_bulk_disable_unprepare(qmp->num_clks, qmp->clks);
2785                 return ret;
2786         }
2787
2788         qmp_combo_disable_autonomous_mode(qmp);
2789
2790         return 0;
2791 }
2792
2793 static const struct dev_pm_ops qmp_combo_pm_ops = {
2794         SET_RUNTIME_PM_OPS(qmp_combo_runtime_suspend,
2795                            qmp_combo_runtime_resume, NULL)
2796 };
2797
2798 static int qmp_combo_vreg_init(struct qmp_combo *qmp)
2799 {
2800         const struct qmp_phy_cfg *cfg = qmp->cfg;
2801         struct device *dev = qmp->dev;
2802         int num = cfg->num_vregs;
2803         int ret, i;
2804
2805         qmp->vregs = devm_kcalloc(dev, num, sizeof(*qmp->vregs), GFP_KERNEL);
2806         if (!qmp->vregs)
2807                 return -ENOMEM;
2808
2809         for (i = 0; i < num; i++)
2810                 qmp->vregs[i].supply = cfg->vreg_list[i].name;
2811
2812         ret = devm_regulator_bulk_get(dev, num, qmp->vregs);
2813         if (ret) {
2814                 dev_err(dev, "failed at devm_regulator_bulk_get\n");
2815                 return ret;
2816         }
2817
2818         for (i = 0; i < num; i++) {
2819                 ret = regulator_set_load(qmp->vregs[i].consumer,
2820                                         cfg->vreg_list[i].enable_load);
2821                 if (ret) {
2822                         dev_err(dev, "failed to set load at %s\n",
2823                                 qmp->vregs[i].supply);
2824                         return ret;
2825                 }
2826         }
2827
2828         return 0;
2829 }
2830
2831 static int qmp_combo_reset_init(struct qmp_combo *qmp)
2832 {
2833         const struct qmp_phy_cfg *cfg = qmp->cfg;
2834         struct device *dev = qmp->dev;
2835         int i;
2836         int ret;
2837
2838         qmp->resets = devm_kcalloc(dev, cfg->num_resets,
2839                                    sizeof(*qmp->resets), GFP_KERNEL);
2840         if (!qmp->resets)
2841                 return -ENOMEM;
2842
2843         for (i = 0; i < cfg->num_resets; i++)
2844                 qmp->resets[i].id = cfg->reset_list[i];
2845
2846         ret = devm_reset_control_bulk_get_exclusive(dev, cfg->num_resets, qmp->resets);
2847         if (ret)
2848                 return dev_err_probe(dev, ret, "failed to get resets\n");
2849
2850         return 0;
2851 }
2852
2853 static int qmp_combo_clk_init(struct qmp_combo *qmp)
2854 {
2855         struct device *dev = qmp->dev;
2856         int num = ARRAY_SIZE(qmp_combo_phy_clk_l);
2857         int i;
2858
2859         qmp->clks = devm_kcalloc(dev, num, sizeof(*qmp->clks), GFP_KERNEL);
2860         if (!qmp->clks)
2861                 return -ENOMEM;
2862
2863         for (i = 0; i < num; i++)
2864                 qmp->clks[i].id = qmp_combo_phy_clk_l[i];
2865
2866         qmp->num_clks = num;
2867
2868         return devm_clk_bulk_get_optional(dev, num, qmp->clks);
2869 }
2870
2871 static void phy_clk_release_provider(void *res)
2872 {
2873         of_clk_del_provider(res);
2874 }
2875
2876 /*
2877  * Register a fixed rate pipe clock.
2878  *
2879  * The <s>_pipe_clksrc generated by PHY goes to the GCC that gate
2880  * controls it. The <s>_pipe_clk coming out of the GCC is requested
2881  * by the PHY driver for its operations.
2882  * We register the <s>_pipe_clksrc here. The gcc driver takes care
2883  * of assigning this <s>_pipe_clksrc as parent to <s>_pipe_clk.
2884  * Below picture shows this relationship.
2885  *
2886  *         +---------------+
2887  *         |   PHY block   |<<---------------------------------------+
2888  *         |               |                                         |
2889  *         |   +-------+   |                   +-----+               |
2890  *   I/P---^-->|  PLL  |---^--->pipe_clksrc--->| GCC |--->pipe_clk---+
2891  *    clk  |   +-------+   |                   +-----+
2892  *         +---------------+
2893  */
2894 static int phy_pipe_clk_register(struct qmp_combo *qmp, struct device_node *np)
2895 {
2896         struct clk_fixed_rate *fixed = &qmp->pipe_clk_fixed;
2897         struct clk_init_data init = { };
2898         char name[64];
2899
2900         snprintf(name, sizeof(name), "%s::pipe_clk", dev_name(qmp->dev));
2901         init.name = name;
2902         init.ops = &clk_fixed_rate_ops;
2903
2904         /* controllers using QMP phys use 125MHz pipe clock interface */
2905         fixed->fixed_rate = 125000000;
2906         fixed->hw.init = &init;
2907
2908         return devm_clk_hw_register(qmp->dev, &fixed->hw);
2909 }
2910
2911 /*
2912  * Display Port PLL driver block diagram for branch clocks
2913  *
2914  *              +------------------------------+
2915  *              |         DP_VCO_CLK           |
2916  *              |                              |
2917  *              |    +-------------------+     |
2918  *              |    |   (DP PLL/VCO)    |     |
2919  *              |    +---------+---------+     |
2920  *              |              v               |
2921  *              |   +----------+-----------+   |
2922  *              |   | hsclk_divsel_clk_src |   |
2923  *              |   +----------+-----------+   |
2924  *              +------------------------------+
2925  *                              |
2926  *          +---------<---------v------------>----------+
2927  *          |                                           |
2928  * +--------v----------------+                          |
2929  * |    dp_phy_pll_link_clk  |                          |
2930  * |     link_clk            |                          |
2931  * +--------+----------------+                          |
2932  *          |                                           |
2933  *          |                                           |
2934  *          v                                           v
2935  * Input to DISPCC block                                |
2936  * for link clk, crypto clk                             |
2937  * and interface clock                                  |
2938  *                                                      |
2939  *                                                      |
2940  *      +--------<------------+-----------------+---<---+
2941  *      |                     |                 |
2942  * +----v---------+  +--------v-----+  +--------v------+
2943  * | vco_divided  |  | vco_divided  |  | vco_divided   |
2944  * |    _clk_src  |  |    _clk_src  |  |    _clk_src   |
2945  * |              |  |              |  |               |
2946  * |divsel_six    |  |  divsel_two  |  |  divsel_four  |
2947  * +-------+------+  +-----+--------+  +--------+------+
2948  *         |                 |                  |
2949  *         v---->----------v-------------<------v
2950  *                         |
2951  *              +----------+-----------------+
2952  *              |   dp_phy_pll_vco_div_clk   |
2953  *              +---------+------------------+
2954  *                        |
2955  *                        v
2956  *              Input to DISPCC block
2957  *              for DP pixel clock
2958  *
2959  */
2960 static int qmp_dp_pixel_clk_determine_rate(struct clk_hw *hw, struct clk_rate_request *req)
2961 {
2962         switch (req->rate) {
2963         case 1620000000UL / 2:
2964         case 2700000000UL / 2:
2965         /* 5.4 and 8.1 GHz are same link rate as 2.7GHz, i.e. div 4 and div 6 */
2966                 return 0;
2967         default:
2968                 return -EINVAL;
2969         }
2970 }
2971
2972 static unsigned long qmp_dp_pixel_clk_recalc_rate(struct clk_hw *hw, unsigned long parent_rate)
2973 {
2974         const struct qmp_combo *qmp;
2975         const struct phy_configure_opts_dp *dp_opts;
2976
2977         qmp = container_of(hw, struct qmp_combo, dp_pixel_hw);
2978         dp_opts = &qmp->dp_opts;
2979
2980         switch (dp_opts->link_rate) {
2981         case 1620:
2982                 return 1620000000UL / 2;
2983         case 2700:
2984                 return 2700000000UL / 2;
2985         case 5400:
2986                 return 5400000000UL / 4;
2987         case 8100:
2988                 return 8100000000UL / 6;
2989         default:
2990                 return 0;
2991         }
2992 }
2993
2994 static const struct clk_ops qmp_dp_pixel_clk_ops = {
2995         .determine_rate = qmp_dp_pixel_clk_determine_rate,
2996         .recalc_rate    = qmp_dp_pixel_clk_recalc_rate,
2997 };
2998
2999 static int qmp_dp_link_clk_determine_rate(struct clk_hw *hw, struct clk_rate_request *req)
3000 {
3001         switch (req->rate) {
3002         case 162000000:
3003         case 270000000:
3004         case 540000000:
3005         case 810000000:
3006                 return 0;
3007         default:
3008                 return -EINVAL;
3009         }
3010 }
3011
3012 static unsigned long qmp_dp_link_clk_recalc_rate(struct clk_hw *hw, unsigned long parent_rate)
3013 {
3014         const struct qmp_combo *qmp;
3015         const struct phy_configure_opts_dp *dp_opts;
3016
3017         qmp = container_of(hw, struct qmp_combo, dp_link_hw);
3018         dp_opts = &qmp->dp_opts;
3019
3020         switch (dp_opts->link_rate) {
3021         case 1620:
3022         case 2700:
3023         case 5400:
3024         case 8100:
3025                 return dp_opts->link_rate * 100000;
3026         default:
3027                 return 0;
3028         }
3029 }
3030
3031 static const struct clk_ops qmp_dp_link_clk_ops = {
3032         .determine_rate = qmp_dp_link_clk_determine_rate,
3033         .recalc_rate    = qmp_dp_link_clk_recalc_rate,
3034 };
3035
3036 static struct clk_hw *qmp_dp_clks_hw_get(struct of_phandle_args *clkspec, void *data)
3037 {
3038         struct qmp_combo *qmp = data;
3039         unsigned int idx = clkspec->args[0];
3040
3041         if (idx >= 2) {
3042                 pr_err("%s: invalid index %u\n", __func__, idx);
3043                 return ERR_PTR(-EINVAL);
3044         }
3045
3046         if (idx == 0)
3047                 return &qmp->dp_link_hw;
3048
3049         return &qmp->dp_pixel_hw;
3050 }
3051
3052 static int phy_dp_clks_register(struct qmp_combo *qmp, struct device_node *np)
3053 {
3054         struct clk_init_data init = { };
3055         char name[64];
3056         int ret;
3057
3058         snprintf(name, sizeof(name), "%s::link_clk", dev_name(qmp->dev));
3059         init.ops = &qmp_dp_link_clk_ops;
3060         init.name = name;
3061         qmp->dp_link_hw.init = &init;
3062         ret = devm_clk_hw_register(qmp->dev, &qmp->dp_link_hw);
3063         if (ret)
3064                 return ret;
3065
3066         snprintf(name, sizeof(name), "%s::vco_div_clk", dev_name(qmp->dev));
3067         init.ops = &qmp_dp_pixel_clk_ops;
3068         init.name = name;
3069         qmp->dp_pixel_hw.init = &init;
3070         ret = devm_clk_hw_register(qmp->dev, &qmp->dp_pixel_hw);
3071         if (ret)
3072                 return ret;
3073
3074         return 0;
3075 }
3076
3077 static struct clk_hw *qmp_combo_clk_hw_get(struct of_phandle_args *clkspec, void *data)
3078 {
3079         struct qmp_combo *qmp = data;
3080
3081         switch (clkspec->args[0]) {
3082         case QMP_USB43DP_USB3_PIPE_CLK:
3083                 return &qmp->pipe_clk_fixed.hw;
3084         case QMP_USB43DP_DP_LINK_CLK:
3085                 return &qmp->dp_link_hw;
3086         case QMP_USB43DP_DP_VCO_DIV_CLK:
3087                 return &qmp->dp_pixel_hw;
3088         }
3089
3090         return ERR_PTR(-EINVAL);
3091 }
3092
3093 static int qmp_combo_register_clocks(struct qmp_combo *qmp, struct device_node *usb_np,
3094                                         struct device_node *dp_np)
3095 {
3096         int ret;
3097
3098         ret = phy_pipe_clk_register(qmp, usb_np);
3099         if (ret)
3100                 return ret;
3101
3102         ret = phy_dp_clks_register(qmp, dp_np);
3103         if (ret)
3104                 return ret;
3105
3106         /*
3107          * Register a single provider for bindings without child nodes.
3108          */
3109         if (usb_np == qmp->dev->of_node)
3110                 return devm_of_clk_add_hw_provider(qmp->dev, qmp_combo_clk_hw_get, qmp);
3111
3112         /*
3113          * Register multiple providers for legacy bindings with child nodes.
3114          */
3115         ret = of_clk_add_hw_provider(usb_np, of_clk_hw_simple_get,
3116                                         &qmp->pipe_clk_fixed.hw);
3117         if (ret)
3118                 return ret;
3119
3120         /*
3121          * Roll a devm action because the clock provider is the child node, but
3122          * the child node is not actually a device.
3123          */
3124         ret = devm_add_action_or_reset(qmp->dev, phy_clk_release_provider, usb_np);
3125         if (ret)
3126                 return ret;
3127
3128         ret = of_clk_add_hw_provider(dp_np, qmp_dp_clks_hw_get, qmp);
3129         if (ret)
3130                 return ret;
3131
3132         return devm_add_action_or_reset(qmp->dev, phy_clk_release_provider, dp_np);
3133 }
3134
3135 #if IS_ENABLED(CONFIG_TYPEC)
3136 static int qmp_combo_typec_switch_set(struct typec_switch_dev *sw,
3137                                       enum typec_orientation orientation)
3138 {
3139         struct qmp_combo *qmp = typec_switch_get_drvdata(sw);
3140         const struct qmp_phy_cfg *cfg = qmp->cfg;
3141
3142         if (orientation == qmp->orientation || orientation == TYPEC_ORIENTATION_NONE)
3143                 return 0;
3144
3145         mutex_lock(&qmp->phy_mutex);
3146         qmp->orientation = orientation;
3147
3148         if (qmp->init_count) {
3149                 if (qmp->usb_init_count)
3150                         qmp_combo_usb_power_off(qmp->usb_phy);
3151                 qmp_combo_com_exit(qmp, true);
3152
3153                 qmp_combo_com_init(qmp, true);
3154                 if (qmp->usb_init_count)
3155                         qmp_combo_usb_power_on(qmp->usb_phy);
3156                 if (qmp->dp_init_count)
3157                         cfg->dp_aux_init(qmp);
3158         }
3159         mutex_unlock(&qmp->phy_mutex);
3160
3161         return 0;
3162 }
3163
3164 static void qmp_combo_typec_unregister(void *data)
3165 {
3166         struct qmp_combo *qmp = data;
3167
3168         typec_switch_unregister(qmp->sw);
3169 }
3170
3171 static int qmp_combo_typec_switch_register(struct qmp_combo *qmp)
3172 {
3173         struct typec_switch_desc sw_desc = {};
3174         struct device *dev = qmp->dev;
3175
3176         sw_desc.drvdata = qmp;
3177         sw_desc.fwnode = dev->fwnode;
3178         sw_desc.set = qmp_combo_typec_switch_set;
3179         qmp->sw = typec_switch_register(dev, &sw_desc);
3180         if (IS_ERR(qmp->sw)) {
3181                 dev_err(dev, "Unable to register typec switch: %pe\n", qmp->sw);
3182                 return PTR_ERR(qmp->sw);
3183         }
3184
3185         return devm_add_action_or_reset(dev, qmp_combo_typec_unregister, qmp);
3186 }
3187 #else
3188 static int qmp_combo_typec_switch_register(struct qmp_combo *qmp)
3189 {
3190         return 0;
3191 }
3192 #endif
3193
3194 #if IS_ENABLED(CONFIG_DRM)
3195 static int qmp_combo_bridge_attach(struct drm_bridge *bridge,
3196                                    enum drm_bridge_attach_flags flags)
3197 {
3198         struct qmp_combo *qmp = container_of(bridge, struct qmp_combo, bridge);
3199         struct drm_bridge *next_bridge;
3200
3201         if (!(flags & DRM_BRIDGE_ATTACH_NO_CONNECTOR))
3202                 return -EINVAL;
3203
3204         next_bridge = devm_drm_of_get_bridge(qmp->dev, qmp->dev->of_node, 0, 0);
3205         if (IS_ERR(next_bridge)) {
3206                 dev_err(qmp->dev, "failed to acquire drm_bridge: %pe\n", next_bridge);
3207                 return PTR_ERR(next_bridge);
3208         }
3209
3210         return drm_bridge_attach(bridge->encoder, next_bridge, bridge,
3211                                  DRM_BRIDGE_ATTACH_NO_CONNECTOR);
3212 }
3213
3214 static const struct drm_bridge_funcs qmp_combo_bridge_funcs = {
3215         .attach = qmp_combo_bridge_attach,
3216 };
3217
3218 static int qmp_combo_dp_register_bridge(struct qmp_combo *qmp)
3219 {
3220         qmp->bridge.funcs = &qmp_combo_bridge_funcs;
3221         qmp->bridge.of_node = qmp->dev->of_node;
3222
3223         return devm_drm_bridge_add(qmp->dev, &qmp->bridge);
3224 }
3225 #else
3226 static int qmp_combo_dp_register_bridge(struct qmp_combo *qmp)
3227 {
3228         return 0;
3229 }
3230 #endif
3231
3232 static int qmp_combo_parse_dt_lecacy_dp(struct qmp_combo *qmp, struct device_node *np)
3233 {
3234         struct device *dev = qmp->dev;
3235
3236         /*
3237          * Get memory resources from the DP child node:
3238          * Resources are indexed as: tx -> 0; rx -> 1; pcs -> 2;
3239          * tx2 -> 3; rx2 -> 4
3240          *
3241          * Note that only tx/tx2 and pcs (dp_phy) are used by the DP
3242          * implementation.
3243          */
3244         qmp->dp_tx = devm_of_iomap(dev, np, 0, NULL);
3245         if (IS_ERR(qmp->dp_tx))
3246                 return PTR_ERR(qmp->dp_tx);
3247
3248         qmp->dp_dp_phy = devm_of_iomap(dev, np, 2, NULL);
3249         if (IS_ERR(qmp->dp_dp_phy))
3250                 return PTR_ERR(qmp->dp_dp_phy);
3251
3252         qmp->dp_tx2 = devm_of_iomap(dev, np, 3, NULL);
3253         if (IS_ERR(qmp->dp_tx2))
3254                 return PTR_ERR(qmp->dp_tx2);
3255
3256         return 0;
3257 }
3258
3259 static int qmp_combo_parse_dt_lecacy_usb(struct qmp_combo *qmp, struct device_node *np)
3260 {
3261         const struct qmp_phy_cfg *cfg = qmp->cfg;
3262         struct device *dev = qmp->dev;
3263
3264         /*
3265          * Get memory resources from the USB child node:
3266          * Resources are indexed as: tx -> 0; rx -> 1; pcs -> 2;
3267          * tx2 -> 3; rx2 -> 4; pcs_misc (optional) -> 5
3268          */
3269         qmp->tx = devm_of_iomap(dev, np, 0, NULL);
3270         if (IS_ERR(qmp->tx))
3271                 return PTR_ERR(qmp->tx);
3272
3273         qmp->rx = devm_of_iomap(dev, np, 1, NULL);
3274         if (IS_ERR(qmp->rx))
3275                 return PTR_ERR(qmp->rx);
3276
3277         qmp->pcs = devm_of_iomap(dev, np, 2, NULL);
3278         if (IS_ERR(qmp->pcs))
3279                 return PTR_ERR(qmp->pcs);
3280
3281         if (cfg->pcs_usb_offset)
3282                 qmp->pcs_usb = qmp->pcs + cfg->pcs_usb_offset;
3283
3284         qmp->tx2 = devm_of_iomap(dev, np, 3, NULL);
3285         if (IS_ERR(qmp->tx2))
3286                 return PTR_ERR(qmp->tx2);
3287
3288         qmp->rx2 = devm_of_iomap(dev, np, 4, NULL);
3289         if (IS_ERR(qmp->rx2))
3290                 return PTR_ERR(qmp->rx2);
3291
3292         qmp->pcs_misc = devm_of_iomap(dev, np, 5, NULL);
3293         if (IS_ERR(qmp->pcs_misc)) {
3294                 dev_vdbg(dev, "PHY pcs_misc-reg not used\n");
3295                 qmp->pcs_misc = NULL;
3296         }
3297
3298         qmp->pipe_clk = devm_get_clk_from_child(dev, np, NULL);
3299         if (IS_ERR(qmp->pipe_clk)) {
3300                 return dev_err_probe(dev, PTR_ERR(qmp->pipe_clk),
3301                                      "failed to get pipe clock\n");
3302         }
3303
3304         return 0;
3305 }
3306
3307 static int qmp_combo_parse_dt_legacy(struct qmp_combo *qmp, struct device_node *usb_np,
3308                                         struct device_node *dp_np)
3309 {
3310         struct platform_device *pdev = to_platform_device(qmp->dev);
3311         int ret;
3312
3313         qmp->serdes = devm_platform_ioremap_resource(pdev, 0);
3314         if (IS_ERR(qmp->serdes))
3315                 return PTR_ERR(qmp->serdes);
3316
3317         qmp->com = devm_platform_ioremap_resource(pdev, 1);
3318         if (IS_ERR(qmp->com))
3319                 return PTR_ERR(qmp->com);
3320
3321         qmp->dp_serdes = devm_platform_ioremap_resource(pdev, 2);
3322         if (IS_ERR(qmp->dp_serdes))
3323                 return PTR_ERR(qmp->dp_serdes);
3324
3325         ret = qmp_combo_parse_dt_lecacy_usb(qmp, usb_np);
3326         if (ret)
3327                 return ret;
3328
3329         ret = qmp_combo_parse_dt_lecacy_dp(qmp, dp_np);
3330         if (ret)
3331                 return ret;
3332
3333         ret = devm_clk_bulk_get_all(qmp->dev, &qmp->clks);
3334         if (ret < 0)
3335                 return ret;
3336
3337         qmp->num_clks = ret;
3338
3339         return 0;
3340 }
3341
3342 static int qmp_combo_parse_dt(struct qmp_combo *qmp)
3343 {
3344         struct platform_device *pdev = to_platform_device(qmp->dev);
3345         const struct qmp_phy_cfg *cfg = qmp->cfg;
3346         const struct qmp_combo_offsets *offs = cfg->offsets;
3347         struct device *dev = qmp->dev;
3348         void __iomem *base;
3349         int ret;
3350
3351         if (!offs)
3352                 return -EINVAL;
3353
3354         base = devm_platform_ioremap_resource(pdev, 0);
3355         if (IS_ERR(base))
3356                 return PTR_ERR(base);
3357
3358         qmp->com = base + offs->com;
3359         qmp->tx = base + offs->txa;
3360         qmp->rx = base + offs->rxa;
3361         qmp->tx2 = base + offs->txb;
3362         qmp->rx2 = base + offs->rxb;
3363
3364         qmp->serdes = base + offs->usb3_serdes;
3365         qmp->pcs_misc = base + offs->usb3_pcs_misc;
3366         qmp->pcs = base + offs->usb3_pcs;
3367         qmp->pcs_usb = base + offs->usb3_pcs_usb;
3368
3369         qmp->dp_serdes = base + offs->dp_serdes;
3370         if (offs->dp_txa) {
3371                 qmp->dp_tx = base + offs->dp_txa;
3372                 qmp->dp_tx2 = base + offs->dp_txb;
3373         } else {
3374                 qmp->dp_tx = base + offs->txa;
3375                 qmp->dp_tx2 = base + offs->txb;
3376         }
3377         qmp->dp_dp_phy = base + offs->dp_dp_phy;
3378
3379         ret = qmp_combo_clk_init(qmp);
3380         if (ret)
3381                 return ret;
3382
3383         qmp->pipe_clk = devm_clk_get(dev, "usb3_pipe");
3384         if (IS_ERR(qmp->pipe_clk)) {
3385                 return dev_err_probe(dev, PTR_ERR(qmp->pipe_clk),
3386                                 "failed to get usb3_pipe clock\n");
3387         }
3388
3389         return 0;
3390 }
3391
3392 static struct phy *qmp_combo_phy_xlate(struct device *dev, struct of_phandle_args *args)
3393 {
3394         struct qmp_combo *qmp = dev_get_drvdata(dev);
3395
3396         if (args->args_count == 0)
3397                 return ERR_PTR(-EINVAL);
3398
3399         switch (args->args[0]) {
3400         case QMP_USB43DP_USB3_PHY:
3401                 return qmp->usb_phy;
3402         case QMP_USB43DP_DP_PHY:
3403                 return qmp->dp_phy;
3404         }
3405
3406         return ERR_PTR(-EINVAL);
3407 }
3408
3409 static int qmp_combo_probe(struct platform_device *pdev)
3410 {
3411         struct qmp_combo *qmp;
3412         struct device *dev = &pdev->dev;
3413         struct device_node *dp_np, *usb_np;
3414         struct phy_provider *phy_provider;
3415         int ret;
3416
3417         qmp = devm_kzalloc(dev, sizeof(*qmp), GFP_KERNEL);
3418         if (!qmp)
3419                 return -ENOMEM;
3420
3421         qmp->dev = dev;
3422
3423         qmp->orientation = TYPEC_ORIENTATION_NORMAL;
3424
3425         qmp->cfg = of_device_get_match_data(dev);
3426         if (!qmp->cfg)
3427                 return -EINVAL;
3428
3429         mutex_init(&qmp->phy_mutex);
3430
3431         ret = qmp_combo_reset_init(qmp);
3432         if (ret)
3433                 return ret;
3434
3435         ret = qmp_combo_vreg_init(qmp);
3436         if (ret)
3437                 return ret;
3438
3439         ret = qmp_combo_typec_switch_register(qmp);
3440         if (ret)
3441                 return ret;
3442
3443         ret = qmp_combo_dp_register_bridge(qmp);
3444         if (ret)
3445                 return ret;
3446
3447         /* Check for legacy binding with child nodes. */
3448         usb_np = of_get_child_by_name(dev->of_node, "usb3-phy");
3449         if (usb_np) {
3450                 dp_np = of_get_child_by_name(dev->of_node, "dp-phy");
3451                 if (!dp_np) {
3452                         of_node_put(usb_np);
3453                         return -EINVAL;
3454                 }
3455
3456                 ret = qmp_combo_parse_dt_legacy(qmp, usb_np, dp_np);
3457         } else {
3458                 usb_np = of_node_get(dev->of_node);
3459                 dp_np = of_node_get(dev->of_node);
3460
3461                 ret = qmp_combo_parse_dt(qmp);
3462         }
3463         if (ret)
3464                 goto err_node_put;
3465
3466         pm_runtime_set_active(dev);
3467         ret = devm_pm_runtime_enable(dev);
3468         if (ret)
3469                 goto err_node_put;
3470         /*
3471          * Prevent runtime pm from being ON by default. Users can enable
3472          * it using power/control in sysfs.
3473          */
3474         pm_runtime_forbid(dev);
3475
3476         ret = qmp_combo_register_clocks(qmp, usb_np, dp_np);
3477         if (ret)
3478                 goto err_node_put;
3479
3480         qmp->usb_phy = devm_phy_create(dev, usb_np, &qmp_combo_usb_phy_ops);
3481         if (IS_ERR(qmp->usb_phy)) {
3482                 ret = PTR_ERR(qmp->usb_phy);
3483                 dev_err(dev, "failed to create USB PHY: %d\n", ret);
3484                 goto err_node_put;
3485         }
3486
3487         phy_set_drvdata(qmp->usb_phy, qmp);
3488
3489         qmp->dp_phy = devm_phy_create(dev, dp_np, &qmp_combo_dp_phy_ops);
3490         if (IS_ERR(qmp->dp_phy)) {
3491                 ret = PTR_ERR(qmp->dp_phy);
3492                 dev_err(dev, "failed to create DP PHY: %d\n", ret);
3493                 goto err_node_put;
3494         }
3495
3496         phy_set_drvdata(qmp->dp_phy, qmp);
3497
3498         dev_set_drvdata(dev, qmp);
3499
3500         if (usb_np == dev->of_node)
3501                 phy_provider = devm_of_phy_provider_register(dev, qmp_combo_phy_xlate);
3502         else
3503                 phy_provider = devm_of_phy_provider_register(dev, of_phy_simple_xlate);
3504
3505         of_node_put(usb_np);
3506         of_node_put(dp_np);
3507
3508         return PTR_ERR_OR_ZERO(phy_provider);
3509
3510 err_node_put:
3511         of_node_put(usb_np);
3512         of_node_put(dp_np);
3513         return ret;
3514 }
3515
3516 static const struct of_device_id qmp_combo_of_match_table[] = {
3517         {
3518                 .compatible = "qcom,sc7180-qmp-usb3-dp-phy",
3519                 .data = &sc7180_usb3dpphy_cfg,
3520         },
3521         {
3522                 .compatible = "qcom,sc7280-qmp-usb3-dp-phy",
3523                 .data = &sm8250_usb3dpphy_cfg,
3524         },
3525         {
3526                 .compatible = "qcom,sc8180x-qmp-usb3-dp-phy",
3527                 .data = &sc8180x_usb3dpphy_cfg,
3528         },
3529         {
3530                 .compatible = "qcom,sc8280xp-qmp-usb43dp-phy",
3531                 .data = &sc8280xp_usb43dpphy_cfg,
3532         },
3533         {
3534                 .compatible = "qcom,sdm845-qmp-usb3-dp-phy",
3535                 .data = &sdm845_usb3dpphy_cfg,
3536         },
3537         {
3538                 .compatible = "qcom,sm6350-qmp-usb3-dp-phy",
3539                 .data = &sm6350_usb3dpphy_cfg,
3540         },
3541         {
3542                 .compatible = "qcom,sm8150-qmp-usb3-dp-phy",
3543                 .data = &sc8180x_usb3dpphy_cfg,
3544         },
3545         {
3546                 .compatible = "qcom,sm8250-qmp-usb3-dp-phy",
3547                 .data = &sm8250_usb3dpphy_cfg,
3548         },
3549         {
3550                 .compatible = "qcom,sm8350-qmp-usb3-dp-phy",
3551                 .data = &sm8350_usb3dpphy_cfg,
3552         },
3553         {
3554                 .compatible = "qcom,sm8450-qmp-usb3-dp-phy",
3555                 .data = &sm8350_usb3dpphy_cfg,
3556         },
3557         {
3558                 .compatible = "qcom,sm8550-qmp-usb3-dp-phy",
3559                 .data = &sm8550_usb3dpphy_cfg,
3560         },
3561         { }
3562 };
3563 MODULE_DEVICE_TABLE(of, qmp_combo_of_match_table);
3564
3565 static struct platform_driver qmp_combo_driver = {
3566         .probe          = qmp_combo_probe,
3567         .driver = {
3568                 .name   = "qcom-qmp-combo-phy",
3569                 .pm     = &qmp_combo_pm_ops,
3570                 .of_match_table = qmp_combo_of_match_table,
3571         },
3572 };
3573
3574 module_platform_driver(qmp_combo_driver);
3575
3576 MODULE_AUTHOR("Vivek Gautam <[email protected]>");
3577 MODULE_DESCRIPTION("Qualcomm QMP USB+DP combo PHY driver");
3578 MODULE_LICENSE("GPL v2");