// SPDX-License-Identifier: GPL-2.0 /* * Copyright (c) 2017, 2020, The Linux Foundation. All rights reserved. * Copyright (c) 2021, Linaro Ltd. */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include "phy-qcom-qmp-dp-phy.h" #include "phy-qcom-qmp-qserdes-com-v4.h" #include "phy-qcom-qmp-qserdes-com-v6.h" /* EDP_PHY registers */ #define DP_PHY_CFG 0x0010 #define DP_PHY_CFG_1 0x0014 #define DP_PHY_PD_CTL 0x001c #define DP_PHY_MODE 0x0020 #define DP_PHY_AUX_CFG0 0x0024 #define DP_PHY_AUX_CFG1 0x0028 #define DP_PHY_AUX_CFG2 0x002C #define DP_PHY_AUX_CFG3 0x0030 #define DP_PHY_AUX_CFG4 0x0034 #define DP_PHY_AUX_CFG5 0x0038 #define DP_PHY_AUX_CFG6 0x003C #define DP_PHY_AUX_CFG7 0x0040 #define DP_PHY_AUX_CFG8 0x0044 #define DP_PHY_AUX_CFG9 0x0048 #define DP_PHY_AUX_INTERRUPT_MASK 0x0058 #define DP_PHY_VCO_DIV 0x0074 #define DP_PHY_TX0_TX1_LANE_CTL 0x007c #define DP_PHY_TX2_TX3_LANE_CTL 0x00a0 #define DP_PHY_STATUS 0x00e0 /* LANE_TXn registers */ #define TXn_CLKBUF_ENABLE 0x0000 #define TXn_TX_EMP_POST1_LVL 0x0004 #define TXn_TX_DRV_LVL 0x0014 #define TXn_TX_DRV_LVL_OFFSET 0x0018 #define TXn_RESET_TSYNC_EN 0x001c #define TXn_LDO_CONFIG 0x0084 #define TXn_TX_BAND 0x0028 #define TXn_RES_CODE_LANE_OFFSET_TX0 0x0044 #define TXn_RES_CODE_LANE_OFFSET_TX1 0x0048 #define TXn_TRANSCEIVER_BIAS_EN 0x0054 #define TXn_HIGHZ_DRVR_EN 0x0058 #define TXn_TX_POL_INV 0x005c #define TXn_LANE_MODE_1 0x0064 #define TXn_TRAN_DRVR_EMP_EN 0x0078 struct qcom_edp_swing_pre_emph_cfg { const u8 (*swing_hbr_rbr)[4][4]; const u8 (*swing_hbr3_hbr2)[4][4]; const u8 (*pre_emphasis_hbr_rbr)[4][4]; const u8 (*pre_emphasis_hbr3_hbr2)[4][4]; }; struct qcom_edp; struct phy_ver_ops { int (*com_power_on)(const struct qcom_edp *edp); int (*com_resetsm_cntrl)(const struct qcom_edp *edp); int (*com_bias_en_clkbuflr)(const struct qcom_edp *edp); int (*com_configure_pll)(const struct qcom_edp *edp); int (*com_configure_ssc)(const struct qcom_edp *edp); }; struct qcom_edp_phy_cfg { bool is_edp; const struct qcom_edp_swing_pre_emph_cfg *swing_pre_emph_cfg; const struct phy_ver_ops *ver_ops; }; struct qcom_edp { struct device *dev; const struct qcom_edp_phy_cfg *cfg; struct phy *phy; void __iomem *edp; void __iomem *tx0; void __iomem *tx1; void __iomem *pll; struct clk_hw dp_link_hw; struct clk_hw dp_pixel_hw; struct phy_configure_opts_dp dp_opts; struct clk_bulk_data clks[2]; struct regulator_bulk_data supplies[2]; bool is_edp; }; static const u8 dp_swing_hbr_rbr[4][4] = { { 0x08, 0x0f, 0x16, 0x1f }, { 0x11, 0x1e, 0x1f, 0xff }, { 0x16, 0x1f, 0xff, 0xff }, { 0x1f, 0xff, 0xff, 0xff } }; static const u8 dp_pre_emp_hbr_rbr[4][4] = { { 0x00, 0x0d, 0x14, 0x1a }, { 0x00, 0x0e, 0x15, 0xff }, { 0x00, 0x0e, 0xff, 0xff }, { 0x03, 0xff, 0xff, 0xff } }; static const u8 dp_swing_hbr2_hbr3[4][4] = { { 0x02, 0x12, 0x16, 0x1a }, { 0x09, 0x19, 0x1f, 0xff }, { 0x10, 0x1f, 0xff, 0xff }, { 0x1f, 0xff, 0xff, 0xff } }; static const u8 dp_pre_emp_hbr2_hbr3[4][4] = { { 0x00, 0x0c, 0x15, 0x1b }, { 0x02, 0x0e, 0x16, 0xff }, { 0x02, 0x11, 0xff, 0xff }, { 0x04, 0xff, 0xff, 0xff } }; static const struct qcom_edp_swing_pre_emph_cfg dp_phy_swing_pre_emph_cfg = { .swing_hbr_rbr = &dp_swing_hbr_rbr, .swing_hbr3_hbr2 = &dp_swing_hbr2_hbr3, .pre_emphasis_hbr_rbr = &dp_pre_emp_hbr_rbr, .pre_emphasis_hbr3_hbr2 = &dp_pre_emp_hbr2_hbr3, }; static const u8 edp_swing_hbr_rbr[4][4] = { { 0x07, 0x0f, 0x16, 0x1f }, { 0x0d, 0x16, 0x1e, 0xff }, { 0x11, 0x1b, 0xff, 0xff }, { 0x16, 0xff, 0xff, 0xff } }; static const u8 edp_pre_emp_hbr_rbr[4][4] = { { 0x05, 0x12, 0x17, 0x1d }, { 0x05, 0x11, 0x18, 0xff }, { 0x06, 0x11, 0xff, 0xff }, { 0x00, 0xff, 0xff, 0xff } }; static const u8 edp_swing_hbr2_hbr3[4][4] = { { 0x0b, 0x11, 0x17, 0x1c }, { 0x10, 0x19, 0x1f, 0xff }, { 0x19, 0x1f, 0xff, 0xff }, { 0x1f, 0xff, 0xff, 0xff } }; static const u8 edp_pre_emp_hbr2_hbr3[4][4] = { { 0x08, 0x11, 0x17, 0x1b }, { 0x00, 0x0c, 0x13, 0xff }, { 0x05, 0x10, 0xff, 0xff }, { 0x00, 0xff, 0xff, 0xff } }; static const struct qcom_edp_swing_pre_emph_cfg edp_phy_swing_pre_emph_cfg = { .swing_hbr_rbr = &edp_swing_hbr_rbr, .swing_hbr3_hbr2 = &edp_swing_hbr2_hbr3, .pre_emphasis_hbr_rbr = &edp_pre_emp_hbr_rbr, .pre_emphasis_hbr3_hbr2 = &edp_pre_emp_hbr2_hbr3, }; static int qcom_edp_phy_init(struct phy *phy) { struct qcom_edp *edp = phy_get_drvdata(phy); int ret; u8 cfg8; ret = regulator_bulk_enable(ARRAY_SIZE(edp->supplies), edp->supplies); if (ret) return ret; ret = clk_bulk_prepare_enable(ARRAY_SIZE(edp->clks), edp->clks); if (ret) goto out_disable_supplies; writel(DP_PHY_PD_CTL_PWRDN | DP_PHY_PD_CTL_AUX_PWRDN | DP_PHY_PD_CTL_PLL_PWRDN | DP_PHY_PD_CTL_DP_CLAMP_EN, edp->edp + DP_PHY_PD_CTL); ret = edp->cfg->ver_ops->com_bias_en_clkbuflr(edp); if (ret) return ret; writel(DP_PHY_PD_CTL_PSR_PWRDN, edp->edp + DP_PHY_PD_CTL); msleep(20); writel(DP_PHY_PD_CTL_PWRDN | DP_PHY_PD_CTL_AUX_PWRDN | DP_PHY_PD_CTL_LANE_0_1_PWRDN | DP_PHY_PD_CTL_LANE_2_3_PWRDN | DP_PHY_PD_CTL_PLL_PWRDN | DP_PHY_PD_CTL_DP_CLAMP_EN, edp->edp + DP_PHY_PD_CTL); /* * TODO: Re-work the conditions around setting the cfg8 value * when more information becomes available about why this is * even needed. */ if (edp->cfg->swing_pre_emph_cfg && !edp->is_edp) cfg8 = 0xb7; else cfg8 = 0x37; writel(0xfc, edp->edp + DP_PHY_MODE); writel(0x00, edp->edp + DP_PHY_AUX_CFG0); writel(0x13, edp->edp + DP_PHY_AUX_CFG1); writel(0x24, edp->edp + DP_PHY_AUX_CFG2); writel(0x00, edp->edp + DP_PHY_AUX_CFG3); writel(0x0a, edp->edp + DP_PHY_AUX_CFG4); writel(0x26, edp->edp + DP_PHY_AUX_CFG5); writel(0x0a, edp->edp + DP_PHY_AUX_CFG6); writel(0x03, edp->edp + DP_PHY_AUX_CFG7); writel(cfg8, edp->edp + DP_PHY_AUX_CFG8); writel(0x03, edp->edp + DP_PHY_AUX_CFG9); writel(PHY_AUX_STOP_ERR_MASK | PHY_AUX_DEC_ERR_MASK | PHY_AUX_SYNC_ERR_MASK | PHY_AUX_ALIGN_ERR_MASK | PHY_AUX_REQ_ERR_MASK, edp->edp + DP_PHY_AUX_INTERRUPT_MASK); msleep(20); return 0; out_disable_supplies: regulator_bulk_disable(ARRAY_SIZE(edp->supplies), edp->supplies); return ret; } static int qcom_edp_set_voltages(struct qcom_edp *edp, const struct phy_configure_opts_dp *dp_opts) { const struct qcom_edp_swing_pre_emph_cfg *cfg = edp->cfg->swing_pre_emph_cfg; unsigned int v_level = 0; unsigned int p_level = 0; u8 ldo_config; u8 swing; u8 emph; int i; if (!cfg) return 0; if (edp->is_edp) cfg = &edp_phy_swing_pre_emph_cfg; for (i = 0; i < dp_opts->lanes; i++) { v_level = max(v_level, dp_opts->voltage[i]); p_level = max(p_level, dp_opts->pre[i]); } if (dp_opts->link_rate <= 2700) { swing = (*cfg->swing_hbr_rbr)[v_level][p_level]; emph = (*cfg->pre_emphasis_hbr_rbr)[v_level][p_level]; } else { swing = (*cfg->swing_hbr3_hbr2)[v_level][p_level]; emph = (*cfg->pre_emphasis_hbr3_hbr2)[v_level][p_level]; } if (swing == 0xff || emph == 0xff) return -EINVAL; ldo_config = edp->is_edp ? 0x0 : 0x1; writel(ldo_config, edp->tx0 + TXn_LDO_CONFIG); writel(swing, edp->tx0 + TXn_TX_DRV_LVL); writel(emph, edp->tx0 + TXn_TX_EMP_POST1_LVL); writel(ldo_config, edp->tx1 + TXn_LDO_CONFIG); writel(swing, edp->tx1 + TXn_TX_DRV_LVL); writel(emph, edp->tx1 + TXn_TX_EMP_POST1_LVL); return 0; } static int qcom_edp_phy_configure(struct phy *phy, union phy_configure_opts *opts) { const struct phy_configure_opts_dp *dp_opts = &opts->dp; struct qcom_edp *edp = phy_get_drvdata(phy); int ret = 0; memcpy(&edp->dp_opts, dp_opts, sizeof(*dp_opts)); if (dp_opts->set_voltages) ret = qcom_edp_set_voltages(edp, dp_opts); return ret; } static int qcom_edp_configure_ssc(const struct qcom_edp *edp) { return edp->cfg->ver_ops->com_configure_ssc(edp); } static int qcom_edp_configure_pll(const struct qcom_edp *edp) { return edp->cfg->ver_ops->com_configure_pll(edp); } static int qcom_edp_set_vco_div(const struct qcom_edp *edp, unsigned long *pixel_freq) { const struct phy_configure_opts_dp *dp_opts = &edp->dp_opts; u32 vco_div; switch (dp_opts->link_rate) { case 1620: vco_div = 0x1; *pixel_freq = 1620000000UL / 2; break; case 2700: vco_div = 0x1; *pixel_freq = 2700000000UL / 2; break; case 5400: vco_div = 0x2; *pixel_freq = 5400000000UL / 4; break; case 8100: vco_div = 0x0; *pixel_freq = 8100000000UL / 6; break; default: /* Other link rates aren't supported */ return -EINVAL; } writel(vco_div, edp->edp + DP_PHY_VCO_DIV); return 0; } static int qcom_edp_phy_power_on_v4(const struct qcom_edp *edp) { u32 val; writel(DP_PHY_PD_CTL_PWRDN | DP_PHY_PD_CTL_AUX_PWRDN | DP_PHY_PD_CTL_LANE_0_1_PWRDN | DP_PHY_PD_CTL_LANE_2_3_PWRDN | DP_PHY_PD_CTL_PLL_PWRDN | DP_PHY_PD_CTL_DP_CLAMP_EN, edp->edp + DP_PHY_PD_CTL); writel(0xfc, edp->edp + DP_PHY_MODE); return readl_poll_timeout(edp->pll + QSERDES_V4_COM_CMN_STATUS, val, val & BIT(7), 5, 200); } static int qcom_edp_phy_com_resetsm_cntrl_v4(const struct qcom_edp *edp) { u32 val; writel(0x20, edp->pll + QSERDES_V4_COM_RESETSM_CNTRL); return readl_poll_timeout(edp->pll + QSERDES_V4_COM_C_READY_STATUS, val, val & BIT(0), 500, 10000); } static int qcom_edp_com_bias_en_clkbuflr_v4(const struct qcom_edp *edp) { /* Turn on BIAS current for PHY/PLL */ writel(0x17, edp->pll + QSERDES_V4_COM_BIAS_EN_CLKBUFLR_EN); return 0; } static int qcom_edp_com_configure_ssc_v4(const struct qcom_edp *edp) { const struct phy_configure_opts_dp *dp_opts = &edp->dp_opts; u32 step1; u32 step2; switch (dp_opts->link_rate) { case 1620: case 2700: case 8100: step1 = 0x45; step2 = 0x06; break; case 5400: step1 = 0x5c; step2 = 0x08; break; default: /* Other link rates aren't supported */ return -EINVAL; } writel(0x01, edp->pll + QSERDES_V4_COM_SSC_EN_CENTER); writel(0x00, edp->pll + QSERDES_V4_COM_SSC_ADJ_PER1); writel(0x36, edp->pll + QSERDES_V4_COM_SSC_PER1); writel(0x01, edp->pll + QSERDES_V4_COM_SSC_PER2); writel(step1, edp->pll + QSERDES_V4_COM_SSC_STEP_SIZE1_MODE0); writel(step2, edp->pll + QSERDES_V4_COM_SSC_STEP_SIZE2_MODE0); return 0; } static int qcom_edp_com_configure_pll_v4(const struct qcom_edp *edp) { const struct phy_configure_opts_dp *dp_opts = &edp->dp_opts; u32 div_frac_start2_mode0; u32 div_frac_start3_mode0; u32 dec_start_mode0; u32 lock_cmp1_mode0; u32 lock_cmp2_mode0; u32 hsclk_sel; switch (dp_opts->link_rate) { case 1620: hsclk_sel = 0x5; dec_start_mode0 = 0x69; div_frac_start2_mode0 = 0x80; div_frac_start3_mode0 = 0x07; lock_cmp1_mode0 = 0x6f; lock_cmp2_mode0 = 0x08; break; case 2700: hsclk_sel = 0x3; dec_start_mode0 = 0x69; div_frac_start2_mode0 = 0x80; div_frac_start3_mode0 = 0x07; lock_cmp1_mode0 = 0x0f; lock_cmp2_mode0 = 0x0e; break; case 5400: hsclk_sel = 0x1; dec_start_mode0 = 0x8c; div_frac_start2_mode0 = 0x00; div_frac_start3_mode0 = 0x0a; lock_cmp1_mode0 = 0x1f; lock_cmp2_mode0 = 0x1c; break; case 8100: hsclk_sel = 0x0; dec_start_mode0 = 0x69; div_frac_start2_mode0 = 0x80; div_frac_start3_mode0 = 0x07; lock_cmp1_mode0 = 0x2f; lock_cmp2_mode0 = 0x2a; break; default: /* Other link rates aren't supported */ return -EINVAL; } writel(0x01, edp->pll + QSERDES_V4_COM_SVS_MODE_CLK_SEL); writel(0x0b, edp->pll + QSERDES_V4_COM_SYSCLK_EN_SEL); writel(0x02, edp->pll + QSERDES_V4_COM_SYS_CLK_CTRL); writel(0x0c, edp->pll + QSERDES_V4_COM_CLK_ENABLE1); writel(0x06, edp->pll + QSERDES_V4_COM_SYSCLK_BUF_ENABLE); writel(0x30, edp->pll + QSERDES_V4_COM_CLK_SELECT); writel(hsclk_sel, edp->pll + QSERDES_V4_COM_HSCLK_SEL); writel(0x0f, edp->pll + QSERDES_V4_COM_PLL_IVCO); writel(0x08, edp->pll + QSERDES_V4_COM_LOCK_CMP_EN); writel(0x36, edp->pll + QSERDES_V4_COM_PLL_CCTRL_MODE0); writel(0x16, edp->pll + QSERDES_V4_COM_PLL_RCTRL_MODE0); writel(0x06, edp->pll + QSERDES_V4_COM_CP_CTRL_MODE0); writel(dec_start_mode0, edp->pll + QSERDES_V4_COM_DEC_START_MODE0); writel(0x00, edp->pll + QSERDES_V4_COM_DIV_FRAC_START1_MODE0); writel(div_frac_start2_mode0, edp->pll + QSERDES_V4_COM_DIV_FRAC_START2_MODE0); writel(div_frac_start3_mode0, edp->pll + QSERDES_V4_COM_DIV_FRAC_START3_MODE0); writel(0x02, edp->pll + QSERDES_V4_COM_CMN_CONFIG); writel(0x3f, edp->pll + QSERDES_V4_COM_INTEGLOOP_GAIN0_MODE0); writel(0x00, edp->pll + QSERDES_V4_COM_INTEGLOOP_GAIN1_MODE0); writel(0x00, edp->pll + QSERDES_V4_COM_VCO_TUNE_MAP); writel(lock_cmp1_mode0, edp->pll + QSERDES_V4_COM_LOCK_CMP1_MODE0); writel(lock_cmp2_mode0, edp->pll + QSERDES_V4_COM_LOCK_CMP2_MODE0); writel(0x0a, edp->pll + QSERDES_V4_COM_BG_TIMER); writel(0x14, edp->pll + QSERDES_V4_COM_CORECLK_DIV_MODE0); writel(0x00, edp->pll + QSERDES_V4_COM_VCO_TUNE_CTRL); writel(0x17, edp->pll + QSERDES_V4_COM_BIAS_EN_CLKBUFLR_EN); writel(0x0f, edp->pll + QSERDES_V4_COM_CORE_CLK_EN); writel(0xa0, edp->pll + QSERDES_V4_COM_VCO_TUNE1_MODE0); writel(0x03, edp->pll + QSERDES_V4_COM_VCO_TUNE2_MODE0); return 0; } static const struct phy_ver_ops qcom_edp_phy_ops_v4 = { .com_power_on = qcom_edp_phy_power_on_v4, .com_resetsm_cntrl = qcom_edp_phy_com_resetsm_cntrl_v4, .com_bias_en_clkbuflr = qcom_edp_com_bias_en_clkbuflr_v4, .com_configure_pll = qcom_edp_com_configure_pll_v4, .com_configure_ssc = qcom_edp_com_configure_ssc_v4, }; static const struct qcom_edp_phy_cfg sc7280_dp_phy_cfg = { .ver_ops = &qcom_edp_phy_ops_v4, }; static const struct qcom_edp_phy_cfg sc8280xp_dp_phy_cfg = { .swing_pre_emph_cfg = &dp_phy_swing_pre_emph_cfg, .ver_ops = &qcom_edp_phy_ops_v4, }; static const struct qcom_edp_phy_cfg sc8280xp_edp_phy_cfg = { .is_edp = true, .swing_pre_emph_cfg = &edp_phy_swing_pre_emph_cfg, .ver_ops = &qcom_edp_phy_ops_v4, }; static int qcom_edp_phy_power_on_v6(const struct qcom_edp *edp) { u32 val; writel(DP_PHY_PD_CTL_PWRDN | DP_PHY_PD_CTL_AUX_PWRDN | DP_PHY_PD_CTL_LANE_0_1_PWRDN | DP_PHY_PD_CTL_LANE_2_3_PWRDN | DP_PHY_PD_CTL_PLL_PWRDN | DP_PHY_PD_CTL_DP_CLAMP_EN, edp->edp + DP_PHY_PD_CTL); writel(0xfc, edp->edp + DP_PHY_MODE); return readl_poll_timeout(edp->pll + QSERDES_V6_COM_CMN_STATUS, val, val & BIT(7), 5, 200); } static int qcom_edp_phy_com_resetsm_cntrl_v6(const struct qcom_edp *edp) { u32 val; writel(0x20, edp->pll + QSERDES_V6_COM_RESETSM_CNTRL); return readl_poll_timeout(edp->pll + QSERDES_V6_COM_C_READY_STATUS, val, val & BIT(0), 500, 10000); } static int qcom_edp_com_bias_en_clkbuflr_v6(const struct qcom_edp *edp) { /* Turn on BIAS current for PHY/PLL */ writel(0x1f, edp->pll + QSERDES_V6_COM_PLL_BIAS_EN_CLK_BUFLR_EN); return 0; } static int qcom_edp_com_configure_ssc_v6(const struct qcom_edp *edp) { const struct phy_configure_opts_dp *dp_opts = &edp->dp_opts; u32 step1; u32 step2; switch (dp_opts->link_rate) { case 1620: case 2700: case 8100: step1 = 0x92; step2 = 0x01; break; case 5400: step1 = 0x18; step2 = 0x02; break; default: /* Other link rates aren't supported */ return -EINVAL; } writel(0x01, edp->pll + QSERDES_V6_COM_SSC_EN_CENTER); writel(0x00, edp->pll + QSERDES_V6_COM_SSC_ADJ_PER1); writel(0x36, edp->pll + QSERDES_V6_COM_SSC_PER1); writel(0x01, edp->pll + QSERDES_V6_COM_SSC_PER2); writel(step1, edp->pll + QSERDES_V6_COM_SSC_STEP_SIZE1_MODE0); writel(step2, edp->pll + QSERDES_V6_COM_SSC_STEP_SIZE2_MODE0); return 0; } static int qcom_edp_com_configure_pll_v6(const struct qcom_edp *edp) { const struct phy_configure_opts_dp *dp_opts = &edp->dp_opts; u32 div_frac_start2_mode0; u32 div_frac_start3_mode0; u32 dec_start_mode0; u32 lock_cmp1_mode0; u32 lock_cmp2_mode0; u32 code1_mode0; u32 code2_mode0; u32 hsclk_sel; switch (dp_opts->link_rate) { case 1620: hsclk_sel = 0x5; dec_start_mode0 = 0x34; div_frac_start2_mode0 = 0xc0; div_frac_start3_mode0 = 0x0b; lock_cmp1_mode0 = 0x37; lock_cmp2_mode0 = 0x04; code1_mode0 = 0x71; code2_mode0 = 0x0c; break; case 2700: hsclk_sel = 0x3; dec_start_mode0 = 0x34; div_frac_start2_mode0 = 0xc0; div_frac_start3_mode0 = 0x0b; lock_cmp1_mode0 = 0x07; lock_cmp2_mode0 = 0x07; code1_mode0 = 0x71; code2_mode0 = 0x0c; break; case 5400: hsclk_sel = 0x1; dec_start_mode0 = 0x46; div_frac_start2_mode0 = 0x00; div_frac_start3_mode0 = 0x05; lock_cmp1_mode0 = 0x0f; lock_cmp2_mode0 = 0x0e; code1_mode0 = 0x97; code2_mode0 = 0x10; break; case 8100: hsclk_sel = 0x0; dec_start_mode0 = 0x34; div_frac_start2_mode0 = 0xc0; div_frac_start3_mode0 = 0x0b; lock_cmp1_mode0 = 0x17; lock_cmp2_mode0 = 0x15; code1_mode0 = 0x71; code2_mode0 = 0x0c; break; default: /* Other link rates aren't supported */ return -EINVAL; } writel(0x01, edp->pll + QSERDES_V6_COM_SVS_MODE_CLK_SEL); writel(0x0b, edp->pll + QSERDES_V6_COM_SYSCLK_EN_SEL); writel(0x02, edp->pll + QSERDES_V6_COM_SYS_CLK_CTRL); writel(0x0c, edp->pll + QSERDES_V6_COM_CLK_ENABLE1); writel(0x06, edp->pll + QSERDES_V6_COM_SYSCLK_BUF_ENABLE); writel(0x30, edp->pll + QSERDES_V6_COM_CLK_SELECT); writel(hsclk_sel, edp->pll + QSERDES_V6_COM_HSCLK_SEL_1); writel(0x07, edp->pll + QSERDES_V6_COM_PLL_IVCO); writel(0x08, edp->pll + QSERDES_V6_COM_LOCK_CMP_EN); writel(0x36, edp->pll + QSERDES_V6_COM_PLL_CCTRL_MODE0); writel(0x16, edp->pll + QSERDES_V6_COM_PLL_RCTRL_MODE0); writel(0x06, edp->pll + QSERDES_V6_COM_CP_CTRL_MODE0); writel(dec_start_mode0, edp->pll + QSERDES_V6_COM_DEC_START_MODE0); writel(0x00, edp->pll + QSERDES_V6_COM_DIV_FRAC_START1_MODE0); writel(div_frac_start2_mode0, edp->pll + QSERDES_V6_COM_DIV_FRAC_START2_MODE0); writel(div_frac_start3_mode0, edp->pll + QSERDES_V6_COM_DIV_FRAC_START3_MODE0); writel(0x12, edp->pll + QSERDES_V6_COM_CMN_CONFIG_1); writel(0x3f, edp->pll + QSERDES_V6_COM_INTEGLOOP_GAIN0_MODE0); writel(0x00, edp->pll + QSERDES_V6_COM_INTEGLOOP_GAIN1_MODE0); writel(0x00, edp->pll + QSERDES_V6_COM_VCO_TUNE_MAP); writel(lock_cmp1_mode0, edp->pll + QSERDES_V6_COM_LOCK_CMP1_MODE0); writel(lock_cmp2_mode0, edp->pll + QSERDES_V6_COM_LOCK_CMP2_MODE0); writel(0x0a, edp->pll + QSERDES_V6_COM_BG_TIMER); writel(0x14, edp->pll + QSERDES_V6_COM_PLL_CORE_CLK_DIV_MODE0); writel(0x00, edp->pll + QSERDES_V6_COM_VCO_TUNE_CTRL); writel(0x1f, edp->pll + QSERDES_V6_COM_PLL_BIAS_EN_CLK_BUFLR_EN); writel(0x0f, edp->pll + QSERDES_V6_COM_CORE_CLK_EN); writel(0xa0, edp->pll + QSERDES_V6_COM_VCO_TUNE1_MODE0); writel(0x03, edp->pll + QSERDES_V6_COM_VCO_TUNE2_MODE0); writel(code1_mode0, edp->pll + QSERDES_V6_COM_BIN_VCOCAL_CMP_CODE1_MODE0); writel(code2_mode0, edp->pll + QSERDES_V6_COM_BIN_VCOCAL_CMP_CODE2_MODE0); return 0; } static const struct phy_ver_ops qcom_edp_phy_ops_v6 = { .com_power_on = qcom_edp_phy_power_on_v6, .com_resetsm_cntrl = qcom_edp_phy_com_resetsm_cntrl_v6, .com_bias_en_clkbuflr = qcom_edp_com_bias_en_clkbuflr_v6, .com_configure_pll = qcom_edp_com_configure_pll_v6, .com_configure_ssc = qcom_edp_com_configure_ssc_v6, }; static struct qcom_edp_phy_cfg x1e80100_phy_cfg = { .swing_pre_emph_cfg = &dp_phy_swing_pre_emph_cfg, .ver_ops = &qcom_edp_phy_ops_v6, }; static int qcom_edp_phy_power_on(struct phy *phy) { const struct qcom_edp *edp = phy_get_drvdata(phy); u32 bias0_en, drvr0_en, bias1_en, drvr1_en; unsigned long pixel_freq; u8 ldo_config = 0x0; int ret; u32 val; u8 cfg1; ret = edp->cfg->ver_ops->com_power_on(edp); if (ret) return ret; if (edp->cfg->swing_pre_emph_cfg && !edp->is_edp) ldo_config = 0x1; writel(ldo_config, edp->tx0 + TXn_LDO_CONFIG); writel(ldo_config, edp->tx1 + TXn_LDO_CONFIG); writel(0x00, edp->tx0 + TXn_LANE_MODE_1); writel(0x00, edp->tx1 + TXn_LANE_MODE_1); if (edp->dp_opts.ssc) { ret = qcom_edp_configure_ssc(edp); if (ret) return ret; } ret = qcom_edp_configure_pll(edp); if (ret) return ret; /* TX Lane configuration */ writel(0x05, edp->edp + DP_PHY_TX0_TX1_LANE_CTL); writel(0x05, edp->edp + DP_PHY_TX2_TX3_LANE_CTL); /* TX-0 register configuration */ writel(0x03, edp->tx0 + TXn_TRANSCEIVER_BIAS_EN); writel(0x0f, edp->tx0 + TXn_CLKBUF_ENABLE); writel(0x03, edp->tx0 + TXn_RESET_TSYNC_EN); writel(0x01, edp->tx0 + TXn_TRAN_DRVR_EMP_EN); writel(0x04, edp->tx0 + TXn_TX_BAND); /* TX-1 register configuration */ writel(0x03, edp->tx1 + TXn_TRANSCEIVER_BIAS_EN); writel(0x0f, edp->tx1 + TXn_CLKBUF_ENABLE); writel(0x03, edp->tx1 + TXn_RESET_TSYNC_EN); writel(0x01, edp->tx1 + TXn_TRAN_DRVR_EMP_EN); writel(0x04, edp->tx1 + TXn_TX_BAND); ret = qcom_edp_set_vco_div(edp, &pixel_freq); if (ret) return ret; writel(0x01, edp->edp + DP_PHY_CFG); writel(0x05, edp->edp + DP_PHY_CFG); writel(0x01, edp->edp + DP_PHY_CFG); writel(0x09, edp->edp + DP_PHY_CFG); ret = edp->cfg->ver_ops->com_resetsm_cntrl(edp); if (ret) return ret; writel(0x19, edp->edp + DP_PHY_CFG); writel(0x1f, edp->tx0 + TXn_HIGHZ_DRVR_EN); writel(0x04, edp->tx0 + TXn_HIGHZ_DRVR_EN); writel(0x00, edp->tx0 + TXn_TX_POL_INV); writel(0x1f, edp->tx1 + TXn_HIGHZ_DRVR_EN); writel(0x04, edp->tx1 + TXn_HIGHZ_DRVR_EN); writel(0x00, edp->tx1 + TXn_TX_POL_INV); writel(0x10, edp->tx0 + TXn_TX_DRV_LVL_OFFSET); writel(0x10, edp->tx1 + TXn_TX_DRV_LVL_OFFSET); writel(0x11, edp->tx0 + TXn_RES_CODE_LANE_OFFSET_TX0); writel(0x11, edp->tx0 + TXn_RES_CODE_LANE_OFFSET_TX1); writel(0x11, edp->tx1 + TXn_RES_CODE_LANE_OFFSET_TX0); writel(0x11, edp->tx1 + TXn_RES_CODE_LANE_OFFSET_TX1); writel(0x10, edp->tx0 + TXn_TX_EMP_POST1_LVL); writel(0x10, edp->tx1 + TXn_TX_EMP_POST1_LVL); writel(0x1f, edp->tx0 + TXn_TX_DRV_LVL); writel(0x1f, edp->tx1 + TXn_TX_DRV_LVL); if (edp->dp_opts.lanes == 1) { bias0_en = 0x01; bias1_en = 0x00; drvr0_en = 0x06; drvr1_en = 0x07; cfg1 = 0x1; } else if (edp->dp_opts.lanes == 2) { bias0_en = 0x03; bias1_en = 0x00; drvr0_en = 0x04; drvr1_en = 0x07; cfg1 = 0x3; } else { bias0_en = 0x03; bias1_en = 0x03; drvr0_en = 0x04; drvr1_en = 0x04; cfg1 = 0xf; } writel(drvr0_en, edp->tx0 + TXn_HIGHZ_DRVR_EN); writel(bias0_en, edp->tx0 + TXn_TRANSCEIVER_BIAS_EN); writel(drvr1_en, edp->tx1 + TXn_HIGHZ_DRVR_EN); writel(bias1_en, edp->tx1 + TXn_TRANSCEIVER_BIAS_EN); writel(cfg1, edp->edp + DP_PHY_CFG_1); writel(0x18, edp->edp + DP_PHY_CFG); usleep_range(100, 1000); writel(0x19, edp->edp + DP_PHY_CFG); ret = readl_poll_timeout(edp->edp + DP_PHY_STATUS, val, val & BIT(1), 500, 10000); if (ret) return ret; clk_set_rate(edp->dp_link_hw.clk, edp->dp_opts.link_rate * 100000); clk_set_rate(edp->dp_pixel_hw.clk, pixel_freq); return 0; } static int qcom_edp_phy_power_off(struct phy *phy) { const struct qcom_edp *edp = phy_get_drvdata(phy); writel(DP_PHY_PD_CTL_PSR_PWRDN, edp->edp + DP_PHY_PD_CTL); return 0; } static int qcom_edp_phy_set_mode(struct phy *phy, enum phy_mode mode, int submode) { struct qcom_edp *edp = phy_get_drvdata(phy); if (mode != PHY_MODE_DP) return -EINVAL; edp->is_edp = submode == PHY_SUBMODE_EDP; return 0; } static int qcom_edp_phy_exit(struct phy *phy) { struct qcom_edp *edp = phy_get_drvdata(phy); clk_bulk_disable_unprepare(ARRAY_SIZE(edp->clks), edp->clks); regulator_bulk_disable(ARRAY_SIZE(edp->supplies), edp->supplies); return 0; } static const struct phy_ops qcom_edp_ops = { .init = qcom_edp_phy_init, .configure = qcom_edp_phy_configure, .power_on = qcom_edp_phy_power_on, .power_off = qcom_edp_phy_power_off, .set_mode = qcom_edp_phy_set_mode, .exit = qcom_edp_phy_exit, .owner = THIS_MODULE, }; /* * Embedded Display Port PLL driver block diagram for branch clocks * * +------------------------------+ * | EDP_VCO_CLK | * | | * | +-------------------+ | * | | (EDP PLL/VCO) | | * | +---------+---------+ | * | v | * | +----------+-----------+ | * | | hsclk_divsel_clk_src | | * | +----------+-----------+ | * +------------------------------+ * | * +---------<---------v------------>----------+ * | | * +--------v----------------+ | * | edp_phy_pll_link_clk | | * | link_clk | | * +--------+----------------+ | * | | * | | * v v * Input to DISPCC block | * for link clk, crypto clk | * and interface clock | * | * | * +--------<------------+-----------------+---<---+ * | | | * +----v---------+ +--------v-----+ +--------v------+ * | vco_divided | | vco_divided | | vco_divided | * | _clk_src | | _clk_src | | _clk_src | * | | | | | | * |divsel_six | | divsel_two | | divsel_four | * +-------+------+ +-----+--------+ +--------+------+ * | | | * v---->----------v-------------<------v * | * +----------+-----------------+ * | edp_phy_pll_vco_div_clk | * +---------+------------------+ * | * v * Input to DISPCC block * for EDP pixel clock * */ static int qcom_edp_dp_pixel_clk_determine_rate(struct clk_hw *hw, struct clk_rate_request *req) { switch (req->rate) { case 1620000000UL / 2: case 2700000000UL / 2: /* 5.4 and 8.1 GHz are same link rate as 2.7GHz, i.e. div 4 and div 6 */ return 0; default: return -EINVAL; } } static unsigned long qcom_edp_dp_pixel_clk_recalc_rate(struct clk_hw *hw, unsigned long parent_rate) { const struct qcom_edp *edp = container_of(hw, struct qcom_edp, dp_pixel_hw); const struct phy_configure_opts_dp *dp_opts = &edp->dp_opts; switch (dp_opts->link_rate) { case 1620: return 1620000000UL / 2; case 2700: return 2700000000UL / 2; case 5400: return 5400000000UL / 4; case 8100: return 8100000000UL / 6; default: return 0; } } static const struct clk_ops qcom_edp_dp_pixel_clk_ops = { .determine_rate = qcom_edp_dp_pixel_clk_determine_rate, .recalc_rate = qcom_edp_dp_pixel_clk_recalc_rate, }; static int qcom_edp_dp_link_clk_determine_rate(struct clk_hw *hw, struct clk_rate_request *req) { switch (req->rate) { case 162000000: case 270000000: case 540000000: case 810000000: return 0; default: return -EINVAL; } } static unsigned long qcom_edp_dp_link_clk_recalc_rate(struct clk_hw *hw, unsigned long parent_rate) { const struct qcom_edp *edp = container_of(hw, struct qcom_edp, dp_link_hw); const struct phy_configure_opts_dp *dp_opts = &edp->dp_opts; switch (dp_opts->link_rate) { case 1620: case 2700: case 5400: case 8100: return dp_opts->link_rate * 100000; default: return 0; } } static const struct clk_ops qcom_edp_dp_link_clk_ops = { .determine_rate = qcom_edp_dp_link_clk_determine_rate, .recalc_rate = qcom_edp_dp_link_clk_recalc_rate, }; static int qcom_edp_clks_register(struct qcom_edp *edp, struct device_node *np) { struct clk_hw_onecell_data *data; struct clk_init_data init = { }; char name[64]; int ret; data = devm_kzalloc(edp->dev, struct_size(data, hws, 2), GFP_KERNEL); if (!data) return -ENOMEM; data->num = 2; snprintf(name, sizeof(name), "%s::link_clk", dev_name(edp->dev)); init.ops = &qcom_edp_dp_link_clk_ops; init.name = name; edp->dp_link_hw.init = &init; ret = devm_clk_hw_register(edp->dev, &edp->dp_link_hw); if (ret) return ret; snprintf(name, sizeof(name), "%s::vco_div_clk", dev_name(edp->dev)); init.ops = &qcom_edp_dp_pixel_clk_ops; init.name = name; edp->dp_pixel_hw.init = &init; ret = devm_clk_hw_register(edp->dev, &edp->dp_pixel_hw); if (ret) return ret; data->hws[0] = &edp->dp_link_hw; data->hws[1] = &edp->dp_pixel_hw; return devm_of_clk_add_hw_provider(edp->dev, of_clk_hw_onecell_get, data); } static int qcom_edp_phy_probe(struct platform_device *pdev) { struct phy_provider *phy_provider; struct device *dev = &pdev->dev; struct qcom_edp *edp; int ret; edp = devm_kzalloc(dev, sizeof(*edp), GFP_KERNEL); if (!edp) return -ENOMEM; edp->dev = dev; edp->cfg = of_device_get_match_data(&pdev->dev); edp->is_edp = edp->cfg->is_edp; edp->edp = devm_platform_ioremap_resource(pdev, 0); if (IS_ERR(edp->edp)) return PTR_ERR(edp->edp); edp->tx0 = devm_platform_ioremap_resource(pdev, 1); if (IS_ERR(edp->tx0)) return PTR_ERR(edp->tx0); edp->tx1 = devm_platform_ioremap_resource(pdev, 2); if (IS_ERR(edp->tx1)) return PTR_ERR(edp->tx1); edp->pll = devm_platform_ioremap_resource(pdev, 3); if (IS_ERR(edp->pll)) return PTR_ERR(edp->pll); edp->clks[0].id = "aux"; edp->clks[1].id = "cfg_ahb"; ret = devm_clk_bulk_get(dev, ARRAY_SIZE(edp->clks), edp->clks); if (ret) return ret; edp->supplies[0].supply = "vdda-phy"; edp->supplies[1].supply = "vdda-pll"; ret = devm_regulator_bulk_get(dev, ARRAY_SIZE(edp->supplies), edp->supplies); if (ret) return ret; ret = regulator_set_load(edp->supplies[0].consumer, 21800); /* 1.2 V vdda-phy */ if (ret) { dev_err(dev, "failed to set load at %s\n", edp->supplies[0].supply); return ret; } ret = regulator_set_load(edp->supplies[1].consumer, 36000); /* 0.9 V vdda-pll */ if (ret) { dev_err(dev, "failed to set load at %s\n", edp->supplies[1].supply); return ret; } ret = qcom_edp_clks_register(edp, pdev->dev.of_node); if (ret) return ret; edp->phy = devm_phy_create(dev, pdev->dev.of_node, &qcom_edp_ops); if (IS_ERR(edp->phy)) { dev_err(dev, "failed to register phy\n"); return PTR_ERR(edp->phy); } phy_set_drvdata(edp->phy, edp); phy_provider = devm_of_phy_provider_register(dev, of_phy_simple_xlate); return PTR_ERR_OR_ZERO(phy_provider); } static const struct of_device_id qcom_edp_phy_match_table[] = { { .compatible = "qcom,sc7280-edp-phy", .data = &sc7280_dp_phy_cfg, }, { .compatible = "qcom,sc8180x-edp-phy", .data = &sc7280_dp_phy_cfg, }, { .compatible = "qcom,sc8280xp-dp-phy", .data = &sc8280xp_dp_phy_cfg, }, { .compatible = "qcom,sc8280xp-edp-phy", .data = &sc8280xp_edp_phy_cfg, }, { .compatible = "qcom,x1e80100-dp-phy", .data = &x1e80100_phy_cfg, }, { } }; MODULE_DEVICE_TABLE(of, qcom_edp_phy_match_table); static struct platform_driver qcom_edp_phy_driver = { .probe = qcom_edp_phy_probe, .driver = { .name = "qcom-edp-phy", .of_match_table = qcom_edp_phy_match_table, }, }; module_platform_driver(qcom_edp_phy_driver); MODULE_AUTHOR("Bjorn Andersson "); MODULE_DESCRIPTION("Qualcomm eDP QMP PHY driver"); MODULE_LICENSE("GPL v2");