On Mon, Dec 16, 2024 at 11:12:18AM +0800, Damon Ding wrote:
> Add basic support for RBR/HBR/HBR2 link rates, and the voltage swing and
> pre-emphasis configurations of each link rate have been verified according
> to the eDP 1.3 requirements.
>
> Signed-off-by: Damon Ding <damon.ding@xxxxxxxxxxxxxx>
>
> ---
>
> Changes in v2:
> - Add the module author
> ---
> .../phy/rockchip/phy-rockchip-samsung-hdptx.c | 937 +++++++++++++++++-
> 1 file changed, 894 insertions(+), 43 deletions(-)
>
> diff --git a/drivers/phy/rockchip/phy-rockchip-samsung-hdptx.c b/drivers/phy/rockchip/phy-rockchip-samsung-hdptx.c
> index 9f084697dd05..8dd0de267d10 100644
> --- a/drivers/phy/rockchip/phy-rockchip-samsung-hdptx.c
> +++ b/drivers/phy/rockchip/phy-rockchip-samsung-hdptx.c
> @@ -25,6 +25,7 @@
> #define HDPTX_I_PLL_EN BIT(7)
> #define HDPTX_I_BIAS_EN BIT(6)
> #define HDPTX_I_BGR_EN BIT(5)
> +#define HDPTX_MODE_SEL BIT(0)
> #define GRF_HDPTX_STATUS 0x80
> #define HDPTX_O_PLL_LOCK_DONE BIT(3)
> #define HDPTX_O_PHY_CLK_RDY BIT(2)
> @@ -44,6 +45,7 @@
> #define LANE_REG(n) HDTPX_REG(n, 0300, 062d)
>
> /* CMN_REG(0008) */
> +#define OVRD_LCPLL_EN_MASK BIT(7)
> #define LCPLL_EN_MASK BIT(6)
> #define LCPLL_LCVCO_MODE_EN_MASK BIT(4)
> /* CMN_REG(001e) */
> @@ -61,49 +63,110 @@
> /* CMN_REG(002f) */
> #define LCPLL_SDC_DENOMINATOR_MASK GENMASK(7, 2)
> #define LCPLL_SDC_NDIV_RSTN BIT(0)
> +/* CMN_REG(003c) */
> +#define ANA_LCPLL_RESERVED7_MASK BIT(7)
> /* CMN_REG(003d) */
> +#define OVRD_ROPLL_EN_MASK BIT(7)
> +#define ROPLL_EN_MASK BIT(6)
> #define ROPLL_LCVCO_EN BIT(4)
> +/* CMN_REG(0046) */
> +#define ROPLL_ANA_CPP_CTRL_COARSE_MASK GENMASK(7, 4)
> +#define ROPLL_ANA_CPP_CTRL_FINE_MASK GENMASK(3, 0)
> +/* CMN_REG(0047) */
> +#define ROPLL_ANA_LPF_C_SEL_COARSE_MASK GENMASK(5, 3)
> +#define ROPLL_ANA_LPF_C_SEL_FINE_MASK GENMASK(2, 0)
> /* CMN_REG(004e) */
> #define ROPLL_PI_EN BIT(5)
> +/* CMN_REG(0051) */
> +#define ROPLL_PMS_MDIV_MASK GENMASK(7, 0)
> +/* CMN_REG(0055) */
> +#define ROPLL_PMS_MDIV_AFC_MASK GENMASK(7, 0)
> +/* CMN_REG(0059) */
> +#define ANA_ROPLL_PMS_PDIV_MASK GENMASK(7, 4)
> +#define ANA_ROPLL_PMS_REFDIV_MASK GENMASK(3, 0)
> +/* CMN_REG(005a) */
> +#define ROPLL_PMS_SDIV_RBR_MASK GENMASK(7, 4)
> +#define ROPLL_PMS_SDIV_HBR_MASK GENMASK(3, 0)
> +/* CMN_REG(005b) */
> +#define ROPLL_PMS_SDIV_HBR2_MASK GENMASK(7, 4)
> /* CMN_REG(005c) */
> #define ROPLL_PMS_IQDIV_RSTN BIT(5)
> /* CMN_REG(005e) */
> #define ROPLL_SDM_EN_MASK BIT(6)
> -#define ROPLL_SDM_FRAC_EN_RBR BIT(3)
> -#define ROPLL_SDM_FRAC_EN_HBR BIT(2)
> -#define ROPLL_SDM_FRAC_EN_HBR2 BIT(1)
> -#define ROPLL_SDM_FRAC_EN_HBR3 BIT(0)
You have mixed the redefinition of existing bitfields with addition of
new ones. Please split them into separate patches: one for each of
corrections (be sure to specify Fixes tag as required), one for generic
renaming and one for the new platform and new registers / new bitfields)
> +#define OVRD_ROPLL_SDM_RSTN_MASK BIT(5)
> +#define ROPLL_SDM_RSTN_MASK BIT(4)
> +#define ROPLL_SDC_FRAC_EN_RBR_MASK BIT(3)
> +#define ROPLL_SDC_FRAC_EN_HBR_MASK BIT(2)
> +#define ROPLL_SDC_FRAC_EN_HBR2_MASK BIT(1)
> +/* CMN_REG(005f) */
> +#define OVRD_ROPLL_SDC_RSTN_MASK BIT(5)
> +#define ROPLL_SDC_RSTN_MASK BIT(4)
> +/* CMN_REG(0060) */
> +#define ROPLL_SDM_DENOMINATOR_MASK GENMASK(7, 0)
> /* CMN_REG(0064) */
> #define ROPLL_SDM_NUM_SIGN_RBR_MASK BIT(3)
> +#define ROPLL_SDM_NUM_SIGN_HBR_MASK BIT(2)
> +#define ROPLL_SDM_NUM_SIGN_HBR2_MASK BIT(1)
> +/* CMN_REG(0065) */
> +#define ROPLL_SDM_NUM_MASK GENMASK(7, 0)
> /* CMN_REG(0069) */
> #define ROPLL_SDC_N_RBR_MASK GENMASK(2, 0)
> +/* CMN_REG(006a) */
> +#define ROPLL_SDC_N_HBR_MASK GENMASK(5, 3)
> +#define ROPLL_SDC_N_HBR2_MASK GENMASK(2, 0)
> +/* CMN_REG(006b) */
> +#define ROPLL_SDC_N_HBR3_MASK GENMASK(3, 1)
> +/* CMN_REG(006c) */
> +#define ROPLL_SDC_NUM_MASK GENMASK(5, 0)
> +/* cmn_reg0070 */
> +#define ROPLL_SDC_DENO_MASK GENMASK(5, 0)
> /* CMN_REG(0074) */
> -#define ROPLL_SDC_NDIV_RSTN BIT(2)
> -#define ROPLL_SSC_EN BIT(0)
> +#define OVRD_ROPLL_SDC_NDIV_RSTN_MASK BIT(3)
> +#define ROPLL_SDC_NDIV_RSTN_MASK BIT(2)
> +#define OVRD_ROPLL_SSC_EN_MASK BIT(1)
> +#define ROPLL_SSC_EN_MASK BIT(0)
> +/* CMN_REG(0075) */
> +#define ANA_ROPLL_SSC_FM_DEVIATION_MASK GENMASK(5, 0)
> +/* CMN_REG(0076) */
> +#define ANA_ROPLL_SSC_FM_FREQ_MASK GENMASK(6, 2)
> +/* CMN_REG(0077) */
> +#define ANA_ROPLL_SSC_CLK_DIV_SEL_MASK GENMASK(6, 3)
> /* CMN_REG(0081) */
> -#define OVRD_PLL_CD_CLK_EN BIT(8)
> -#define PLL_CD_HSCLK_EAST_EN BIT(0)
> +#define ANA_PLL_CD_TX_SER_RATE_SEL_MASK BIT(3)
> +#define ANA_PLL_CD_HSCLK_WEST_EN_MASK BIT(1)
> +#define ANA_PLL_CD_HSCLK_EAST_EN_MASK BIT(0)
> +/* CMN_REG(0082) */
> +#define ANA_PLL_CD_VREG_GAIN_CTRL_MASK GENMASK(3, 0)
> +/* CMN_REG(0083) */
> +#define ANA_PLL_CD_VREG_ICTRL_MASK GENMASK(6, 5)
> +/* CMN_REG(0084) */
> +#define PLL_LCRO_CLK_SEL_MASK BIT(5)
> +/* CMN_REG(0085) */
> +#define ANA_PLL_SYNC_LOSS_DET_MODE_MASK GENMASK(1, 0)
> /* CMN_REG(0086) */
> #define PLL_PCG_POSTDIV_SEL_MASK GENMASK(7, 4)
> #define PLL_PCG_CLK_SEL_MASK GENMASK(3, 1)
> #define PLL_PCG_CLK_EN BIT(0)
> /* CMN_REG(0087) */
> -#define PLL_FRL_MODE_EN BIT(3)
> -#define PLL_TX_HS_CLK_EN BIT(2)
> +#define ANA_PLL_FRL_MODE_EN_MASK BIT(3)
> +#define ANA_PLL_TX_HS_CLK_EN_MASK BIT(2)
> /* CMN_REG(0089) */
> #define LCPLL_ALONE_MODE BIT(1)
> +/* CMN_REG(0095) */
> +#define DP_TX_LINK_BW_MASK GENMASK(1, 0)
> /* CMN_REG(0097) */
> -#define DIG_CLK_SEL BIT(1)
> -#define ROPLL_REF BIT(1)
> -#define LCPLL_REF 0
> +#define DIG_CLK_SEL_MASK BIT(1)
> +#define LCPLL_REF BIT(1)
> +#define ROPLL_REF 0
> /* CMN_REG(0099) */
> +#define SSC_EN_MASK GENMASK(7, 6)
> #define CMN_ROPLL_ALONE_MODE BIT(2)
> #define ROPLL_ALONE_MODE BIT(2)
> /* CMN_REG(009a) */
> -#define HS_SPEED_SEL BIT(0)
> +#define HS_SPEED_SEL_MASK BIT(0)
> #define DIV_10_CLOCK BIT(0)
> /* CMN_REG(009b) */
> -#define IS_SPEED_SEL BIT(4)
> +#define LS_SPEED_SEL_MASK BIT(4)
> #define LINK_SYMBOL_CLOCK BIT(4)
> #define LINK_SYMBOL_CLOCK1_2 0
>
> @@ -118,6 +181,8 @@
> /* SB_REG(0104) */
> #define OVRD_SB_EN_MASK BIT(5)
> #define SB_EN_MASK BIT(4)
> +#define OVRD_SB_AUX_EN_MASK BIT(1)
> +#define SB_AUX_EN_MASK BIT(0)
> /* SB_REG(0105) */
> #define OVRD_SB_EARC_CMDC_EN_MASK BIT(6)
> #define SB_EARC_CMDC_EN_MASK BIT(5)
> @@ -126,6 +191,8 @@
> #define ANA_SB_TX_LLVL_PROG_MASK GENMASK(6, 4)
> /* SB_REG(0109) */
> #define ANA_SB_DMRX_AFC_DIV_RATIO_MASK GENMASK(2, 0)
> +/* SB_REG(010d) */
> +#define ANA_SB_DMRX_LPBK_DATA_MASK BIT(4)
> /* SB_REG(010f) */
> #define OVRD_SB_VREG_EN_MASK BIT(7)
> #define SB_VREG_EN_MASK BIT(6)
> @@ -133,6 +200,7 @@
> #define SB_VREG_LPF_BYPASS_MASK BIT(4)
> #define ANA_SB_VREG_GAIN_CTRL_MASK GENMASK(3, 0)
> /* SB_REG(0110) */
> +#define ANA_SB_VREG_OUT_SEL_MASK BIT(1)
> #define ANA_SB_VREG_REF_SEL_MASK BIT(0)
> /* SB_REG(0113) */
> #define SB_RX_RCAL_OPT_CODE_MASK GENMASK(5, 4)
> @@ -147,13 +215,24 @@
> #define AFC_RSTN_DELAY_TIME_MASK GENMASK(6, 4)
> /* SB_REG(0117) */
> #define FAST_PULSE_TIME_MASK GENMASK(3, 0)
> +/* SB_REG(0118) */
> +#define SB_TG_EARC_DMRX_RECVRD_CLK_CNT_MASK GENMASK(7, 0)
> +/* SB_REG(011a) */
> +#define SB_TG_CNT_RUN_NO_7_0_MASK GENMASK(7, 0)
> /* SB_REG(011b) */
> #define SB_EARC_SIG_DET_BYPASS_MASK BIT(4)
> #define SB_AFC_TOL_MASK GENMASK(3, 0)
> +/* SB_REG(011c) */
> +#define SB_AFC_STB_NUM_MASK GENMASK(3, 0)
> +/* SB_REG(011d) */
> +#define SB_TG_OSC_CNT_MIN_MASK GENMASK(7, 0)
> +/* SB_REG(011e) */
> +#define SB_TG_OSC_CNT_MAX_MASK GENMASK(7, 0)
> /* SB_REG(011f) */
> #define SB_PWM_AFC_CTRL_MASK GENMASK(7, 2)
> #define SB_RCAL_RSTN_MASK BIT(1)
> /* SB_REG(0120) */
> +#define SB_AUX_EN_IN_MASK BIT(7)
> #define SB_EARC_EN_MASK BIT(1)
> #define SB_EARC_AFC_EN_MASK BIT(2)
> /* SB_REG(0123) */
> @@ -165,35 +244,65 @@
> #define HDMI_MODE BIT(2)
> #define HDMI_TMDS_FRL_SEL BIT(1)
> /* LNTOP_REG(0206) */
> -#define DATA_BUS_SEL BIT(0)
> +#define DATA_BUS_WIDTH_MASK GENMASK(2, 1)
> +#define DATA_BUS_WIDTH_SEL_MASK BIT(0)
> #define DATA_BUS_36_40 BIT(0)
> /* LNTOP_REG(0207) */
> #define LANE_EN 0xf
> #define ALL_LANE_EN 0xf
>
> -/* LANE_REG(0312) */
> -#define LN0_TX_SER_RATE_SEL_RBR BIT(5)
> -#define LN0_TX_SER_RATE_SEL_HBR BIT(4)
> -#define LN0_TX_SER_RATE_SEL_HBR2 BIT(3)
> -#define LN0_TX_SER_RATE_SEL_HBR3 BIT(2)
> -/* LANE_REG(0412) */
> -#define LN1_TX_SER_RATE_SEL_RBR BIT(5)
> -#define LN1_TX_SER_RATE_SEL_HBR BIT(4)
> -#define LN1_TX_SER_RATE_SEL_HBR2 BIT(3)
> -#define LN1_TX_SER_RATE_SEL_HBR3 BIT(2)
> -/* LANE_REG(0512) */
> -#define LN2_TX_SER_RATE_SEL_RBR BIT(5)
> -#define LN2_TX_SER_RATE_SEL_HBR BIT(4)
> -#define LN2_TX_SER_RATE_SEL_HBR2 BIT(3)
> -#define LN2_TX_SER_RATE_SEL_HBR3 BIT(2)
> -/* LANE_REG(0612) */
> -#define LN3_TX_SER_RATE_SEL_RBR BIT(5)
> -#define LN3_TX_SER_RATE_SEL_HBR BIT(4)
> -#define LN3_TX_SER_RATE_SEL_HBR2 BIT(3)
> -#define LN3_TX_SER_RATE_SEL_HBR3 BIT(2)
> +/* LANE_REG(0301) */
> +#define OVRD_LN_TX_DRV_EI_EN_MASK BIT(7)
> +#define LN_TX_DRV_EI_EN_MASK BIT(6)
> +/* LANE_REG(0303) */
> +#define OVRD_LN_TX_DRV_LVL_CTRL_MASK BIT(5)
> +#define LN_TX_DRV_LVL_CTRL_MASK GENMASK(4, 0)
> +/* LANE_REG(0304) */
> +#define OVRD_LN_TX_DRV_POST_LVL_CTRL_MASK BIT(4)
> +#define LN_TX_DRV_POST_LVL_CTRL_MASK GENMASK(3, 0)
> +/* LANE_REG(0305) */
> +#define OVRD_LN_TX_DRV_PRE_LVL_CTRL_MASK BIT(6)
> +#define LN_TX_DRV_PRE_LVL_CTRL_MASK GENMASK(5, 2)
> +/* LANE_REG(0306) */
> +#define LN_ANA_TX_DRV_IDRV_IDN_CTRL_MASK GENMASK(7, 5)
> +#define LN_ANA_TX_DRV_IDRV_IUP_CTRL_MASK GENMASK(4, 2)
> +#define LN_ANA_TX_DRV_ACCDRV_EN_MASK BIT(0)
> +/* LANE_REG(0307) */
> +#define LN_ANA_TX_DRV_ACCDRV_POL_SEL_MASK BIT(6)
> +#define LN_ANA_TX_DRV_ACCDRV_CTRL_MASK GENMASK(5, 3)
> +/* LANE_REG(030a) */
> +#define LN_ANA_TX_JEQ_EN_MASK BIT(4)
> +#define LN_TX_JEQ_EVEN_CTRL_RBR_MASK GENMASK(3, 0)
> +/* LANE_REG(030b) */
> +#define LN_TX_JEQ_EVEN_CTRL_HBR_MASK GENMASK(7, 4)
> +#define LN_TX_JEQ_EVEN_CTRL_HBR2_MASK GENMASK(3, 0)
> +/* LANE_REG(030c) */
> +#define LN_TX_JEQ_ODD_CTRL_RBR_MASK GENMASK(3, 0)
> +/* LANE_REG(030d) */
> +#define LN_TX_JEQ_ODD_CTRL_HBR_MASK GENMASK(7, 4)
> +#define LN_TX_JEQ_ODD_CTRL_HBR2_MASK GENMASK(3, 0)
> +/* LANE_REG(0310) */
> +#define LN_ANA_TX_SYNC_LOSS_DET_MODE_MASK GENMASK(1, 0)
> +/* LANE_REG(0311) */
> +#define LN_TX_SER_40BIT_EN_RBR_MASK BIT(3)
> +#define LN_TX_SER_40BIT_EN_HBR_MASK BIT(2)
> +#define LN_TX_SER_40BIT_EN_HBR2_MASK BIT(1)
> +/* LANE_REG(0316) */
> +#define LN_ANA_TX_SER_VREG_GAIN_CTRL_MASK GENMASK(3, 0)
> +/* LANE_REG(031B) */
> +#define LN_ANA_TX_RESERVED_MASK GENMASK(7, 0)
> +/* LANE_REG(031e) */
> +#define LN_POLARITY_INV_MASK BIT(2)
> +#define LN_LANE_MODE_MASK BIT(1)
>
> #define HDMI20_MAX_RATE 600000000
>
> +enum dp_link_rate {
> + DP_BW_RBR,
> + DP_BW_HBR,
> + DP_BW_HBR2,
> +};
> +
> struct lcpll_config {
> u32 bit_rate;
> u8 lcvco_mode_en;
> @@ -255,6 +364,19 @@ struct ropll_config {
> u8 cd_tx_ser_rate_sel;
> };
>
> +struct tx_drv_ctrl {
> + u8 tx_drv_lvl_ctrl;
> + u8 tx_drv_post_lvl_ctrl;
> + u8 ana_tx_drv_idrv_idn_ctrl;
> + u8 ana_tx_drv_idrv_iup_ctrl;
> + u8 ana_tx_drv_accdrv_en;
> + u8 ana_tx_drv_accdrv_ctrl;
> + u8 tx_drv_pre_lvl_ctrl;
> + u8 ana_tx_jeq_en;
> + u8 tx_jeq_even_ctrl;
> + u8 tx_jeq_odd_ctrl;
> +};
> +
> enum rk_hdptx_reset {
> RST_PHY = 0,
> RST_APB,
> @@ -560,6 +682,90 @@ static const struct reg_sequence rk_hdtpx_tmds_lane_init_seq[] = {
> REG_SEQ0(LANE_REG(0606), 0x1c),
> };
>
> +static struct tx_drv_ctrl tx_drv_ctrl_rbr[4][4] = {
> + /* voltage swing 0, pre-emphasis 0->3 */
> + {
> + { 0x2, 0x0, 0x4, 0x6, 0x0, 0x4, 0x1, 0x1, 0x7, 0x7 },
> + { 0x4, 0x3, 0x4, 0x6, 0x0, 0x4, 0x0, 0x1, 0x7, 0x7 },
> + { 0x7, 0x6, 0x4, 0x6, 0x0, 0x4, 0x0, 0x1, 0x7, 0x7 },
> + { 0xd, 0xc, 0x7, 0x7, 0x1, 0x7, 0x0, 0x1, 0x7, 0x7 },
> + },
> +
> + /* voltage swing 1, pre-emphasis 0->2 */
> + {
> + { 0x4, 0x0, 0x4, 0x6, 0x0, 0x4, 0x1, 0x1, 0x7, 0x7 },
> + { 0x9, 0x5, 0x4, 0x6, 0x0, 0x4, 0x0, 0x1, 0x7, 0x7 },
> + { 0xc, 0x8, 0x7, 0x7, 0x1, 0x7, 0x0, 0x1, 0x7, 0x7 },
> + },
> +
> + /* voltage swing 2, pre-emphasis 0->1 */
> + {
> + { 0x8, 0x0, 0x4, 0x6, 0x0, 0x4, 0x1, 0x1, 0x7, 0x7 },
> + { 0xc, 0x5, 0x7, 0x7, 0x1, 0x7, 0x0, 0x1, 0x7, 0x7 },
> + },
> +
> + /* voltage swing 3, pre-emphasis 0 */
> + {
> + { 0xb, 0x0, 0x7, 0x7, 0x1, 0x4, 0x1, 0x1, 0x7, 0x7 },
> + }
> +};
> +
> +static struct tx_drv_ctrl tx_drv_ctrl_hbr[4][4] = {
> + /* voltage swing 0, pre-emphasis 0->3 */
> + {
> + { 0x2, 0x0, 0x4, 0x6, 0x0, 0x4, 0x1, 0x1, 0x7, 0x7 },
> + { 0x5, 0x4, 0x4, 0x6, 0x0, 0x4, 0x0, 0x1, 0x7, 0x7 },
> + { 0x9, 0x8, 0x4, 0x6, 0x0, 0x4, 0x0, 0x1, 0x7, 0x7 },
> + { 0xd, 0xc, 0x7, 0x7, 0x1, 0x7, 0x0, 0x1, 0x7, 0x7 },
> + },
> +
> + /* voltage swing 1, pre-emphasis 0->2 */
> + {
> + { 0x6, 0x1, 0x4, 0x6, 0x0, 0x4, 0x1, 0x1, 0x7, 0x7 },
> + { 0xa, 0x6, 0x4, 0x6, 0x0, 0x4, 0x0, 0x1, 0x7, 0x7 },
> + { 0xc, 0x8, 0x7, 0x7, 0x1, 0x7, 0x0, 0x1, 0x7, 0x7 },
> + },
> +
> + /* voltage swing 2, pre-emphasis 0->1 */
> + {
> + { 0x9, 0x1, 0x4, 0x6, 0x0, 0x4, 0x1, 0x1, 0x7, 0x7 },
> + { 0xd, 0x6, 0x7, 0x7, 0x1, 0x7, 0x0, 0x1, 0x7, 0x7 },
> + },
> +
> + /* voltage swing 3, pre-emphasis 0 */
> + {
> + { 0xc, 0x1, 0x7, 0x7, 0x1, 0x4, 0x1, 0x1, 0x7, 0x7 },
> + }
> +};
> +
> +static struct tx_drv_ctrl tx_drv_ctrl_hbr2[4][4] = {
> + /* voltage swing 0, pre-emphasis 0->3 */
> + {
> + { 0x2, 0x1, 0x4, 0x6, 0x0, 0x4, 0x0, 0x1, 0x7, 0x7 },
> + { 0x5, 0x4, 0x4, 0x6, 0x0, 0x4, 0x0, 0x1, 0x7, 0x7 },
> + { 0x9, 0x8, 0x4, 0x6, 0x1, 0x4, 0x0, 0x1, 0x7, 0x7 },
> + { 0xd, 0xc, 0x7, 0x7, 0x1, 0x7, 0x0, 0x1, 0x7, 0x7 },
> + },
> +
> + /* voltage swing 1, pre-emphasis 0->2 */
> + {
> + { 0x6, 0x1, 0x4, 0x6, 0x0, 0x4, 0x1, 0x1, 0x7, 0x7 },
> + { 0xb, 0x7, 0x4, 0x6, 0x0, 0x4, 0x0, 0x1, 0x7, 0x7 },
> + { 0xd, 0x9, 0x7, 0x7, 0x1, 0x7, 0x0, 0x1, 0x7, 0x7 },
> + },
> +
> + /* voltage swing 2, pre-emphasis 0->1 */
> + {
> + { 0x8, 0x1, 0x4, 0x6, 0x0, 0x4, 0x1, 0x1, 0x7, 0x7 },
> + { 0xc, 0x6, 0x7, 0x7, 0x1, 0x7, 0x0, 0x1, 0x7, 0x7 },
> + },
> +
> + /* voltage swing 3, pre-emphasis 0 */
> + {
> + { 0xb, 0x0, 0x7, 0x7, 0x1, 0x4, 0x1, 0x1, 0x7, 0x7 },
> + }
> +};
> +
> static bool rk_hdptx_phy_is_rw_reg(struct device *dev, unsigned int reg)
> {
> switch (reg) {
> @@ -911,11 +1117,297 @@ static int rk_hdptx_phy_consumer_put(struct rk_hdptx_phy *hdptx, bool force)
> return ret;
> }
>
> +static void rk_hdptx_dp_reset(struct rk_hdptx_phy *hdptx)
> +{
> + reset_control_assert(hdptx->rsts[RST_LANE].rstc);
> + reset_control_assert(hdptx->rsts[RST_CMN].rstc);
> + reset_control_assert(hdptx->rsts[RST_INIT].rstc);
> +
> + reset_control_assert(hdptx->rsts[RST_APB].rstc);
> + udelay(10);
> + reset_control_deassert(hdptx->rsts[RST_APB].rstc);
> +
> + regmap_update_bits(hdptx->regmap, LANE_REG(0301),
> + OVRD_LN_TX_DRV_EI_EN_MASK | LN_TX_DRV_EI_EN_MASK,
> + FIELD_PREP(OVRD_LN_TX_DRV_EI_EN_MASK, 1) |
> + FIELD_PREP(LN_TX_DRV_EI_EN_MASK, 0));
> + regmap_update_bits(hdptx->regmap, LANE_REG(0401),
> + OVRD_LN_TX_DRV_EI_EN_MASK | LN_TX_DRV_EI_EN_MASK,
> + FIELD_PREP(OVRD_LN_TX_DRV_EI_EN_MASK, 1) |
> + FIELD_PREP(LN_TX_DRV_EI_EN_MASK, 0));
> + regmap_update_bits(hdptx->regmap, LANE_REG(0501),
> + OVRD_LN_TX_DRV_EI_EN_MASK | LN_TX_DRV_EI_EN_MASK,
> + FIELD_PREP(OVRD_LN_TX_DRV_EI_EN_MASK, 1) |
> + FIELD_PREP(LN_TX_DRV_EI_EN_MASK, 0));
> + regmap_update_bits(hdptx->regmap, LANE_REG(0601),
> + OVRD_LN_TX_DRV_EI_EN_MASK | LN_TX_DRV_EI_EN_MASK,
> + FIELD_PREP(OVRD_LN_TX_DRV_EI_EN_MASK, 1) |
> + FIELD_PREP(LN_TX_DRV_EI_EN_MASK, 0));
> +
> + regmap_write(hdptx->grf, GRF_HDPTX_CON0,
> + HDPTX_I_PLL_EN << 16 | FIELD_PREP(HDPTX_I_PLL_EN, 0x0));
> + regmap_write(hdptx->grf, GRF_HDPTX_CON0,
> + HDPTX_I_BIAS_EN << 16 | FIELD_PREP(HDPTX_I_BIAS_EN, 0x0));
> + regmap_write(hdptx->grf, GRF_HDPTX_CON0,
> + HDPTX_I_BGR_EN << 16 | FIELD_PREP(HDPTX_I_BGR_EN, 0x0));
> +}
> +
> +static void rk_hdptx_dp_pll_init(struct rk_hdptx_phy *hdptx)
> +{
> + regmap_update_bits(hdptx->regmap, CMN_REG(003c), ANA_LCPLL_RESERVED7_MASK,
> + FIELD_PREP(ANA_LCPLL_RESERVED7_MASK, 0x1));
> +
> + regmap_update_bits(hdptx->regmap, CMN_REG(0046),
> + ROPLL_ANA_CPP_CTRL_COARSE_MASK | ROPLL_ANA_CPP_CTRL_FINE_MASK,
> + FIELD_PREP(ROPLL_ANA_CPP_CTRL_COARSE_MASK, 0xe) |
> + FIELD_PREP(ROPLL_ANA_CPP_CTRL_FINE_MASK, 0xe));
> + regmap_update_bits(hdptx->regmap, CMN_REG(0047),
> + ROPLL_ANA_LPF_C_SEL_COARSE_MASK |
> + ROPLL_ANA_LPF_C_SEL_FINE_MASK,
> + FIELD_PREP(ROPLL_ANA_LPF_C_SEL_COARSE_MASK, 0x4) |
> + FIELD_PREP(ROPLL_ANA_LPF_C_SEL_FINE_MASK, 0x4));
> +
> + regmap_write(hdptx->regmap, CMN_REG(0051), FIELD_PREP(ROPLL_PMS_MDIV_MASK, 0x87));
> + regmap_write(hdptx->regmap, CMN_REG(0052), FIELD_PREP(ROPLL_PMS_MDIV_MASK, 0x71));
> + regmap_write(hdptx->regmap, CMN_REG(0053), FIELD_PREP(ROPLL_PMS_MDIV_MASK, 0x71));
> +
> + regmap_write(hdptx->regmap, CMN_REG(0055),
> + FIELD_PREP(ROPLL_PMS_MDIV_AFC_MASK, 0x87));
> + regmap_write(hdptx->regmap, CMN_REG(0056),
> + FIELD_PREP(ROPLL_PMS_MDIV_AFC_MASK, 0x71));
> + regmap_write(hdptx->regmap, CMN_REG(0057),
> + FIELD_PREP(ROPLL_PMS_MDIV_AFC_MASK, 0x71));
> +
> + regmap_write(hdptx->regmap, CMN_REG(0059),
> + FIELD_PREP(ANA_ROPLL_PMS_PDIV_MASK, 0x1) |
> + FIELD_PREP(ANA_ROPLL_PMS_REFDIV_MASK, 0x1));
> + regmap_write(hdptx->regmap, CMN_REG(005a),
> + FIELD_PREP(ROPLL_PMS_SDIV_RBR_MASK, 0x3) |
> + FIELD_PREP(ROPLL_PMS_SDIV_HBR_MASK, 0x1));
> + regmap_update_bits(hdptx->regmap, CMN_REG(005b), ROPLL_PMS_SDIV_HBR2_MASK,
> + FIELD_PREP(ROPLL_PMS_SDIV_HBR2_MASK, 0x0));
> +
> + regmap_update_bits(hdptx->regmap, CMN_REG(005e), ROPLL_SDM_EN_MASK,
> + FIELD_PREP(ROPLL_SDM_EN_MASK, 0x1));
> + regmap_update_bits(hdptx->regmap, CMN_REG(005e),
> + OVRD_ROPLL_SDM_RSTN_MASK | ROPLL_SDM_RSTN_MASK,
> + FIELD_PREP(OVRD_ROPLL_SDM_RSTN_MASK, 0x1) |
> + FIELD_PREP(ROPLL_SDM_RSTN_MASK, 0x1));
> + regmap_update_bits(hdptx->regmap, CMN_REG(005e), ROPLL_SDC_FRAC_EN_RBR_MASK,
> + FIELD_PREP(ROPLL_SDC_FRAC_EN_RBR_MASK, 0x1));
> + regmap_update_bits(hdptx->regmap, CMN_REG(005e), ROPLL_SDC_FRAC_EN_HBR_MASK,
> + FIELD_PREP(ROPLL_SDC_FRAC_EN_HBR_MASK, 0x1));
> + regmap_update_bits(hdptx->regmap, CMN_REG(005e), ROPLL_SDC_FRAC_EN_HBR2_MASK,
> + FIELD_PREP(ROPLL_SDC_FRAC_EN_HBR2_MASK, 0x1));
> +
> + regmap_update_bits(hdptx->regmap, CMN_REG(005f),
> + OVRD_ROPLL_SDC_RSTN_MASK | ROPLL_SDC_RSTN_MASK,
> + FIELD_PREP(OVRD_ROPLL_SDC_RSTN_MASK, 0x1) |
> + FIELD_PREP(ROPLL_SDC_RSTN_MASK, 0x1));
> + regmap_write(hdptx->regmap, CMN_REG(0060),
> + FIELD_PREP(ROPLL_SDM_DENOMINATOR_MASK, 0x21));
> + regmap_write(hdptx->regmap, CMN_REG(0061),
> + FIELD_PREP(ROPLL_SDM_DENOMINATOR_MASK, 0x27));
> + regmap_write(hdptx->regmap, CMN_REG(0062),
> + FIELD_PREP(ROPLL_SDM_DENOMINATOR_MASK, 0x27));
> +
> + regmap_update_bits(hdptx->regmap, CMN_REG(0064),
> + ROPLL_SDM_NUM_SIGN_RBR_MASK |
> + ROPLL_SDM_NUM_SIGN_HBR_MASK |
> + ROPLL_SDM_NUM_SIGN_HBR2_MASK,
> + FIELD_PREP(ROPLL_SDM_NUM_SIGN_RBR_MASK, 0x0) |
> + FIELD_PREP(ROPLL_SDM_NUM_SIGN_HBR_MASK, 0x1) |
> + FIELD_PREP(ROPLL_SDM_NUM_SIGN_HBR2_MASK, 0x1));
> + regmap_write(hdptx->regmap, CMN_REG(0065),
> + FIELD_PREP(ROPLL_SDM_NUM_MASK, 0x0));
> + regmap_write(hdptx->regmap, CMN_REG(0066),
> + FIELD_PREP(ROPLL_SDM_NUM_MASK, 0xd));
> + regmap_write(hdptx->regmap, CMN_REG(0067),
> + FIELD_PREP(ROPLL_SDM_NUM_MASK, 0xd));
> +
> + regmap_update_bits(hdptx->regmap, CMN_REG(0069), ROPLL_SDC_N_RBR_MASK,
> + FIELD_PREP(ROPLL_SDC_N_RBR_MASK, 0x2));
> +
> + regmap_update_bits(hdptx->regmap, CMN_REG(006a),
> + ROPLL_SDC_N_HBR_MASK | ROPLL_SDC_N_HBR2_MASK,
> + FIELD_PREP(ROPLL_SDC_N_HBR_MASK, 0x1) |
> + FIELD_PREP(ROPLL_SDC_N_HBR2_MASK, 0x1));
> +
> + regmap_write(hdptx->regmap, CMN_REG(006c),
> + FIELD_PREP(ROPLL_SDC_NUM_MASK, 0x3));
> + regmap_write(hdptx->regmap, CMN_REG(006d),
> + FIELD_PREP(ROPLL_SDC_NUM_MASK, 0x7));
> + regmap_write(hdptx->regmap, CMN_REG(006e),
> + FIELD_PREP(ROPLL_SDC_NUM_MASK, 0x7));
> +
> + regmap_write(hdptx->regmap, CMN_REG(0070),
> + FIELD_PREP(ROPLL_SDC_DENO_MASK, 0x8));
> + regmap_write(hdptx->regmap, CMN_REG(0071),
> + FIELD_PREP(ROPLL_SDC_DENO_MASK, 0x18));
> + regmap_write(hdptx->regmap, CMN_REG(0072),
> + FIELD_PREP(ROPLL_SDC_DENO_MASK, 0x18));
> +
> + regmap_update_bits(hdptx->regmap, CMN_REG(0074),
> + OVRD_ROPLL_SDC_NDIV_RSTN_MASK | ROPLL_SDC_NDIV_RSTN_MASK,
> + FIELD_PREP(OVRD_ROPLL_SDC_NDIV_RSTN_MASK, 0x1) |
> + FIELD_PREP(ROPLL_SDC_NDIV_RSTN_MASK, 0x1));
> +
> + regmap_update_bits(hdptx->regmap, CMN_REG(0077), ANA_ROPLL_SSC_CLK_DIV_SEL_MASK,
> + FIELD_PREP(ANA_ROPLL_SSC_CLK_DIV_SEL_MASK, 0x1));
> +
> + regmap_update_bits(hdptx->regmap, CMN_REG(0081), ANA_PLL_CD_TX_SER_RATE_SEL_MASK,
> + FIELD_PREP(ANA_PLL_CD_TX_SER_RATE_SEL_MASK, 0x0));
> + regmap_update_bits(hdptx->regmap, CMN_REG(0081),
> + ANA_PLL_CD_HSCLK_EAST_EN_MASK | ANA_PLL_CD_HSCLK_WEST_EN_MASK,
> + FIELD_PREP(ANA_PLL_CD_HSCLK_EAST_EN_MASK, 0x1) |
> + FIELD_PREP(ANA_PLL_CD_HSCLK_WEST_EN_MASK, 0x0));
> +
> + regmap_update_bits(hdptx->regmap, CMN_REG(0082), ANA_PLL_CD_VREG_GAIN_CTRL_MASK,
> + FIELD_PREP(ANA_PLL_CD_VREG_GAIN_CTRL_MASK, 0x4));
> + regmap_update_bits(hdptx->regmap, CMN_REG(0083), ANA_PLL_CD_VREG_ICTRL_MASK,
> + FIELD_PREP(ANA_PLL_CD_VREG_ICTRL_MASK, 0x1));
> + regmap_update_bits(hdptx->regmap, CMN_REG(0084), PLL_LCRO_CLK_SEL_MASK,
> + FIELD_PREP(PLL_LCRO_CLK_SEL_MASK, 0x1));
> + regmap_update_bits(hdptx->regmap, CMN_REG(0085), ANA_PLL_SYNC_LOSS_DET_MODE_MASK,
> + FIELD_PREP(ANA_PLL_SYNC_LOSS_DET_MODE_MASK, 0x3));
> +
> + regmap_update_bits(hdptx->regmap, CMN_REG(0087), ANA_PLL_TX_HS_CLK_EN_MASK,
> + FIELD_PREP(ANA_PLL_TX_HS_CLK_EN_MASK, 0x1));
> +
> + regmap_update_bits(hdptx->regmap, CMN_REG(0097), DIG_CLK_SEL_MASK,
> + FIELD_PREP(DIG_CLK_SEL_MASK, 0x1));
> +
> + regmap_update_bits(hdptx->regmap, CMN_REG(0099), CMN_ROPLL_ALONE_MODE,
> + FIELD_PREP(CMN_ROPLL_ALONE_MODE, 0x1));
> + regmap_update_bits(hdptx->regmap, CMN_REG(009a), HS_SPEED_SEL_MASK,
> + FIELD_PREP(HS_SPEED_SEL_MASK, 0x1));
> + regmap_update_bits(hdptx->regmap, CMN_REG(009b), LS_SPEED_SEL_MASK,
> + FIELD_PREP(LS_SPEED_SEL_MASK, 0x1));
> +}
> +
> +static int rk_hdptx_dp_aux_init(struct rk_hdptx_phy *hdptx)
> +{
> + u32 status;
> + int ret;
> +
> + regmap_update_bits(hdptx->regmap, SB_REG(0102), ANA_SB_RXTERM_OFFSP_MASK,
> + FIELD_PREP(ANA_SB_RXTERM_OFFSP_MASK, 0x3));
> + regmap_update_bits(hdptx->regmap, SB_REG(0103), ANA_SB_RXTERM_OFFSN_MASK,
> + FIELD_PREP(ANA_SB_RXTERM_OFFSN_MASK, 0x3));
> + regmap_update_bits(hdptx->regmap, SB_REG(0104), SB_AUX_EN_MASK,
> + FIELD_PREP(SB_AUX_EN_MASK, 0x1));
> + regmap_update_bits(hdptx->regmap, SB_REG(0105), ANA_SB_TX_HLVL_PROG_MASK,
> + FIELD_PREP(ANA_SB_TX_HLVL_PROG_MASK, 0x7));
> + regmap_update_bits(hdptx->regmap, SB_REG(0106), ANA_SB_TX_LLVL_PROG_MASK,
> + FIELD_PREP(ANA_SB_TX_LLVL_PROG_MASK, 0x7));
> +
> + regmap_update_bits(hdptx->regmap, SB_REG(010d), ANA_SB_DMRX_LPBK_DATA_MASK,
> + FIELD_PREP(ANA_SB_DMRX_LPBK_DATA_MASK, 0x1));
> +
> + regmap_update_bits(hdptx->regmap, SB_REG(010f), ANA_SB_VREG_GAIN_CTRL_MASK,
> + FIELD_PREP(ANA_SB_VREG_GAIN_CTRL_MASK, 0x0));
> + regmap_update_bits(hdptx->regmap, SB_REG(0110),
> + ANA_SB_VREG_OUT_SEL_MASK | ANA_SB_VREG_REF_SEL_MASK,
> + FIELD_PREP(ANA_SB_VREG_OUT_SEL_MASK, 0x1) |
> + FIELD_PREP(ANA_SB_VREG_REF_SEL_MASK, 0x1));
> +
> + regmap_update_bits(hdptx->regmap, SB_REG(0113),
> + SB_RX_RCAL_OPT_CODE_MASK | SB_RX_RTERM_CTRL_MASK,
> + FIELD_PREP(SB_RX_RCAL_OPT_CODE_MASK, 0x1) |
> + FIELD_PREP(SB_RX_RTERM_CTRL_MASK, 0x3));
> + regmap_update_bits(hdptx->regmap, SB_REG(0114),
> + SB_TG_SB_EN_DELAY_TIME_MASK | SB_TG_RXTERM_EN_DELAY_TIME_MASK,
> + FIELD_PREP(SB_TG_SB_EN_DELAY_TIME_MASK, 0x2) |
> + FIELD_PREP(SB_TG_RXTERM_EN_DELAY_TIME_MASK, 0x2));
> + regmap_update_bits(hdptx->regmap, SB_REG(0115),
> + SB_READY_DELAY_TIME_MASK | SB_TG_OSC_EN_DELAY_TIME_MASK,
> + FIELD_PREP(SB_READY_DELAY_TIME_MASK, 0x2) |
> + FIELD_PREP(SB_TG_OSC_EN_DELAY_TIME_MASK, 0x2));
> + regmap_update_bits(hdptx->regmap, SB_REG(0116),
> + AFC_RSTN_DELAY_TIME_MASK,
> + FIELD_PREP(AFC_RSTN_DELAY_TIME_MASK, 0x2));
> + regmap_update_bits(hdptx->regmap, SB_REG(0117),
> + FAST_PULSE_TIME_MASK,
> + FIELD_PREP(FAST_PULSE_TIME_MASK, 0x4));
> + regmap_update_bits(hdptx->regmap, SB_REG(0118),
> + SB_TG_EARC_DMRX_RECVRD_CLK_CNT_MASK,
> + FIELD_PREP(SB_TG_EARC_DMRX_RECVRD_CLK_CNT_MASK, 0xa));
> +
> + regmap_update_bits(hdptx->regmap, SB_REG(011a), SB_TG_CNT_RUN_NO_7_0_MASK,
> + FIELD_PREP(SB_TG_CNT_RUN_NO_7_0_MASK, 0x3));
> + regmap_update_bits(hdptx->regmap, SB_REG(011b),
> + SB_EARC_SIG_DET_BYPASS_MASK | SB_AFC_TOL_MASK,
> + FIELD_PREP(SB_EARC_SIG_DET_BYPASS_MASK, 0x1) |
> + FIELD_PREP(SB_AFC_TOL_MASK, 0x3));
> + regmap_update_bits(hdptx->regmap, SB_REG(011c), SB_AFC_STB_NUM_MASK,
> + FIELD_PREP(SB_AFC_STB_NUM_MASK, 0x4));
> + regmap_update_bits(hdptx->regmap, SB_REG(011d), SB_TG_OSC_CNT_MIN_MASK,
> + FIELD_PREP(SB_TG_OSC_CNT_MIN_MASK, 0x67));
> + regmap_update_bits(hdptx->regmap, SB_REG(011e), SB_TG_OSC_CNT_MAX_MASK,
> + FIELD_PREP(SB_TG_OSC_CNT_MAX_MASK, 0x6a));
> + regmap_update_bits(hdptx->regmap, SB_REG(011f), SB_PWM_AFC_CTRL_MASK,
> + FIELD_PREP(SB_PWM_AFC_CTRL_MASK, 0x5));
> + regmap_update_bits(hdptx->regmap, SB_REG(011f), SB_RCAL_RSTN_MASK,
> + FIELD_PREP(SB_RCAL_RSTN_MASK, 0x1));
> + regmap_update_bits(hdptx->regmap, SB_REG(0120), SB_AUX_EN_IN_MASK,
> + FIELD_PREP(SB_AUX_EN_IN_MASK, 0x1));
> +
> + regmap_update_bits(hdptx->regmap, SB_REG(0102), OVRD_SB_RXTERM_EN_MASK,
> + FIELD_PREP(OVRD_SB_RXTERM_EN_MASK, 0x1));
> + regmap_update_bits(hdptx->regmap, SB_REG(0103), OVRD_SB_RX_RESCAL_DONE_MASK,
> + FIELD_PREP(OVRD_SB_RX_RESCAL_DONE_MASK, 0x1));
> + regmap_update_bits(hdptx->regmap, SB_REG(0104), OVRD_SB_EN_MASK,
> + FIELD_PREP(OVRD_SB_EN_MASK, 0x1));
> + regmap_update_bits(hdptx->regmap, SB_REG(0104), OVRD_SB_AUX_EN_MASK,
> + FIELD_PREP(OVRD_SB_AUX_EN_MASK, 0x1));
> +
> + regmap_update_bits(hdptx->regmap, SB_REG(010f), OVRD_SB_VREG_EN_MASK,
> + FIELD_PREP(OVRD_SB_VREG_EN_MASK, 0x1));
> +
> + regmap_write(hdptx->grf, GRF_HDPTX_CON0,
> + HDPTX_I_BGR_EN << 16 | FIELD_PREP(HDPTX_I_BGR_EN, 0x1));
> + regmap_write(hdptx->grf, GRF_HDPTX_CON0,
> + HDPTX_I_BIAS_EN << 16 | FIELD_PREP(HDPTX_I_BIAS_EN, 0x1));
> + usleep_range(20, 25);
> +
> + reset_control_deassert(hdptx->rsts[RST_INIT].rstc);
> + usleep_range(20, 25);
> + reset_control_deassert(hdptx->rsts[RST_CMN].rstc);
> + usleep_range(20, 25);
> +
> + regmap_update_bits(hdptx->regmap, SB_REG(0103), OVRD_SB_RX_RESCAL_DONE_MASK,
> + FIELD_PREP(OVRD_SB_RX_RESCAL_DONE_MASK, 0x1));
> + usleep_range(100, 110);
> + regmap_update_bits(hdptx->regmap, SB_REG(0104), SB_EN_MASK,
> + FIELD_PREP(SB_EN_MASK, 0x1));
> + usleep_range(100, 110);
> + regmap_update_bits(hdptx->regmap, SB_REG(0102), SB_RXTERM_EN_MASK,
> + FIELD_PREP(SB_RXTERM_EN_MASK, 0x1));
> + usleep_range(20, 25);
> + regmap_update_bits(hdptx->regmap, SB_REG(010f), SB_VREG_EN_MASK,
> + FIELD_PREP(SB_VREG_EN_MASK, 0x1));
> + usleep_range(20, 25);
> + regmap_update_bits(hdptx->regmap, SB_REG(0104), SB_AUX_EN_MASK,
> + FIELD_PREP(SB_AUX_EN_MASK, 0x1));
> + usleep_range(100, 110);
> +
> + ret = regmap_read_poll_timeout(hdptx->grf, GRF_HDPTX_STATUS,
> + status, FIELD_GET(HDPTX_O_SB_RDY, status),
> + 50, 1000);
> + if (ret) {
> + dev_err(hdptx->dev, "Failed to get phy sb ready: %d\n", ret);
> + return ret;
> + }
> +
> + return 0;
> +}
> +
> static int rk_hdptx_phy_power_on(struct phy *phy)
> {
> struct rk_hdptx_phy *hdptx = phy_get_drvdata(phy);
> int bus_width = phy_get_bus_width(hdptx->phy);
> - int ret;
> + enum phy_mode mode = phy_get_mode(phy);
> + int ret, lane;
>
> /*
> * FIXME: Temporary workaround to pass pixel_clk_rate
> @@ -927,13 +1419,43 @@ static int rk_hdptx_phy_power_on(struct phy *phy)
> dev_dbg(hdptx->dev, "%s bus_width=%x rate=%u\n",
> __func__, bus_width, rate);
>
> - ret = rk_hdptx_phy_consumer_get(hdptx, rate);
> - if (ret)
> - return ret;
> + if (mode == PHY_MODE_DP) {
> + rk_hdptx_dp_reset(hdptx);
>
> - ret = rk_hdptx_ropll_tmds_mode_config(hdptx, rate);
> - if (ret)
> - rk_hdptx_phy_consumer_put(hdptx, true);
> + for (lane = 0; lane < 4; lane++) {
> + regmap_update_bits(hdptx->regmap, LANE_REG(031e) + 0x400 * lane,
> + LN_POLARITY_INV_MASK | LN_LANE_MODE_MASK,
> + FIELD_PREP(LN_POLARITY_INV_MASK, 0) |
> + FIELD_PREP(LN_LANE_MODE_MASK, 1));
> + }
> +
> + regmap_write(hdptx->grf, GRF_HDPTX_CON0,
> + HDPTX_MODE_SEL << 16 | FIELD_PREP(HDPTX_MODE_SEL, 0x1));
> +
> + regmap_update_bits(hdptx->regmap, LNTOP_REG(0200), PROTOCOL_SEL,
> + FIELD_PREP(PROTOCOL_SEL, 0x0));
> + regmap_update_bits(hdptx->regmap, LNTOP_REG(0206), DATA_BUS_WIDTH_MASK,
> + FIELD_PREP(DATA_BUS_WIDTH_MASK, 0x1));
> + regmap_update_bits(hdptx->regmap, LNTOP_REG(0206), DATA_BUS_WIDTH_SEL_MASK,
> + FIELD_PREP(DATA_BUS_WIDTH_SEL_MASK, 0x0));
> +
> + rk_hdptx_dp_pll_init(hdptx);
> +
> + ret = rk_hdptx_dp_aux_init(hdptx);
> + if (ret)
> + pm_runtime_put(hdptx->dev);
> + } else {
> + regmap_write(hdptx->grf, GRF_HDPTX_CON0,
> + HDPTX_MODE_SEL << 16 | FIELD_PREP(HDPTX_MODE_SEL, 0x0));
> +
> + ret = rk_hdptx_phy_consumer_get(hdptx, rate);
> + if (ret)
> + return ret;
> +
> + ret = rk_hdptx_ropll_tmds_mode_config(hdptx, rate);
> + if (ret)
> + rk_hdptx_phy_consumer_put(hdptx, true);
> + }
>
> return ret;
> }
> @@ -945,9 +1467,337 @@ static int rk_hdptx_phy_power_off(struct phy *phy)
> return rk_hdptx_phy_consumer_put(hdptx, false);
> }
>
> +static int rk_hdptx_phy_set_mode(struct phy *phy, enum phy_mode mode,
> + int submode)
> +{
> + return 0;
> +}
> +
> +static int rk_hdptx_phy_verify_config(struct rk_hdptx_phy *hdptx,
> + struct phy_configure_opts_dp *dp)
> +{
> + int i;
> +
> + if (dp->set_rate) {
> + switch (dp->link_rate) {
> + case 1620:
> + case 2700:
> + case 5400:
> + break;
> + default:
> + return -EINVAL;
> + }
> + }
> +
> + if (dp->set_lanes) {
> + switch (dp->lanes) {
> + case 0:
> + case 1:
> + case 2:
> + case 4:
> + break;
> + default:
> + return -EINVAL;
> + }
> + }
> +
> + if (dp->set_voltages) {
> + for (i = 0; i < dp->lanes; i++) {
> + if (dp->voltage[i] > 3 || dp->pre[i] > 3)
> + return -EINVAL;
> +
> + if (dp->voltage[i] + dp->pre[i] > 3)
> + return -EINVAL;
> + }
> + }
> +
> + return 0;
> +}
> +
> +static int rk_hdptx_phy_set_rate(struct rk_hdptx_phy *hdptx,
> + struct phy_configure_opts_dp *dp)
> +{
> + u32 bw, status;
> + int ret;
> +
> + regmap_write(hdptx->grf, GRF_HDPTX_CON0,
> + HDPTX_I_PLL_EN << 16 | FIELD_PREP(HDPTX_I_PLL_EN, 0x0));
> +
> + switch (dp->link_rate) {
> + case 1620:
> + bw = DP_BW_RBR;
> + break;
> + case 2700:
> + bw = DP_BW_HBR;
> + break;
> + case 5400:
> + bw = DP_BW_HBR2;
> + break;
> + default:
> + return -EINVAL;
> + }
> +
> + regmap_update_bits(hdptx->regmap, CMN_REG(0008), OVRD_LCPLL_EN_MASK | LCPLL_EN_MASK,
> + FIELD_PREP(OVRD_LCPLL_EN_MASK, 0x1) |
> + FIELD_PREP(LCPLL_EN_MASK, 0x0));
> +
> + regmap_update_bits(hdptx->regmap, CMN_REG(003d), OVRD_ROPLL_EN_MASK | ROPLL_EN_MASK,
> + FIELD_PREP(OVRD_ROPLL_EN_MASK, 0x1) |
> + FIELD_PREP(ROPLL_EN_MASK, 0x1));
> +
> + if (dp->ssc) {
> + regmap_update_bits(hdptx->regmap, CMN_REG(0074),
> + OVRD_ROPLL_SSC_EN_MASK | ROPLL_SSC_EN_MASK,
> + FIELD_PREP(OVRD_ROPLL_SSC_EN_MASK, 0x1) |
> + FIELD_PREP(ROPLL_SSC_EN_MASK, 0x1));
> + regmap_write(hdptx->regmap, CMN_REG(0075),
> + FIELD_PREP(ANA_ROPLL_SSC_FM_DEVIATION_MASK, 0xc));
> + regmap_update_bits(hdptx->regmap, CMN_REG(0076),
> + ANA_ROPLL_SSC_FM_FREQ_MASK,
> + FIELD_PREP(ANA_ROPLL_SSC_FM_FREQ_MASK, 0x1f));
> +
> + regmap_update_bits(hdptx->regmap, CMN_REG(0099), SSC_EN_MASK,
> + FIELD_PREP(SSC_EN_MASK, 0x2));
> + } else {
> + regmap_update_bits(hdptx->regmap, CMN_REG(0074),
> + OVRD_ROPLL_SSC_EN_MASK | ROPLL_SSC_EN_MASK,
> + FIELD_PREP(OVRD_ROPLL_SSC_EN_MASK, 0x1) |
> + FIELD_PREP(ROPLL_SSC_EN_MASK, 0x0));
> + regmap_write(hdptx->regmap, CMN_REG(0075),
> + FIELD_PREP(ANA_ROPLL_SSC_FM_DEVIATION_MASK, 0x20));
> + regmap_update_bits(hdptx->regmap, CMN_REG(0076),
> + ANA_ROPLL_SSC_FM_FREQ_MASK,
> + FIELD_PREP(ANA_ROPLL_SSC_FM_FREQ_MASK, 0xc));
> +
> + regmap_update_bits(hdptx->regmap, CMN_REG(0099), SSC_EN_MASK,
> + FIELD_PREP(SSC_EN_MASK, 0x0));
> + }
> +
> + regmap_update_bits(hdptx->regmap, CMN_REG(0095), DP_TX_LINK_BW_MASK,
> + FIELD_PREP(DP_TX_LINK_BW_MASK, bw));
> +
> + regmap_write(hdptx->grf, GRF_HDPTX_CON0,
> + HDPTX_I_PLL_EN << 16 | FIELD_PREP(HDPTX_I_PLL_EN, 0x1));
> +
> + ret = regmap_read_poll_timeout(hdptx->grf, GRF_HDPTX_STATUS,
> + status, FIELD_GET(HDPTX_O_PLL_LOCK_DONE, status),
> + 50, 1000);
> + if (ret) {
> + dev_err(hdptx->dev, "Failed to get phy pll lock: %d\n", ret);
> + return ret;
> + }
> +
> + return 0;
> +}
> +
> +static void rk_hdptx_phy_lane_disable(struct rk_hdptx_phy *hdptx)
> +{
> + reset_control_assert(hdptx->rsts[RST_LANE].rstc);
> +
> + regmap_update_bits(hdptx->regmap, LNTOP_REG(0207), LANE_EN,
> + FIELD_PREP(LANE_EN, 0x0));
> +
> + regmap_write(hdptx->grf, GRF_HDPTX_CON0,
> + HDPTX_I_PLL_EN << 16 | FIELD_PREP(HDPTX_I_PLL_EN, 0x0));
> +
> + regmap_update_bits(hdptx->regmap, CMN_REG(0008), OVRD_LCPLL_EN_MASK | LCPLL_EN_MASK,
> + FIELD_PREP(OVRD_LCPLL_EN_MASK, 0x1) |
> + FIELD_PREP(LCPLL_EN_MASK, 0x0));
> +
> + regmap_update_bits(hdptx->regmap, CMN_REG(003d), OVRD_ROPLL_EN_MASK | ROPLL_EN_MASK,
> + FIELD_PREP(OVRD_ROPLL_EN_MASK, 0x1) |
> + FIELD_PREP(ROPLL_EN_MASK, 0x0));
> +}
> +
> +static int rk_hdptx_phy_set_lanes(struct rk_hdptx_phy *hdptx,
> + struct phy_configure_opts_dp *dp)
> +{
> + if (!dp->lanes) {
> + rk_hdptx_phy_lane_disable(hdptx);
> + return 0;
> + }
> +
> + regmap_update_bits(hdptx->regmap, LNTOP_REG(0207), LANE_EN,
> + FIELD_PREP(LANE_EN, GENMASK(dp->lanes - 1, 0)));
> +
> + return 0;
> +}
> +
> +static void rk_hdptx_phy_set_voltage(struct rk_hdptx_phy *hdptx,
> + struct phy_configure_opts_dp *dp,
> + u8 lane)
> +{
> + const struct tx_drv_ctrl *ctrl;
> + u32 offset = lane * 0x400;
> +
> + switch (dp->link_rate) {
> + case 1620:
> + ctrl = &tx_drv_ctrl_rbr[dp->voltage[lane]][dp->pre[lane]];
> + regmap_update_bits(hdptx->regmap, LANE_REG(030a) + offset,
> + LN_TX_JEQ_EVEN_CTRL_RBR_MASK,
> + FIELD_PREP(LN_TX_JEQ_EVEN_CTRL_RBR_MASK,
> + ctrl->tx_jeq_even_ctrl));
> + regmap_update_bits(hdptx->regmap, LANE_REG(030c) + offset,
> + LN_TX_JEQ_ODD_CTRL_RBR_MASK,
> + FIELD_PREP(LN_TX_JEQ_ODD_CTRL_RBR_MASK,
> + ctrl->tx_jeq_odd_ctrl));
> + regmap_update_bits(hdptx->regmap, LANE_REG(0311) + offset,
> + LN_TX_SER_40BIT_EN_RBR_MASK,
> + FIELD_PREP(LN_TX_SER_40BIT_EN_RBR_MASK, 0x1));
> + break;
> + case 2700:
> + ctrl = &tx_drv_ctrl_hbr[dp->voltage[lane]][dp->pre[lane]];
> + regmap_update_bits(hdptx->regmap, LANE_REG(030b) + offset,
> + LN_TX_JEQ_EVEN_CTRL_HBR_MASK,
> + FIELD_PREP(LN_TX_JEQ_EVEN_CTRL_HBR_MASK,
> + ctrl->tx_jeq_even_ctrl));
> + regmap_update_bits(hdptx->regmap, LANE_REG(030d) + offset,
> + LN_TX_JEQ_ODD_CTRL_HBR_MASK,
> + FIELD_PREP(LN_TX_JEQ_ODD_CTRL_HBR_MASK,
> + ctrl->tx_jeq_odd_ctrl));
> + regmap_update_bits(hdptx->regmap, LANE_REG(0311) + offset,
> + LN_TX_SER_40BIT_EN_HBR_MASK,
> + FIELD_PREP(LN_TX_SER_40BIT_EN_HBR_MASK, 0x1));
> + break;
> + case 5400:
> + default:
> + ctrl = &tx_drv_ctrl_hbr2[dp->voltage[lane]][dp->pre[lane]];
> + regmap_update_bits(hdptx->regmap, LANE_REG(030b) + offset,
> + LN_TX_JEQ_EVEN_CTRL_HBR2_MASK,
> + FIELD_PREP(LN_TX_JEQ_EVEN_CTRL_HBR2_MASK,
> + ctrl->tx_jeq_even_ctrl));
> + regmap_update_bits(hdptx->regmap, LANE_REG(030d) + offset,
> + LN_TX_JEQ_ODD_CTRL_HBR2_MASK,
> + FIELD_PREP(LN_TX_JEQ_ODD_CTRL_HBR2_MASK,
> + ctrl->tx_jeq_odd_ctrl));
> + regmap_update_bits(hdptx->regmap, LANE_REG(0311) + offset,
> + LN_TX_SER_40BIT_EN_HBR2_MASK,
> + FIELD_PREP(LN_TX_SER_40BIT_EN_HBR2_MASK, 0x1));
> + break;
> + }
> +
> + regmap_update_bits(hdptx->regmap, LANE_REG(0303) + offset,
> + OVRD_LN_TX_DRV_LVL_CTRL_MASK | LN_TX_DRV_LVL_CTRL_MASK,
> + FIELD_PREP(OVRD_LN_TX_DRV_LVL_CTRL_MASK, 0x1) |
> + FIELD_PREP(LN_TX_DRV_LVL_CTRL_MASK,
> + ctrl->tx_drv_lvl_ctrl));
> + regmap_update_bits(hdptx->regmap, LANE_REG(0304) + offset,
> + OVRD_LN_TX_DRV_POST_LVL_CTRL_MASK |
> + LN_TX_DRV_POST_LVL_CTRL_MASK,
> + FIELD_PREP(OVRD_LN_TX_DRV_POST_LVL_CTRL_MASK, 0x1) |
> + FIELD_PREP(LN_TX_DRV_POST_LVL_CTRL_MASK,
> + ctrl->tx_drv_post_lvl_ctrl));
> + regmap_update_bits(hdptx->regmap, LANE_REG(0305) + offset,
> + OVRD_LN_TX_DRV_PRE_LVL_CTRL_MASK |
> + LN_TX_DRV_PRE_LVL_CTRL_MASK,
> + FIELD_PREP(OVRD_LN_TX_DRV_PRE_LVL_CTRL_MASK, 0x1) |
> + FIELD_PREP(LN_TX_DRV_PRE_LVL_CTRL_MASK,
> + ctrl->tx_drv_pre_lvl_ctrl));
> + regmap_update_bits(hdptx->regmap, LANE_REG(0306) + offset,
> + LN_ANA_TX_DRV_IDRV_IDN_CTRL_MASK |
> + LN_ANA_TX_DRV_IDRV_IUP_CTRL_MASK |
> + LN_ANA_TX_DRV_ACCDRV_EN_MASK,
> + FIELD_PREP(LN_ANA_TX_DRV_IDRV_IDN_CTRL_MASK,
> + ctrl->ana_tx_drv_idrv_idn_ctrl) |
> + FIELD_PREP(LN_ANA_TX_DRV_IDRV_IUP_CTRL_MASK,
> + ctrl->ana_tx_drv_idrv_iup_ctrl) |
> + FIELD_PREP(LN_ANA_TX_DRV_ACCDRV_EN_MASK,
> + ctrl->ana_tx_drv_accdrv_en));
> + regmap_update_bits(hdptx->regmap, LANE_REG(0307) + offset,
> + LN_ANA_TX_DRV_ACCDRV_POL_SEL_MASK |
> + LN_ANA_TX_DRV_ACCDRV_CTRL_MASK,
> + FIELD_PREP(LN_ANA_TX_DRV_ACCDRV_POL_SEL_MASK, 0x1) |
> + FIELD_PREP(LN_ANA_TX_DRV_ACCDRV_CTRL_MASK,
> + ctrl->ana_tx_drv_accdrv_ctrl));
> +
> + regmap_update_bits(hdptx->regmap, LANE_REG(030a) + offset,
> + LN_ANA_TX_JEQ_EN_MASK,
> + FIELD_PREP(LN_ANA_TX_JEQ_EN_MASK, ctrl->ana_tx_jeq_en));
> +
> + regmap_update_bits(hdptx->regmap, LANE_REG(0310) + offset,
> + LN_ANA_TX_SYNC_LOSS_DET_MODE_MASK,
> + FIELD_PREP(LN_ANA_TX_SYNC_LOSS_DET_MODE_MASK, 0x3));
> +
> + regmap_update_bits(hdptx->regmap, LANE_REG(0316) + offset,
> + LN_ANA_TX_SER_VREG_GAIN_CTRL_MASK,
> + FIELD_PREP(LN_ANA_TX_SER_VREG_GAIN_CTRL_MASK, 0x2));
> +
> + regmap_update_bits(hdptx->regmap, LANE_REG(031b) + offset,
> + LN_ANA_TX_RESERVED_MASK,
> + FIELD_PREP(LN_ANA_TX_RESERVED_MASK, 0x1));
> +}
> +
> +static int rk_hdptx_phy_set_voltages(struct rk_hdptx_phy *hdptx,
> + struct phy_configure_opts_dp *dp)
> +{
> + u8 lane;
> + u32 status;
> + int ret;
> +
> + for (lane = 0; lane < dp->lanes; lane++)
> + rk_hdptx_phy_set_voltage(hdptx, dp, lane);
> +
> + reset_control_deassert(hdptx->rsts[RST_LANE].rstc);
> +
> + ret = regmap_read_poll_timeout(hdptx->grf, GRF_HDPTX_STATUS,
> + status, FIELD_GET(HDPTX_O_PHY_RDY, status),
> + 50, 5000);
> + if (ret) {
> + dev_err(hdptx->dev, "Failed to get phy ready: %d\n", ret);
> + return ret;
> + }
> +
> + return 0;
> +}
> +
> +static int rk_hdptx_phy_configure(struct phy *phy, union phy_configure_opts *opts)
> +{
> + struct rk_hdptx_phy *hdptx = phy_get_drvdata(phy);
> + enum phy_mode mode = phy_get_mode(phy);
> + int ret;
> +
> + if (mode != PHY_MODE_DP)
> + return -EINVAL;
> +
> + ret = rk_hdptx_phy_verify_config(hdptx, &opts->dp);
> + if (ret) {
> + dev_err(hdptx->dev, "invalid params for phy configure\n");
> + return ret;
> + }
> +
> + if (opts->dp.set_rate) {
> + ret = rk_hdptx_phy_set_rate(hdptx, &opts->dp);
> + if (ret) {
> + dev_err(hdptx->dev, "failed to set rate: %d\n", ret);
> + return ret;
> + }
> + }
> +
> + if (opts->dp.set_lanes) {
> + ret = rk_hdptx_phy_set_lanes(hdptx, &opts->dp);
> + if (ret) {
> + dev_err(hdptx->dev, "failed to set lanes: %d\n", ret);
> + return ret;
> + }
> + }
> +
> + if (opts->dp.set_voltages) {
> + ret = rk_hdptx_phy_set_voltages(hdptx, &opts->dp);
> + if (ret) {
> + dev_err(hdptx->dev, "failed to set voltages: %d\n",
> + ret);
> + return ret;
> + }
> + }
> +
> + return 0;
> +}
> +
> static const struct phy_ops rk_hdptx_phy_ops = {
> .power_on = rk_hdptx_phy_power_on,
> .power_off = rk_hdptx_phy_power_off,
> + .set_mode = rk_hdptx_phy_set_mode,
> + .configure = rk_hdptx_phy_configure,
> .owner = THIS_MODULE,
> };
>
> @@ -1164,5 +2014,6 @@ module_platform_driver(rk_hdptx_phy_driver);
>
> MODULE_AUTHOR("Algea Cao <algea.cao@xxxxxxxxxxxxxx>");
> MODULE_AUTHOR("Cristian Ciocaltea <cristian.ciocaltea@xxxxxxxxxxxxx>");
> +MODULE_AUTHOR("Damon Ding <damon.ding@xxxxxxxxxxxxxx>");
> MODULE_DESCRIPTION("Samsung HDMI/eDP Transmitter Combo PHY Driver");
> MODULE_LICENSE("GPL");
> --
> 2.34.1
>
--
With best wishes
Dmitry
