| Message ID | 20241129-add-displayport-support-for-qcs615-platform-v1-3-09a4338d93ef@quicinc.com |
|---|---|
| State | New |
| Headers | show |
| Series | Add DisplayPort support for QCS615 platform | expand |
Hi Xiangxu,
kernel test robot noticed the following build warnings:
[auto build test WARNING on f486c8aa16b8172f63bddc70116a0c897a7f3f02]
url: https://github.com/intel-lab-lkp/linux/commits/Xiangxu-Yin/dt-bindings-display-msm-Document-DP-on-QCS615/20241129-160612
base: f486c8aa16b8172f63bddc70116a0c897a7f3f02
patch link: https://lore.kernel.org/r/20241129-add-displayport-support-for-qcs615-platform-v1-3-09a4338d93ef%40quicinc.com
patch subject: [PATCH 3/8] phy: qcom: qmp-usbc: Add DP phy mode support on QCS615
config: arm64-allmodconfig (https://download.01.org/0day-ci/archive/20241129/202411292042.NDeS4BGv-lkp@intel.com/config)
compiler: clang version 20.0.0git (https://github.com/llvm/llvm-project 592c0fe55f6d9a811028b5f3507be91458ab2713)
reproduce (this is a W=1 build): (https://download.01.org/0day-ci/archive/20241129/202411292042.NDeS4BGv-lkp@intel.com/reproduce)
If you fix the issue in a separate patch/commit (i.e. not just a new version of
the same patch/commit), kindly add following tags
| Reported-by: kernel test robot <lkp@intel.com>
| Closes: https://lore.kernel.org/oe-kbuild-all/202411292042.NDeS4BGv-lkp@intel.com/
All warnings (new ones prefixed by >>):
In file included from drivers/phy/qualcomm/phy-qcom-qmp-usbc.c:17:
In file included from include/linux/phy/phy.h:17:
In file included from include/linux/regulator/consumer.h:35:
In file included from include/linux/suspend.h:5:
In file included from include/linux/swap.h:9:
In file included from include/linux/memcontrol.h:21:
In file included from include/linux/mm.h:2223:
include/linux/vmstat.h:504:43: warning: arithmetic between different enumeration types ('enum zone_stat_item' and 'enum numa_stat_item') [-Wenum-enum-conversion]
504 | return vmstat_text[NR_VM_ZONE_STAT_ITEMS +
| ~~~~~~~~~~~~~~~~~~~~~ ^
505 | item];
| ~~~~
include/linux/vmstat.h:511:43: warning: arithmetic between different enumeration types ('enum zone_stat_item' and 'enum numa_stat_item') [-Wenum-enum-conversion]
511 | return vmstat_text[NR_VM_ZONE_STAT_ITEMS +
| ~~~~~~~~~~~~~~~~~~~~~ ^
512 | NR_VM_NUMA_EVENT_ITEMS +
| ~~~~~~~~~~~~~~~~~~~~~~
include/linux/vmstat.h:518:36: warning: arithmetic between different enumeration types ('enum node_stat_item' and 'enum lru_list') [-Wenum-enum-conversion]
518 | return node_stat_name(NR_LRU_BASE + lru) + 3; // skip "nr_"
| ~~~~~~~~~~~ ^ ~~~
include/linux/vmstat.h:524:43: warning: arithmetic between different enumeration types ('enum zone_stat_item' and 'enum numa_stat_item') [-Wenum-enum-conversion]
524 | return vmstat_text[NR_VM_ZONE_STAT_ITEMS +
| ~~~~~~~~~~~~~~~~~~~~~ ^
525 | NR_VM_NUMA_EVENT_ITEMS +
| ~~~~~~~~~~~~~~~~~~~~~~
>> drivers/phy/qualcomm/phy-qcom-qmp-usbc.c:721:24: warning: variable 'pre_emphasis_cfg' is uninitialized when used here [-Wuninitialized]
721 | if ((v_level > 4) || (pre_emphasis_cfg > 4)) {
| ^~~~~~~~~~~~~~~~
drivers/phy/qualcomm/phy-qcom-qmp-usbc.c:708:40: note: initialize the variable 'pre_emphasis_cfg' to silence this warning
708 | u8 voltage_swing_cfg, pre_emphasis_cfg;
| ^
| = '\0'
>> drivers/phy/qualcomm/phy-qcom-qmp-usbc.c:1801:47: warning: variable 'ret' is uninitialized when used here [-Wuninitialized]
1801 | dev_err(dev, "get resource fail, ret:%d\n", ret);
| ^~~
include/linux/dev_printk.h:154:65: note: expanded from macro 'dev_err'
154 | dev_printk_index_wrap(_dev_err, KERN_ERR, dev, dev_fmt(fmt), ##__VA_ARGS__)
| ^~~~~~~~~~~
include/linux/dev_printk.h:110:23: note: expanded from macro 'dev_printk_index_wrap'
110 | _p_func(dev, fmt, ##__VA_ARGS__); \
| ^~~~~~~~~~~
drivers/phy/qualcomm/phy-qcom-qmp-usbc.c:1797:9: note: initialize the variable 'ret' to silence this warning
1797 | int ret;
| ^
| = 0
>> drivers/phy/qualcomm/phy-qcom-qmp-usbc.c:2082:13: warning: variable 'np' is used uninitialized whenever 'if' condition is false [-Wsometimes-uninitialized]
2082 | } else if (qmp->type == QMP_PHY_USBC_DP) {
| ^~~~~~~~~~~~~~~~~~~~~~~~~~~~
drivers/phy/qualcomm/phy-qcom-qmp-usbc.c:2150:14: note: uninitialized use occurs here
2150 | of_node_put(np);
| ^~
drivers/phy/qualcomm/phy-qcom-qmp-usbc.c:2082:9: note: remove the 'if' if its condition is always true
2082 | } else if (qmp->type == QMP_PHY_USBC_DP) {
| ^~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
drivers/phy/qualcomm/phy-qcom-qmp-usbc.c:2027:24: note: initialize the variable 'np' to silence this warning
2027 | struct device_node *np;
| ^
| = NULL
7 warnings generated.
vim +/pre_emphasis_cfg +721 drivers/phy/qualcomm/phy-qcom-qmp-usbc.c
699
700 static int qcs615_qmp_configure_dp_voltages(struct qmp_usbc *qmp)
701 {
702 struct qmp_phy_dp_layout *layout = to_dp_layout(qmp);
703 struct qmp_phy_dp_cfg *cfg = to_dp_cfg(qmp);
704 const struct phy_configure_opts_dp *dp_opts = &layout->dp_opts;
705 void __iomem *tx = layout->dp_tx;
706 void __iomem *tx2 = layout->dp_tx2;
707 unsigned int v_level = 0, p_level = 0;
708 u8 voltage_swing_cfg, pre_emphasis_cfg;
709 int i;
710
711 if (dp_opts->lanes > 4) {
712 dev_err(qmp->dev, "Invalid lane_num(%d)\n", dp_opts->lanes);
713 return -EINVAL;
714 }
715
716 for (i = 0; i < dp_opts->lanes; i++) {
717 v_level = max(v_level, dp_opts->voltage[i]);
718 p_level = max(p_level, dp_opts->pre[i]);
719 }
720
> 721 if ((v_level > 4) || (pre_emphasis_cfg > 4)) {
722 dev_err(qmp->dev, "Invalid v(%d) | p(%d) level)\n",
723 v_level, pre_emphasis_cfg);
724 return -EINVAL;
725 }
726
727 voltage_swing_cfg = (*cfg->swing_tbl)[v_level][p_level];
728 pre_emphasis_cfg = (*cfg->pre_emphasis_tbl)[v_level][p_level];
729
730 /* Enable MUX to use Cursor values from these registers */
731 voltage_swing_cfg |= DP_PHY_TXn_TX_DRV_LVL_MUX_EN;
732 pre_emphasis_cfg |= DP_PHY_TXn_TX_EMP_POST1_LVL_MUX_EN;
733
734 if (voltage_swing_cfg == 0xFF && pre_emphasis_cfg == 0xFF)
735 return -EINVAL;
736
737 /* program default setting first */
738 writel(0x2A, tx + QSERDES_V3_TX_TX_DRV_LVL);
739 writel(0x20, tx + QSERDES_V3_TX_TX_EMP_POST1_LVL);
740 writel(0x2A, tx2 + QSERDES_V3_TX_TX_DRV_LVL);
741 writel(0x20, tx2 + QSERDES_V3_TX_TX_EMP_POST1_LVL);
742
743 writel(voltage_swing_cfg, tx + QSERDES_V3_TX_TX_DRV_LVL);
744 writel(pre_emphasis_cfg, tx + QSERDES_V3_TX_TX_EMP_POST1_LVL);
745 writel(voltage_swing_cfg, tx2 + QSERDES_V3_TX_TX_DRV_LVL);
746 writel(pre_emphasis_cfg, tx2 + QSERDES_V3_TX_TX_EMP_POST1_LVL);
747
748 return 0;
749 }
750
On 11/29/2024 4:18 PM, Krzysztof Kozlowski wrote: > On 29/11/2024 08:57, Xiangxu Yin wrote: >> Extended DP support for QCS615 USB or DP phy. Differentiated between >> USBC and DP PHY using the match table’s type, dynamically generating >> different types of cfg and layout attributes during initialization based >> on this type. Static variables are stored in cfg, while parsed values >> are organized into the layout structure. >> >> Signed-off-by: Xiangxu Yin <quic_xiangxuy@quicinc.com> >> --- >> drivers/phy/qualcomm/phy-qcom-qmp-dp-phy.h | 1 + >> drivers/phy/qualcomm/phy-qcom-qmp-usbc.c | 1453 ++++++++++++++++++++++++---- >> 2 files changed, 1254 insertions(+), 200 deletions(-) > > > > ... > >> + /* program default setting first */ >> + writel(0x2A, tx + QSERDES_V3_TX_TX_DRV_LVL); >> + writel(0x20, tx + QSERDES_V3_TX_TX_EMP_POST1_LVL); >> + writel(0x2A, tx2 + QSERDES_V3_TX_TX_DRV_LVL); >> + writel(0x20, tx2 + QSERDES_V3_TX_TX_EMP_POST1_LVL); >> + >> + writel(voltage_swing_cfg, tx + QSERDES_V3_TX_TX_DRV_LVL); >> + writel(pre_emphasis_cfg, tx + QSERDES_V3_TX_TX_EMP_POST1_LVL); >> + writel(voltage_swing_cfg, tx2 + QSERDES_V3_TX_TX_DRV_LVL); >> + writel(pre_emphasis_cfg, tx2 + QSERDES_V3_TX_TX_EMP_POST1_LVL); >> + >> + return 0; >> +} >> + >> +static int qcs615_qmp_configure_dp_phy(struct qmp_usbc *qmp) >> +{ >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); >> + u32 status; >> + >> + writel(0x01, layout->dp_phy + QSERDES_DP_PHY_CFG); >> + writel(0x05, layout->dp_phy + QSERDES_DP_PHY_CFG); >> + writel(0x01, layout->dp_phy + QSERDES_DP_PHY_CFG); >> + writel(0x09, layout->dp_phy + QSERDES_DP_PHY_CFG); >> + >> + writel(0x20, layout->dp_serdes + QSERDES_COM_RESETSM_CNTRL); >> + >> + // C_READY > > Use Linux coding style. > > Anyway, drop all useless comments. Say something useful or don't say > anything. > Ok, will update in next seperated patches. >> + if (readl_poll_timeout(layout->dp_serdes + QSERDES_COM_C_READY_STATUS, >> + status, >> + ((status & BIT(0)) > 0), >> + 500, >> + 10000)) { >> + dev_err(qmp->dev, "C_READY not ready\n"); >> + return -ETIMEDOUT; >> + } >> + >> + // FREQ_DONE >> + if (readl_poll_timeout(layout->dp_serdes + QSERDES_COM_CMN_STATUS, >> + status, >> + ((status & BIT(0)) > 0), >> + 500, >> + 10000)){ >> + dev_err(qmp->dev, "FREQ_DONE not ready\n"); >> + return -ETIMEDOUT; >> + } >> + >> + // PLL_LOCKED >> + if (readl_poll_timeout(layout->dp_serdes + QSERDES_COM_CMN_STATUS, >> + status, >> + ((status & BIT(1)) > 0), >> + 500, >> + 10000)){ >> + dev_err(qmp->dev, "PLL_LOCKED not ready\n"); >> + return -ETIMEDOUT; >> + } >> + >> + writel(0x19, layout->dp_phy + QSERDES_DP_PHY_CFG); >> + udelay(10); >> + >> + // TSYNC_DONE >> + if (readl_poll_timeout(layout->dp_phy + QSERDES_V3_DP_PHY_STATUS, >> + status, >> + ((status & BIT(0)) > 0), >> + 500, >> + 10000)){ >> + dev_err(qmp->dev, "TSYNC_DONE not ready\n"); >> + return -ETIMEDOUT; >> + } >> + >> + // PHY_READY >> + if (readl_poll_timeout(layout->dp_phy + QSERDES_V3_DP_PHY_STATUS, >> + status, >> + ((status & BIT(1)) > 0), >> + 500, >> + 10000)){ >> + dev_err(qmp->dev, "PHY_READY not ready\n"); >> + return -ETIMEDOUT; >> + } >> + >> + writel(0x3f, layout->dp_tx + QSERDES_V3_TX_TRANSCEIVER_BIAS_EN); >> + writel(0x10, layout->dp_tx + QSERDES_V3_TX_HIGHZ_DRVR_EN); >> + writel(0x0a, layout->dp_tx + QSERDES_V3_TX_TX_POL_INV); >> + writel(0x3f, layout->dp_tx2 + QSERDES_V3_TX_TRANSCEIVER_BIAS_EN); >> + writel(0x10, layout->dp_tx2 + QSERDES_V3_TX_HIGHZ_DRVR_EN); >> + writel(0x0a, layout->dp_tx2 + QSERDES_V3_TX_TX_POL_INV); >> + >> + writel(0x18, layout->dp_phy + QSERDES_DP_PHY_CFG); >> + writel(0x19, layout->dp_phy + QSERDES_DP_PHY_CFG); >> + >> + if (readl_poll_timeout(layout->dp_phy + QSERDES_V3_DP_PHY_STATUS, >> + status, >> + ((status & BIT(1)) > 0), >> + 500, >> + 10000)){ >> + dev_err(qmp->dev, "PHY_READY not ready\n"); >> + return -ETIMEDOUT; >> + } >> + >> + return 0; >> +} >> + >> +static int qcs615_qmp_calibrate_dp_phy(struct qmp_usbc *qmp) >> +{ >> + static const u8 cfg1_settings[] = {0x13, 0x23, 0x1d}; >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); >> + u8 val; >> + >> + layout->dp_aux_cfg++; >> + layout->dp_aux_cfg %= ARRAY_SIZE(cfg1_settings); >> + val = cfg1_settings[layout->dp_aux_cfg]; >> + >> + writel(val, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG1); >> + >> + qmp_usbc_check_dp_phy(qmp, "pos_calibrate"); >> + >> + return 0; >> +} >> + >> +static int qmp_usbc_com_init(struct phy *phy) >> { >> struct qmp_usbc *qmp = phy_get_drvdata(phy); >> - const struct qmp_phy_cfg *cfg = qmp->cfg; >> - void __iomem *pcs = qmp->pcs; >> + int num_vregs; >> u32 val = 0; >> int ret; >> + unsigned int reg_pwr_dn; >> >> - ret = regulator_bulk_enable(cfg->num_vregs, qmp->vregs); >> + if (qmp->type == QMP_PHY_USBC_USB) { > > > Sorry, all this code is unreviewable. Organize your changes in logical, > reviewable chunks. > Will create new patch list and seperate patchsets. >> + struct qmp_phy_usb_cfg *cfg = to_usb_cfg(qmp); >> + >> + num_vregs = cfg->num_vregs; >> + reg_pwr_dn = cfg->regs[QPHY_PCS_POWER_DOWN_CONTROL]; >> + } else { > > ... > >> + .compatible = "qcom,qcs615-qmp-dp-phy", >> + .data = &(struct dev_cfg) { >> + .type = QMP_PHY_USBC_DP, >> + .cfg = &qcs615_dpphy_cfg, >> + }, >> }, { >> .compatible = "qcom,sdm660-qmp-usb3-phy", >> - .data = &sdm660_usb3phy_cfg, >> + .data = &(struct dev_cfg) { >> + .type = QMP_PHY_USBC_USB, >> + .cfg = &sdm660_usb3phy_cfg, >> + }, >> }, { >> .compatible = "qcom,sm6115-qmp-usb3-phy", >> - .data = &qcm2290_usb3phy_cfg, >> + .data = &(struct dev_cfg) { >> + .type = QMP_PHY_USBC_USB, >> + .cfg = &qcm2290_usb3phy_cfg, >> + }, >> }, >> { }, >> }; >> + > > > You make some random changes all over this file. No, clean it up. > >> MODULE_DEVICE_TABLE(of, qmp_usbc_of_match_table); >> >> static struct platform_driver qmp_usbc_driver = { >> > > > Best regards, > Krzysztof
On Mon, Dec 02, 2024 at 06:31:44PM +0800, Xiangxu Yin wrote: > > > On 11/29/2024 4:18 PM, Krzysztof Kozlowski wrote: > > On 29/11/2024 08:57, Xiangxu Yin wrote: > >> +static int qmp_usbc_com_init(struct phy *phy) > >> { > >> struct qmp_usbc *qmp = phy_get_drvdata(phy); > >> - const struct qmp_phy_cfg *cfg = qmp->cfg; > >> - void __iomem *pcs = qmp->pcs; > >> + int num_vregs; > >> u32 val = 0; > >> int ret; > >> + unsigned int reg_pwr_dn; > >> > >> - ret = regulator_bulk_enable(cfg->num_vregs, qmp->vregs); > >> + if (qmp->type == QMP_PHY_USBC_USB) { > > > > > > Sorry, all this code is unreviewable. Organize your changes in logical, > > reviewable chunks. > > > Will create new patch list and seperate patchsets. Please respond to the comment regarding the single PHY vs multiple PHYs first. > >> + struct qmp_phy_usb_cfg *cfg = to_usb_cfg(qmp); > >> + > >> + num_vregs = cfg->num_vregs; > >> + reg_pwr_dn = cfg->regs[QPHY_PCS_POWER_DOWN_CONTROL]; > >> + } else { > >
On 11/29/2024 10:33 PM, Dmitry Baryshkov wrote: > On Fri, 29 Nov 2024 at 09:59, Xiangxu Yin <quic_xiangxuy@quicinc.com> wrote: >> >> Extended DP support for QCS615 USB or DP phy. Differentiated between >> USBC and DP PHY using the match table’s type, dynamically generating >> different types of cfg and layout attributes during initialization based >> on this type. Static variables are stored in cfg, while parsed values >> are organized into the layout structure. > > We didn't have an understanding / conclusion whether > qcom,usb-ssphy-qmp-usb3-or-dp PHYs are actually a single device / PHY > or two PHYs being placed next to each other. Could you please start > your commit message by explaining it? Or even better, make that a part > of the cover letter for a new series touching just the USBC PHY > driver. DP changes don't have anything in common with the PHY changes, > so you can split the series into two. > Before implement DP extension, we have discussed with abhinav and krishna about whether use combo, usbc or separate phy. We identified that DP and USB share some common controls for phy_mode and orientation. Specifically, 'TCSR_USB3_0_DP_PHYMODE' controls who must use the lanes - USB or DP, while PERIPH_SS_USB0_USB3PHY_PCS_MISC_TYPEC_CTRL controls the orientation. It would be more efficient for a single driver to manage these controls. Additionally, this PHY does not support Alt Mode, and the two control registers are located in separate address spaces. Therefore, even though the orientation for DP on this platform is always normal and connected to the video output board, we still decided to base it on the USBC extension. >> >> Signed-off-by: Xiangxu Yin <quic_xiangxuy@quicinc.com> >> --- >> drivers/phy/qualcomm/phy-qcom-qmp-dp-phy.h | 1 + >> drivers/phy/qualcomm/phy-qcom-qmp-usbc.c | 1453 ++++++++++++++++++++++++---- > > Too many changes for a single patch. Please split into logical chunks. > Ok. Once we have clarified the overall direction, we can then discuss whether to split on current list or create a new list for the split. >> 2 files changed, 1254 insertions(+), 200 deletions(-) >> >> diff --git a/drivers/phy/qualcomm/phy-qcom-qmp-dp-phy.h b/drivers/phy/qualcomm/phy-qcom-qmp-dp-phy.h >> index 0ebd405bcaf0cac8215550bfc9b226f30cc43a59..59885616405f878885d0837838a0bac1899fb69f 100644 >> --- a/drivers/phy/qualcomm/phy-qcom-qmp-dp-phy.h >> +++ b/drivers/phy/qualcomm/phy-qcom-qmp-dp-phy.h >> @@ -25,6 +25,7 @@ >> #define QSERDES_DP_PHY_AUX_CFG7 0x03c >> #define QSERDES_DP_PHY_AUX_CFG8 0x040 >> #define QSERDES_DP_PHY_AUX_CFG9 0x044 >> +#define QSERDES_DP_PHY_VCO_DIV 0x068 >> >> /* QSERDES COM_BIAS_EN_CLKBUFLR_EN bits */ >> # define QSERDES_V3_COM_BIAS_EN 0x0001 >> diff --git a/drivers/phy/qualcomm/phy-qcom-qmp-usbc.c b/drivers/phy/qualcomm/phy-qcom-qmp-usbc.c >> index cf12a6f12134dc77ff032f967b2efa43e3de4b21..7fece9d7dc959ed5a7c62077d8552324c3734859 100644 >> --- a/drivers/phy/qualcomm/phy-qcom-qmp-usbc.c >> +++ b/drivers/phy/qualcomm/phy-qcom-qmp-usbc.c >> @@ -22,13 +22,20 @@ >> #include <linux/slab.h> >> #include <linux/usb/typec.h> >> #include <linux/usb/typec_mux.h> >> +#include <dt-bindings/phy/phy-qcom-qmp.h> >> +#include <drm/bridge/aux-bridge.h> >> >> #include "phy-qcom-qmp-common.h" >> >> #include "phy-qcom-qmp.h" >> #include "phy-qcom-qmp-pcs-misc-v3.h" >> >> +#include "phy-qcom-qmp-dp-phy.h" >> +#include "phy-qcom-qmp-dp-phy-v3.h" >> + >> #define PHY_INIT_COMPLETE_TIMEOUT 10000 >> +#define SW_PORTSELECT_VAL BIT(0) >> +#define SW_PORTSELECT_MUX BIT(1) >> >> /* set of registers with offsets different per-PHY */ >> enum qphy_reg_layout { >> @@ -284,7 +291,26 @@ static const struct qmp_phy_init_tbl qcm2290_usb3_pcs_tbl[] = { >> QMP_PHY_INIT_CFG(QPHY_V3_PCS_RX_SIGDET_LVL, 0x88), >> }; >> >> -struct qmp_usbc_offsets { >> +enum qmp_phy_usbc_type { >> + QMP_PHY_USBC_INVALID, > > How can a type be invalid? > I thought that platformdata must specify a type, so I set the default value to ‘invalid’. I will remove this in a future patch. >> + QMP_PHY_USBC_USB, >> + QMP_PHY_USBC_DP, >> +}; >> + >> +/* list of regulators */ >> +struct qmp_regulator_data { >> + const char *name; >> + unsigned int enable_load; >> +}; >> + >> +struct dev_cfg { >> + int type; >> + const void *cfg; >> +}; >> + >> +struct qmp_usbc; >> + >> +struct qmp_usbc_usb_offsets { >> u16 serdes; >> u16 pcs; >> u16 pcs_misc; >> @@ -295,9 +321,9 @@ struct qmp_usbc_offsets { >> u16 rx2; >> }; >> >> -/* struct qmp_phy_cfg - per-PHY initialization config */ >> -struct qmp_phy_cfg { >> - const struct qmp_usbc_offsets *offsets; >> +/* struct qmp_phy_usb_cfg - per-usb PHY initialization config */ > > what is "per-usb PHY"? > Each usb phy in which defined in platform data. Shall I remove this annotation? >> +struct qmp_phy_usb_cfg { >> + const struct qmp_usbc_usb_offsets *offsets; >> >> /* Init sequence for PHY blocks - serdes, tx, rx, pcs */ >> const struct qmp_phy_init_tbl *serdes_tbl; >> @@ -317,11 +343,7 @@ struct qmp_phy_cfg { >> const unsigned int *regs; >> }; >> >> -struct qmp_usbc { >> - struct device *dev; >> - >> - const struct qmp_phy_cfg *cfg; >> - >> +struct qmp_phy_usb_layout { >> void __iomem *serdes; >> void __iomem *pcs; >> void __iomem *pcs_misc; >> @@ -329,28 +351,67 @@ struct qmp_usbc { >> void __iomem *rx; >> void __iomem *tx2; >> void __iomem *rx2; >> - >> struct regmap *tcsr_map; >> u32 vls_clamp_reg; >> - >> + enum phy_mode mode; >> + struct typec_switch_dev *sw; >> struct clk *pipe_clk; >> + struct clk_fixed_rate pipe_clk_fixed; >> +}; >> + >> +struct qmp_usbc_dp_offsets { >> + u16 dp_serdes; >> + u16 dp_txa; >> + u16 dp_txb; >> + u16 dp_phy; >> +}; >> + >> +/* struct qmp_phy_dp_cfg - per-dp PHY initialization config */ >> +struct qmp_phy_dp_cfg { >> + const struct qmp_usbc_dp_offsets *offsets; >> + >> + /* DP PHY swing and pre_emphasis tables */ >> + const u8 (*swing_tbl)[4][4]; >> + const u8 (*pre_emphasis_tbl)[4][4]; >> + >> + // /* DP PHY callbacks */ >> + int (*dp_aux_init)(struct qmp_usbc *qmp); >> + int (*configure_dp_serdes)(struct qmp_usbc *qmp); >> + int (*configure_dp_voltages)(struct qmp_usbc *qmp); >> + int (*configure_dp_phy)(struct qmp_usbc *qmp); >> + int (*calibrate_dp_phy)(struct qmp_usbc *qmp); >> + >> + const struct qmp_regulator_data *vreg_list; >> + int num_vregs; >> +}; >> + >> +struct qmp_phy_dp_layout { >> + void __iomem *dp_phy; >> + void __iomem *dp_tx; >> + void __iomem *dp_tx2; >> + void __iomem *dp_serdes; >> + struct regmap *tcsr_map; >> + u32 dp_phy_mode; >> + unsigned int dp_aux_cfg; >> + struct phy_configure_opts_dp dp_opts; >> + struct clk_hw dp_link_hw; >> + struct clk_hw dp_pixel_hw; >> +}; >> + >> +struct qmp_usbc { >> + struct device *dev; >> + int type; >> struct clk_bulk_data *clks; >> int num_clks; >> int num_resets; >> struct reset_control_bulk_data *resets; >> struct regulator_bulk_data *vregs; >> - >> struct mutex phy_mutex; >> - >> - enum phy_mode mode; >> - unsigned int usb_init_count; >> - >> struct phy *phy; >> - >> - struct clk_fixed_rate pipe_clk_fixed; >> - >> - struct typec_switch_dev *sw; >> enum typec_orientation orientation; >> + unsigned int init_count; >> + const void *cfg; >> + void *layout; > > The patch contains a mixture of renames bundled with actual changes. > Please explain why old names are bad in a separate patch. > Ok, The renaming is mainly to distinguish which structures are for USB or DP, which are fixed configurations, and which are dynamically parsed variables. After we clarify the overall direction, If still implement in usbc, will seperate to below 4 patchsets. 1.renaming and structural adjustments for the USB driver 2.structure definitions for DP extension. 3.common callback functions for DP. 4.platform-related functions for DP. >> }; >> >> static inline void qphy_setbits(void __iomem *base, u32 offset, u32 val) >> @@ -391,12 +452,21 @@ static const char * const usb3phy_reset_l[] = { >> "phy_phy", "phy", >> }; >> >> +static const char * const dp_usb3phy_reset_l[] = { >> + "phy", >> +}; >> + >> /* list of regulators */ >> -static const char * const qmp_phy_vreg_l[] = { >> +static const char * const qmp_phy_usb_vreg_l[] = { >> "vdda-phy", "vdda-pll", >> }; >> >> -static const struct qmp_usbc_offsets qmp_usbc_offsets_v3_qcm2290 = { >> +static struct qmp_regulator_data qmp_phy_dp_vreg_l[] = { >> + { .name = "vdda-phy", .enable_load = 21800 }, >> + { .name = "vdda-pll", .enable_load = 36000 }, >> +}; >> + >> +static const struct qmp_usbc_usb_offsets qmp_usbc_usb_offsets_v3_qcm2290 = { >> .serdes = 0x0, >> .pcs = 0xc00, >> .pcs_misc = 0xa00, >> @@ -406,8 +476,15 @@ static const struct qmp_usbc_offsets qmp_usbc_offsets_v3_qcm2290 = { >> .rx2 = 0x800, >> }; >> >> -static const struct qmp_phy_cfg msm8998_usb3phy_cfg = { >> - .offsets = &qmp_usbc_offsets_v3_qcm2290, >> +static const struct qmp_usbc_dp_offsets qmp_usbc_dp_offsets_qcs615 = { >> + .dp_serdes = 0x0C00, >> + .dp_txa = 0x0400, >> + .dp_txb = 0x0800, >> + .dp_phy = 0x0000, >> +}; >> + >> +static const struct qmp_phy_usb_cfg msm8998_usb3phy_cfg = { >> + .offsets = &qmp_usbc_usb_offsets_v3_qcm2290, >> >> .serdes_tbl = msm8998_usb3_serdes_tbl, >> .serdes_tbl_num = ARRAY_SIZE(msm8998_usb3_serdes_tbl), >> @@ -417,13 +494,13 @@ static const struct qmp_phy_cfg msm8998_usb3phy_cfg = { >> .rx_tbl_num = ARRAY_SIZE(msm8998_usb3_rx_tbl), >> .pcs_tbl = msm8998_usb3_pcs_tbl, >> .pcs_tbl_num = ARRAY_SIZE(msm8998_usb3_pcs_tbl), >> - .vreg_list = qmp_phy_vreg_l, >> - .num_vregs = ARRAY_SIZE(qmp_phy_vreg_l), >> + .vreg_list = qmp_phy_usb_vreg_l, >> + .num_vregs = ARRAY_SIZE(qmp_phy_usb_vreg_l), >> .regs = qmp_v3_usb3phy_regs_layout, >> }; >> >> -static const struct qmp_phy_cfg qcm2290_usb3phy_cfg = { >> - .offsets = &qmp_usbc_offsets_v3_qcm2290, >> +static const struct qmp_phy_usb_cfg qcm2290_usb3phy_cfg = { >> + .offsets = &qmp_usbc_usb_offsets_v3_qcm2290, >> >> .serdes_tbl = qcm2290_usb3_serdes_tbl, >> .serdes_tbl_num = ARRAY_SIZE(qcm2290_usb3_serdes_tbl), >> @@ -433,13 +510,13 @@ static const struct qmp_phy_cfg qcm2290_usb3phy_cfg = { >> .rx_tbl_num = ARRAY_SIZE(qcm2290_usb3_rx_tbl), >> .pcs_tbl = qcm2290_usb3_pcs_tbl, >> .pcs_tbl_num = ARRAY_SIZE(qcm2290_usb3_pcs_tbl), >> - .vreg_list = qmp_phy_vreg_l, >> - .num_vregs = ARRAY_SIZE(qmp_phy_vreg_l), >> + .vreg_list = qmp_phy_usb_vreg_l, >> + .num_vregs = ARRAY_SIZE(qmp_phy_usb_vreg_l), >> .regs = qmp_v3_usb3phy_regs_layout_qcm2290, >> }; >> >> -static const struct qmp_phy_cfg sdm660_usb3phy_cfg = { >> - .offsets = &qmp_usbc_offsets_v3_qcm2290, >> +static const struct qmp_phy_usb_cfg sdm660_usb3phy_cfg = { >> + .offsets = &qmp_usbc_usb_offsets_v3_qcm2290, >> >> .serdes_tbl = qcm2290_usb3_serdes_tbl, >> .serdes_tbl_num = ARRAY_SIZE(qcm2290_usb3_serdes_tbl), >> @@ -449,20 +526,352 @@ static const struct qmp_phy_cfg sdm660_usb3phy_cfg = { >> .rx_tbl_num = ARRAY_SIZE(sdm660_usb3_rx_tbl), >> .pcs_tbl = qcm2290_usb3_pcs_tbl, >> .pcs_tbl_num = ARRAY_SIZE(qcm2290_usb3_pcs_tbl), >> - .vreg_list = qmp_phy_vreg_l, >> - .num_vregs = ARRAY_SIZE(qmp_phy_vreg_l), >> + .vreg_list = qmp_phy_usb_vreg_l, >> + .num_vregs = ARRAY_SIZE(qmp_phy_usb_vreg_l), >> .regs = qmp_v3_usb3phy_regs_layout_qcm2290, >> }; >> >> -static int qmp_usbc_init(struct phy *phy) >> +static const u8 qmp_dp_pre_emphasis_hbr2_rbr[4][4] = { >> + {0x00, 0x0B, 0x12, 0xFF}, /* pe0, 0 db */ >> + {0x00, 0x0A, 0x12, 0xFF}, /* pe1, 3.5 db */ >> + {0x00, 0x0C, 0xFF, 0xFF}, /* pe2, 6.0 db */ >> + {0xFF, 0xFF, 0xFF, 0xFF} /* pe3, 9.5 db */ >> +}; >> + >> +static const u8 qmp_dp_voltage_swing_hbr2_rbr[4][4] = { >> + {0x07, 0x0F, 0x14, 0xFF}, /* sw0, 0.4v */ >> + {0x11, 0x1D, 0x1F, 0xFF}, /* sw1, 0.6 v */ >> + {0x18, 0x1F, 0xFF, 0xFF}, /* sw1, 0.8 v */ >> + {0xFF, 0xFF, 0xFF, 0xFF} /* sw1, 1.2 v, optional */ >> +}; >> + >> +static int qcs615_qmp_dp_aux_init(struct qmp_usbc *qmp); >> +static int qcs615_qmp_configure_dp_serdes(struct qmp_usbc *qmp); >> +static int qcs615_qmp_configure_dp_voltages(struct qmp_usbc *qmp); >> +static int qcs615_qmp_configure_dp_phy(struct qmp_usbc *qmp); >> +static int qcs615_qmp_calibrate_dp_phy(struct qmp_usbc *qmp); > > Are those functions really platform-specific? > I mainly compared the driver of the combo PHY to identify reusable functions. I extracted the dp_aux_init, configure_dp_phy and calibrate_dp_phy, and based on the differences in the flow of the HPG in the 14nm DP PHY, I separated out the configure_dp_voltages and configure_dp_serdes functions. Detailed explanation is provided in the following comment. >> + >> +static void qmp_usbc_check_dp_phy(struct qmp_usbc *qmp, const char *pos); >> + >> +static const struct qmp_phy_dp_cfg qcs615_dpphy_cfg = { >> + .offsets = &qmp_usbc_dp_offsets_qcs615, >> + >> + .swing_tbl = &qmp_dp_voltage_swing_hbr2_rbr, >> + .pre_emphasis_tbl = &qmp_dp_pre_emphasis_hbr2_rbr, >> + >> + .dp_aux_init = qcs615_qmp_dp_aux_init, >> + .configure_dp_serdes = qcs615_qmp_configure_dp_serdes, >> + .configure_dp_voltages = qcs615_qmp_configure_dp_voltages, >> + .configure_dp_phy = qcs615_qmp_configure_dp_phy, >> + .calibrate_dp_phy = qcs615_qmp_calibrate_dp_phy, >> + >> + .vreg_list = qmp_phy_dp_vreg_l, >> + .num_vregs = ARRAY_SIZE(qmp_phy_dp_vreg_l), >> +}; >> + >> +#define to_usb_cfg(x) ((struct qmp_phy_usb_cfg *)(x->cfg)) >> +#define to_dp_cfg(x) ((struct qmp_phy_dp_cfg *)(x->cfg)) >> +#define to_usb_layout(x) ((struct qmp_phy_usb_layout *)(x->layout)) >> +#define to_dp_layout(x) ((struct qmp_phy_dp_layout *)(x->layout)) >> + >> +static int qcs615_qmp_dp_aux_init(struct qmp_usbc *qmp) >> +{ >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); >> + >> + regmap_write(layout->tcsr_map, layout->dp_phy_mode, 0x1); >> + >> + writel(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, >> + layout->dp_phy + QSERDES_DP_PHY_PD_CTL); >> + >> + 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, >> + layout->dp_phy + QSERDES_DP_PHY_PD_CTL); >> + >> + writel(0x00, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG0); >> + writel(0x13, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG1); >> + writel(0x00, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG2); >> + writel(0x00, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG3); >> + writel(0x0a, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG4); >> + writel(0x26, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG5); >> + writel(0x0a, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG6); >> + writel(0x03, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG7); >> + writel(0xbb, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG8); >> + writel(0x03, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG9); >> + layout->dp_aux_cfg = 0; >> + >> + 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, >> + layout->dp_phy + QSERDES_V3_DP_PHY_AUX_INTERRUPT_MASK); >> + return 0; >> +} > > We've had DP PHY implementation in QMP Combo PHY and in eDP PHY. > Please review them and work on extracting common bits into some kind > of a library. At least -combo and your -usbc implementation seem close > enough to warrant common library code. > Initially, I intended to reference the register tables of combo. However, I discovered some flow differences in the 14nm PHY, So, I only kept the sw and pe tables, and the rest was implemented as functions. 1.configure_dp_serdes: The configuration of dp_serdes in the 14nm PHY is similar to that of eDP. The configurations corresponding to RBR to HBR2 need to be set in the middle of the dp_serdes. Therefore, I didn’t split it into five tables, but instead referenced the eDP implementation such like com_configure_pll. 2.configure_dp_voltages: 14nm DP phy have only one pair of reference swing table and pre_emphasis_tbl. Similar implement with combo V3. 3.configure_dp_phy & power_on: This PHY requires alternating configurations among the dp_phy, dp_serdes, and dp_tx, dp_tx2 register groups, which makes grouped configuration less convenient. >> + >> +static int qcs615_qmp_configure_dp_serdes(struct qmp_usbc *qmp) >> +{ >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); >> + void __iomem *serdes = layout->dp_serdes; >> + const struct phy_configure_opts_dp *dp_opts = &layout->dp_opts; >> + u8 hsclk_sel; >> + u8 dec_start_mode0; >> + u8 div_frac_start1_mode0; >> + u8 div_frac_start2_mode0; >> + u8 div_frac_start3_mode0; >> + u8 lock_cmp1_mode0; >> + u8 lock_cmp2_mode0; >> + u8 lock_cmp3_mode0; >> + >> + switch (dp_opts->link_rate) { >> + case 1620: >> + hsclk_sel = 0x2c; >> + dec_start_mode0 = 0x69; >> + div_frac_start1_mode0 = 0x00; >> + div_frac_start2_mode0 = 0x80; >> + div_frac_start3_mode0 = 0x07; >> + lock_cmp1_mode0 = 0xbf; >> + lock_cmp2_mode0 = 0x21; >> + lock_cmp3_mode0 = 0x00; >> + break; >> + case 2700: >> + hsclk_sel = 0x24; >> + dec_start_mode0 = 0x69; >> + div_frac_start1_mode0 = 0x00; >> + div_frac_start2_mode0 = 0x80; >> + div_frac_start3_mode0 = 0x07; >> + lock_cmp1_mode0 = 0x3f; >> + lock_cmp2_mode0 = 0x38; >> + lock_cmp3_mode0 = 0x00; >> + break; >> + case 5400: >> + hsclk_sel = 0x20; >> + dec_start_mode0 = 0x8c; >> + div_frac_start1_mode0 = 0x00; >> + div_frac_start2_mode0 = 0x00; >> + div_frac_start3_mode0 = 0x0a; >> + lock_cmp1_mode0 = 0x7f; >> + lock_cmp2_mode0 = 0x70; >> + lock_cmp3_mode0 = 0x00; >> + break; >> + default: >> + /* Other link rates aren't supported */ >> + return -EINVAL; >> + } >> + >> + writel(0x01, serdes + QSERDES_COM_SVS_MODE_CLK_SEL); >> + writel(0x37, serdes + QSERDES_COM_SYSCLK_EN_SEL); >> + writel(0x00, serdes + QSERDES_COM_CLK_SELECT); >> + writel(0x06, serdes + QSERDES_COM_SYS_CLK_CTRL); >> + writel(0x3f, serdes + QSERDES_COM_BIAS_EN_CLKBUFLR_EN); >> + writel(0x0e, serdes + QSERDES_COM_CLK_ENABLE1); >> + writel(0x0f, serdes + QSERDES_COM_BG_CTRL); >> + writel(0x06, serdes + QSERDES_COM_SYSCLK_BUF_ENABLE); >> + writel(0x30, serdes + QSERDES_COM_CLK_SELECT); >> + writel(0x0f, serdes + QSERDES_COM_PLL_IVCO); >> + writel(0x28, serdes + QSERDES_COM_PLL_CCTRL_MODE0); >> + writel(0x16, serdes + QSERDES_COM_PLL_RCTRL_MODE0); >> + writel(0x0b, serdes + QSERDES_COM_CP_CTRL_MODE0); >> + >> + writel(hsclk_sel, serdes + QSERDES_COM_HSCLK_SEL); >> + writel(dec_start_mode0, serdes + QSERDES_COM_DEC_START_MODE0); >> + writel(div_frac_start1_mode0, serdes + QSERDES_COM_DIV_FRAC_START1_MODE0); >> + writel(div_frac_start2_mode0, serdes + QSERDES_COM_DIV_FRAC_START2_MODE0); >> + writel(div_frac_start3_mode0, serdes + QSERDES_COM_DIV_FRAC_START3_MODE0); >> + writel(lock_cmp1_mode0, serdes + QSERDES_COM_LOCK_CMP1_MODE0); >> + writel(lock_cmp2_mode0, serdes + QSERDES_COM_LOCK_CMP2_MODE0); >> + writel(lock_cmp3_mode0, serdes + QSERDES_COM_LOCK_CMP3_MODE0); >> + >> + writel(0x40, serdes + QSERDES_COM_INTEGLOOP_GAIN0_MODE0); >> + writel(0x00, serdes + QSERDES_COM_INTEGLOOP_GAIN1_MODE0); >> + writel(0x00, serdes + QSERDES_COM_VCO_TUNE_MAP); >> + writel(0x08, serdes + QSERDES_COM_BG_TIMER); >> + writel(0x05, serdes + QSERDES_COM_CORECLK_DIV); >> + writel(0x00, serdes + QSERDES_COM_VCO_TUNE_CTRL); >> + writel(0x00, serdes + QSERDES_COM_VCO_TUNE1_MODE0); >> + writel(0x00, serdes + QSERDES_COM_VCO_TUNE2_MODE0); >> + writel(0x00, serdes + QSERDES_COM_VCO_TUNE_CTRL); >> + >> + writel(0x0f, serdes + QSERDES_COM_CORE_CLK_EN); >> + >> + return 0; >> +} >> + >> +static int qcs615_qmp_configure_dp_voltages(struct qmp_usbc *qmp) >> +{ >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); >> + struct qmp_phy_dp_cfg *cfg = to_dp_cfg(qmp); >> + const struct phy_configure_opts_dp *dp_opts = &layout->dp_opts; >> + void __iomem *tx = layout->dp_tx; >> + void __iomem *tx2 = layout->dp_tx2; >> + unsigned int v_level = 0, p_level = 0; >> + u8 voltage_swing_cfg, pre_emphasis_cfg; >> + int i; >> + >> + if (dp_opts->lanes > 4) { >> + dev_err(qmp->dev, "Invalid lane_num(%d)\n", dp_opts->lanes); >> + return -EINVAL; >> + } >> + >> + 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 ((v_level > 4) || (pre_emphasis_cfg > 4)) { >> + dev_err(qmp->dev, "Invalid v(%d) | p(%d) level)\n", >> + v_level, pre_emphasis_cfg); >> + return -EINVAL; >> + } >> + >> + voltage_swing_cfg = (*cfg->swing_tbl)[v_level][p_level]; >> + pre_emphasis_cfg = (*cfg->pre_emphasis_tbl)[v_level][p_level]; >> + >> + /* Enable MUX to use Cursor values from these registers */ >> + voltage_swing_cfg |= DP_PHY_TXn_TX_DRV_LVL_MUX_EN; >> + pre_emphasis_cfg |= DP_PHY_TXn_TX_EMP_POST1_LVL_MUX_EN; >> + >> + if (voltage_swing_cfg == 0xFF && pre_emphasis_cfg == 0xFF) >> + return -EINVAL; >> + >> + /* program default setting first */ >> + writel(0x2A, tx + QSERDES_V3_TX_TX_DRV_LVL); >> + writel(0x20, tx + QSERDES_V3_TX_TX_EMP_POST1_LVL); >> + writel(0x2A, tx2 + QSERDES_V3_TX_TX_DRV_LVL); >> + writel(0x20, tx2 + QSERDES_V3_TX_TX_EMP_POST1_LVL); > > Lowercase all hex numbers. > Ok, will update in next patch. >> + >> + writel(voltage_swing_cfg, tx + QSERDES_V3_TX_TX_DRV_LVL); >> + writel(pre_emphasis_cfg, tx + QSERDES_V3_TX_TX_EMP_POST1_LVL); >> + writel(voltage_swing_cfg, tx2 + QSERDES_V3_TX_TX_DRV_LVL); >> + writel(pre_emphasis_cfg, tx2 + QSERDES_V3_TX_TX_EMP_POST1_LVL); >> + >> + return 0; >> +} >> + >> +static int qcs615_qmp_configure_dp_phy(struct qmp_usbc *qmp) >> +{ >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); >> + u32 status; >> + >> + writel(0x01, layout->dp_phy + QSERDES_DP_PHY_CFG); >> + writel(0x05, layout->dp_phy + QSERDES_DP_PHY_CFG); >> + writel(0x01, layout->dp_phy + QSERDES_DP_PHY_CFG); >> + writel(0x09, layout->dp_phy + QSERDES_DP_PHY_CFG); >> + >> + writel(0x20, layout->dp_serdes + QSERDES_COM_RESETSM_CNTRL); >> + >> + // C_READY >> + if (readl_poll_timeout(layout->dp_serdes + QSERDES_COM_C_READY_STATUS, >> + status, >> + ((status & BIT(0)) > 0), >> + 500, >> + 10000)) { >> + dev_err(qmp->dev, "C_READY not ready\n"); >> + return -ETIMEDOUT; >> + } >> + >> + // FREQ_DONE >> + if (readl_poll_timeout(layout->dp_serdes + QSERDES_COM_CMN_STATUS, >> + status, >> + ((status & BIT(0)) > 0), >> + 500, >> + 10000)){ >> + dev_err(qmp->dev, "FREQ_DONE not ready\n"); >> + return -ETIMEDOUT; >> + } >> + >> + // PLL_LOCKED >> + if (readl_poll_timeout(layout->dp_serdes + QSERDES_COM_CMN_STATUS, >> + status, >> + ((status & BIT(1)) > 0), >> + 500, >> + 10000)){ >> + dev_err(qmp->dev, "PLL_LOCKED not ready\n"); >> + return -ETIMEDOUT; >> + } >> + >> + writel(0x19, layout->dp_phy + QSERDES_DP_PHY_CFG); >> + udelay(10); >> + >> + // TSYNC_DONE >> + if (readl_poll_timeout(layout->dp_phy + QSERDES_V3_DP_PHY_STATUS, >> + status, >> + ((status & BIT(0)) > 0), >> + 500, >> + 10000)){ >> + dev_err(qmp->dev, "TSYNC_DONE not ready\n"); >> + return -ETIMEDOUT; >> + } >> + >> + // PHY_READY >> + if (readl_poll_timeout(layout->dp_phy + QSERDES_V3_DP_PHY_STATUS, >> + status, >> + ((status & BIT(1)) > 0), >> + 500, >> + 10000)){ >> + dev_err(qmp->dev, "PHY_READY not ready\n"); >> + return -ETIMEDOUT; >> + } >> + >> + writel(0x3f, layout->dp_tx + QSERDES_V3_TX_TRANSCEIVER_BIAS_EN); >> + writel(0x10, layout->dp_tx + QSERDES_V3_TX_HIGHZ_DRVR_EN); >> + writel(0x0a, layout->dp_tx + QSERDES_V3_TX_TX_POL_INV); >> + writel(0x3f, layout->dp_tx2 + QSERDES_V3_TX_TRANSCEIVER_BIAS_EN); >> + writel(0x10, layout->dp_tx2 + QSERDES_V3_TX_HIGHZ_DRVR_EN); >> + writel(0x0a, layout->dp_tx2 + QSERDES_V3_TX_TX_POL_INV); >> + >> + writel(0x18, layout->dp_phy + QSERDES_DP_PHY_CFG); >> + writel(0x19, layout->dp_phy + QSERDES_DP_PHY_CFG); >> + >> + if (readl_poll_timeout(layout->dp_phy + QSERDES_V3_DP_PHY_STATUS, >> + status, >> + ((status & BIT(1)) > 0), >> + 500, >> + 10000)){ >> + dev_err(qmp->dev, "PHY_READY not ready\n"); >> + return -ETIMEDOUT; >> + } >> + >> + return 0; >> +} >> + >> +static int qcs615_qmp_calibrate_dp_phy(struct qmp_usbc *qmp) >> +{ >> + static const u8 cfg1_settings[] = {0x13, 0x23, 0x1d}; >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); >> + u8 val; >> + >> + layout->dp_aux_cfg++; >> + layout->dp_aux_cfg %= ARRAY_SIZE(cfg1_settings); >> + val = cfg1_settings[layout->dp_aux_cfg]; >> + >> + writel(val, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG1); >> + >> + qmp_usbc_check_dp_phy(qmp, "pos_calibrate"); >> + >> + return 0; >> +} >> + >> +static int qmp_usbc_com_init(struct phy *phy) >> { >> struct qmp_usbc *qmp = phy_get_drvdata(phy); >> - const struct qmp_phy_cfg *cfg = qmp->cfg; >> - void __iomem *pcs = qmp->pcs; >> + int num_vregs; >> u32 val = 0; >> int ret; >> + unsigned int reg_pwr_dn; >> >> - ret = regulator_bulk_enable(cfg->num_vregs, qmp->vregs); >> + if (qmp->type == QMP_PHY_USBC_USB) { >> + struct qmp_phy_usb_cfg *cfg = to_usb_cfg(qmp); >> + >> + num_vregs = cfg->num_vregs; >> + reg_pwr_dn = cfg->regs[QPHY_PCS_POWER_DOWN_CONTROL]; >> + } else { >> + struct qmp_phy_dp_cfg *cfg = to_dp_cfg(qmp); >> + >> + num_vregs = cfg->num_vregs; >> + } >> + >> + ret = regulator_bulk_enable(num_vregs, qmp->vregs); >> if (ret) { >> dev_err(qmp->dev, "failed to enable regulators, err=%d\n", ret); >> return ret; >> @@ -484,73 +893,85 @@ static int qmp_usbc_init(struct phy *phy) >> if (ret) >> goto err_assert_reset; >> >> - qphy_setbits(pcs, cfg->regs[QPHY_PCS_POWER_DOWN_CONTROL], SW_PWRDN); >> - >> -#define SW_PORTSELECT_VAL BIT(0) >> -#define SW_PORTSELECT_MUX BIT(1) >> /* Use software based port select and switch on typec orientation */ >> val = SW_PORTSELECT_MUX; >> if (qmp->orientation == TYPEC_ORIENTATION_REVERSE) >> val |= SW_PORTSELECT_VAL; >> - writel(val, qmp->pcs_misc); >> + >> + if (qmp->type == QMP_PHY_USBC_USB) { > > Why? > On QCS615 ADP AIR platform, Type-C DP orientation is fixed in one direction due to connected to the external video-out expansion board through the expansion slot. Therefore, we cannot validate DP orientation behaviour. As a result, the orientation part remains consistent with the original implementation of the USB-C driver and only applies to USB devices. >> + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); >> + >> + qphy_setbits(layout->pcs, reg_pwr_dn, SW_PWRDN); >> + writel(val, layout->pcs_misc); >> + } >> >> return 0; >> >> err_assert_reset: >> reset_control_bulk_assert(qmp->num_resets, qmp->resets); >> err_disable_regulators: >> - regulator_bulk_disable(cfg->num_vregs, qmp->vregs); >> + regulator_bulk_disable(num_vregs, qmp->vregs); >> >> return ret; >> } >> >> -static int qmp_usbc_exit(struct phy *phy) >> +static int qmp_usbc_com_exit(struct phy *phy) >> { >> struct qmp_usbc *qmp = phy_get_drvdata(phy); >> - const struct qmp_phy_cfg *cfg = qmp->cfg; >> + int num_vregs; >> >> reset_control_bulk_assert(qmp->num_resets, qmp->resets); >> >> clk_bulk_disable_unprepare(qmp->num_clks, qmp->clks); >> >> - regulator_bulk_disable(cfg->num_vregs, qmp->vregs); >> + if (qmp->type == QMP_PHY_USBC_USB) { >> + struct qmp_phy_usb_cfg *cfg = to_usb_cfg(qmp); >> + >> + num_vregs = cfg->num_vregs; >> + } else { >> + struct qmp_phy_dp_cfg *cfg = to_dp_cfg(qmp); >> + >> + num_vregs = cfg->num_vregs; >> + } >> + regulator_bulk_disable(num_vregs, qmp->vregs); >> >> return 0; >> } >> >> -static int qmp_usbc_power_on(struct phy *phy) >> +static int qmp_usbc_usb_power_on(struct phy *phy) >> { >> struct qmp_usbc *qmp = phy_get_drvdata(phy); >> - const struct qmp_phy_cfg *cfg = qmp->cfg; >> + const struct qmp_phy_usb_cfg *cfg = to_usb_cfg(qmp); >> + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); >> void __iomem *status; >> unsigned int val; >> int ret; >> >> - qmp_configure(qmp->dev, qmp->serdes, cfg->serdes_tbl, >> + qmp_configure(qmp->dev, layout->serdes, cfg->serdes_tbl, >> cfg->serdes_tbl_num); >> >> - ret = clk_prepare_enable(qmp->pipe_clk); >> + ret = clk_prepare_enable(layout->pipe_clk); >> if (ret) { >> dev_err(qmp->dev, "pipe_clk enable failed err=%d\n", ret); >> return ret; >> } >> >> /* Tx, Rx, and PCS configurations */ >> - qmp_configure_lane(qmp->dev, qmp->tx, cfg->tx_tbl, cfg->tx_tbl_num, 1); >> - qmp_configure_lane(qmp->dev, qmp->rx, cfg->rx_tbl, cfg->rx_tbl_num, 1); >> + qmp_configure_lane(qmp->dev, layout->tx, cfg->tx_tbl, cfg->tx_tbl_num, 1); >> + qmp_configure_lane(qmp->dev, layout->rx, cfg->rx_tbl, cfg->rx_tbl_num, 1); >> >> - qmp_configure_lane(qmp->dev, qmp->tx2, cfg->tx_tbl, cfg->tx_tbl_num, 2); >> - qmp_configure_lane(qmp->dev, qmp->rx2, cfg->rx_tbl, cfg->rx_tbl_num, 2); >> + qmp_configure_lane(qmp->dev, layout->tx2, cfg->tx_tbl, cfg->tx_tbl_num, 2); >> + qmp_configure_lane(qmp->dev, layout->rx2, cfg->rx_tbl, cfg->rx_tbl_num, 2); >> >> - qmp_configure(qmp->dev, qmp->pcs, cfg->pcs_tbl, cfg->pcs_tbl_num); >> + qmp_configure(qmp->dev, layout->pcs, cfg->pcs_tbl, cfg->pcs_tbl_num); >> >> /* Pull PHY out of reset state */ >> - qphy_clrbits(qmp->pcs, cfg->regs[QPHY_SW_RESET], SW_RESET); >> + qphy_clrbits(layout->pcs, cfg->regs[QPHY_SW_RESET], SW_RESET); >> >> /* start SerDes and Phy-Coding-Sublayer */ >> - qphy_setbits(qmp->pcs, cfg->regs[QPHY_START_CTRL], SERDES_START | PCS_START); >> + qphy_setbits(layout->pcs, cfg->regs[QPHY_START_CTRL], SERDES_START | PCS_START); >> >> - status = qmp->pcs + cfg->regs[QPHY_PCS_STATUS]; >> + status = layout->pcs + cfg->regs[QPHY_PCS_STATUS]; >> ret = readl_poll_timeout(status, val, !(val & PHYSTATUS), 200, >> PHY_INIT_COMPLETE_TIMEOUT); >> if (ret) { >> @@ -561,92 +982,348 @@ static int qmp_usbc_power_on(struct phy *phy) >> return 0; >> >> err_disable_pipe_clk: >> - clk_disable_unprepare(qmp->pipe_clk); >> + clk_disable_unprepare(layout->pipe_clk); >> >> return ret; >> } >> >> -static int qmp_usbc_power_off(struct phy *phy) >> +static int qmp_usbc_usb_power_off(struct phy *phy) >> { >> struct qmp_usbc *qmp = phy_get_drvdata(phy); >> - const struct qmp_phy_cfg *cfg = qmp->cfg; >> + const struct qmp_phy_usb_cfg *cfg = to_usb_cfg(qmp); >> + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); >> >> - clk_disable_unprepare(qmp->pipe_clk); >> + clk_disable_unprepare(layout->pipe_clk); >> >> /* PHY reset */ >> - qphy_setbits(qmp->pcs, cfg->regs[QPHY_SW_RESET], SW_RESET); >> + qphy_setbits(layout->pcs, cfg->regs[QPHY_SW_RESET], SW_RESET); >> >> /* stop SerDes and Phy-Coding-Sublayer */ >> - qphy_clrbits(qmp->pcs, cfg->regs[QPHY_START_CTRL], >> + qphy_clrbits(layout->pcs, cfg->regs[QPHY_START_CTRL], >> SERDES_START | PCS_START); >> >> /* Put PHY into POWER DOWN state: active low */ >> - qphy_clrbits(qmp->pcs, cfg->regs[QPHY_PCS_POWER_DOWN_CONTROL], >> + qphy_clrbits(layout->pcs, cfg->regs[QPHY_PCS_POWER_DOWN_CONTROL], >> SW_PWRDN); >> >> return 0; >> } >> >> -static int qmp_usbc_enable(struct phy *phy) >> +static int qmp_usbc_usb_enable(struct phy *phy) >> { >> struct qmp_usbc *qmp = phy_get_drvdata(phy); >> int ret; >> >> mutex_lock(&qmp->phy_mutex); >> >> - ret = qmp_usbc_init(phy); >> + ret = qmp_usbc_com_init(phy); >> if (ret) >> goto out_unlock; >> >> - ret = qmp_usbc_power_on(phy); >> + ret = qmp_usbc_usb_power_on(phy); >> if (ret) { >> - qmp_usbc_exit(phy); >> + qmp_usbc_com_exit(phy); >> goto out_unlock; >> } >> >> - qmp->usb_init_count++; >> + qmp->init_count++; >> out_unlock: >> mutex_unlock(&qmp->phy_mutex); >> >> return ret; >> } >> >> -static int qmp_usbc_disable(struct phy *phy) >> +static int qmp_usbc_usb_disable(struct phy *phy) >> { >> struct qmp_usbc *qmp = phy_get_drvdata(phy); >> int ret; >> >> - qmp->usb_init_count--; >> - ret = qmp_usbc_power_off(phy); >> + qmp->init_count--; >> + ret = qmp_usbc_usb_power_off(phy); >> if (ret) >> return ret; >> - return qmp_usbc_exit(phy); >> + return qmp_usbc_com_exit(phy); >> +} >> + >> +static int qmp_usbc_usb_set_mode(struct phy *phy, enum phy_mode mode, int submode) >> +{ >> + struct qmp_usbc *qmp = phy_get_drvdata(phy); >> + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); >> + >> + layout->mode = mode; >> + >> + return 0; >> +} >> + >> +static int qmp_usbc_dp_init(struct phy *phy) >> +{ >> + struct qmp_usbc *qmp = phy_get_drvdata(phy); >> + const struct qmp_phy_dp_cfg *cfg = to_dp_cfg(qmp); >> + int ret; >> + >> + if (qmp->init_count) { >> + dev_err(qmp->dev, "type(%d) inited(%d)\n", qmp->type, qmp->init_count); >> + return 0; >> + } >> + >> + mutex_lock(&qmp->phy_mutex); >> + >> + ret = qmp_usbc_com_init(phy); >> + if (ret) { >> + dev_err(qmp->dev, "type(%d) com_init fail\n", qmp->type); >> + goto dp_init_unlock; >> + } >> + >> + cfg->dp_aux_init(qmp); >> + >> + qmp->init_count++; >> + >> +dp_init_unlock: >> + mutex_unlock(&qmp->phy_mutex); >> + return ret; >> +} >> + >> +static int qmp_usbc_dp_exit(struct phy *phy) >> +{ >> + struct qmp_usbc *qmp = phy_get_drvdata(phy); >> + >> + mutex_lock(&qmp->phy_mutex); >> + >> + qmp_usbc_com_exit(phy); >> + >> + qmp->init_count--; >> + >> + mutex_unlock(&qmp->phy_mutex); >> + >> + return 0; >> +} >> + >> +static int qmp_usbc_dp_configure(struct phy *phy, union phy_configure_opts *opts) >> +{ >> + const struct phy_configure_opts_dp *dp_opts = &opts->dp; >> + struct qmp_usbc *qmp = phy_get_drvdata(phy); >> + struct qmp_phy_dp_cfg *cfg = to_dp_cfg(qmp); >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); >> + int ret; >> + >> + mutex_lock(&qmp->phy_mutex); >> + >> + memcpy(&layout->dp_opts, dp_opts, sizeof(*dp_opts)); >> + if (layout->dp_opts.set_voltages) { >> + ret = cfg->configure_dp_voltages(qmp); >> + if (ret) { >> + dev_err(qmp->dev, "type(%d) err(%d)\n", qmp->type, ret); >> + mutex_unlock(&qmp->phy_mutex); >> + return ret; >> + } >> + >> + layout->dp_opts.set_voltages = 0; >> + } >> + >> + mutex_unlock(&qmp->phy_mutex); >> + >> + return 0; >> +} >> + >> +static int qmp_usbc_dp_calibrate(struct phy *phy) >> +{ >> + struct qmp_usbc *qmp = phy_get_drvdata(phy); >> + struct qmp_phy_dp_cfg *cfg = to_dp_cfg(qmp); >> + int ret = 0; >> + >> + mutex_lock(&qmp->phy_mutex); >> + >> + if (cfg->calibrate_dp_phy) { >> + ret = cfg->calibrate_dp_phy(qmp); >> + if (ret) { >> + dev_err(qmp->dev, "type(%d) err(%d)\n", qmp->type, ret); >> + mutex_unlock(&qmp->phy_mutex); >> + return ret; >> + } >> + } >> + >> + mutex_unlock(&qmp->phy_mutex); >> + return 0; >> } >> >> -static int qmp_usbc_set_mode(struct phy *phy, enum phy_mode mode, int submode) >> +static int qmp_usbc_configure_dp_clocks(struct qmp_usbc *qmp) >> +{ >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); >> + const struct phy_configure_opts_dp *dp_opts = &layout->dp_opts; >> + u32 phy_vco_div; >> + unsigned long pixel_freq; >> + >> + switch (dp_opts->link_rate) { >> + case 1620: >> + phy_vco_div = 0x1; >> + pixel_freq = 1620000000UL / 2; >> + break; >> + case 2700: >> + phy_vco_div = 0x1; >> + pixel_freq = 2700000000UL / 2; >> + break; >> + case 5400: >> + phy_vco_div = 0x2; >> + pixel_freq = 5400000000UL / 4; >> + break; >> + case 8100: >> + phy_vco_div = 0x0; >> + pixel_freq = 8100000000UL / 6; >> + break; >> + default: >> + /* Other link rates aren't supported */ >> + return -EINVAL; >> + } >> + writel(phy_vco_div, layout->dp_phy + QSERDES_DP_PHY_VCO_DIV); >> + >> + clk_set_rate(layout->dp_link_hw.clk, dp_opts->link_rate * 100000); >> + clk_set_rate(layout->dp_pixel_hw.clk, pixel_freq); >> + >> + return 0; >> +} >> + >> +static void qmp_usbc_check_dp_phy(struct qmp_usbc *qmp, const char *pos) >> +{ >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); >> + u8 c_ready, cmn_status, phy_status; >> + >> + c_ready = readl(layout->dp_serdes + QSERDES_COM_C_READY_STATUS); >> + cmn_status = readl(layout->dp_serdes + QSERDES_COM_CMN_STATUS); >> + phy_status = readl(layout->dp_phy + QSERDES_V3_DP_PHY_STATUS); >> + >> + dev_dbg(qmp->dev, "pos(%s) c_ready(0x%x) cmn_status(0x%x) phy_status(0x%x)\n", >> + pos, c_ready, cmn_status, phy_status); >> +} >> + >> +static int qmp_usbc_dp_power_on(struct phy *phy) >> +{ >> + struct qmp_usbc *qmp = phy_get_drvdata(phy); >> + const struct qmp_phy_dp_cfg *cfg = to_dp_cfg(qmp); >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); >> + const struct phy_configure_opts_dp *dp_opts = &layout->dp_opts; >> + bool reverse = (qmp->orientation == TYPEC_ORIENTATION_REVERSE); >> + void __iomem *tx = layout->dp_tx; >> + void __iomem *tx2 = layout->dp_tx2; >> + u8 lane_mode_1; >> + int ret = 0; >> + >> + mutex_lock(&qmp->phy_mutex); >> + >> + 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, >> + layout->dp_phy + QSERDES_DP_PHY_PD_CTL); >> + >> + ret = cfg->configure_dp_serdes(qmp); >> + if (ret) { >> + dev_err(qmp->dev, "failed to config pll\n"); >> + goto power_on_unlock; >> + } >> + >> + if (dp_opts->link_rate >= 2700) >> + lane_mode_1 = 0xc4; >> + else >> + lane_mode_1 = 0xc6; >> + >> + writel(lane_mode_1, tx + QSERDES_V3_TX_LANE_MODE_1); >> + writel(lane_mode_1, tx2 + QSERDES_V3_TX_LANE_MODE_1); >> + >> + if (reverse) >> + writel(0xc9, layout->dp_phy + QSERDES_DP_PHY_MODE); >> + else >> + writel(0xd9, layout->dp_phy + QSERDES_DP_PHY_MODE); >> + >> + writel(0x05, layout->dp_phy + QSERDES_V3_DP_PHY_TX0_TX1_LANE_CTL); >> + writel(0x05, layout->dp_phy + QSERDES_V3_DP_PHY_TX2_TX3_LANE_CTL); >> + >> + writel(0x1a, tx + QSERDES_V3_TX_TRANSCEIVER_BIAS_EN); >> + writel(0x40, tx + QSERDES_V3_TX_VMODE_CTRL1); >> + writel(0x30, tx + QSERDES_V3_TX_PRE_STALL_LDO_BOOST_EN); >> + writel(0x3d, tx + QSERDES_V3_TX_INTERFACE_SELECT); >> + writel(0x0f, tx + QSERDES_V3_TX_CLKBUF_ENABLE); >> + writel(0x03, tx + QSERDES_V3_TX_RESET_TSYNC_EN); >> + writel(0x03, tx + QSERDES_V3_TX_TRAN_DRVR_EMP_EN); >> + writel(0x00, tx + QSERDES_V3_TX_PARRATE_REC_DETECT_IDLE_EN); >> + writel(0x00, tx + QSERDES_V3_TX_TX_INTERFACE_MODE); >> + writel(0x2b, tx + QSERDES_V3_TX_TX_EMP_POST1_LVL); >> + writel(0x2f, tx + QSERDES_V3_TX_TX_DRV_LVL); >> + writel(0x04, tx + QSERDES_V3_TX_TX_BAND); >> + writel(0x12, tx + QSERDES_V3_TX_RES_CODE_LANE_OFFSET_TX); >> + writel(0x12, tx + QSERDES_V3_TX_RES_CODE_LANE_OFFSET_RX); >> + >> + writel(0x1a, tx2 + QSERDES_V3_TX_TRANSCEIVER_BIAS_EN); >> + writel(0x40, tx2 + QSERDES_V3_TX_VMODE_CTRL1); >> + writel(0x30, tx2 + QSERDES_V3_TX_PRE_STALL_LDO_BOOST_EN); >> + writel(0x3d, tx2 + QSERDES_V3_TX_INTERFACE_SELECT); >> + writel(0x0f, tx2 + QSERDES_V3_TX_CLKBUF_ENABLE); >> + writel(0x03, tx2 + QSERDES_V3_TX_RESET_TSYNC_EN); >> + writel(0x03, tx2 + QSERDES_V3_TX_TRAN_DRVR_EMP_EN); >> + writel(0x00, tx2 + QSERDES_V3_TX_PARRATE_REC_DETECT_IDLE_EN); >> + writel(0x00, tx2 + QSERDES_V3_TX_TX_INTERFACE_MODE); >> + writel(0x2b, tx2 + QSERDES_V3_TX_TX_EMP_POST1_LVL); >> + writel(0x2f, tx2 + QSERDES_V3_TX_TX_DRV_LVL); >> + writel(0x04, tx2 + QSERDES_V3_TX_TX_BAND); >> + writel(0x12, tx2 + QSERDES_V3_TX_RES_CODE_LANE_OFFSET_TX); >> + writel(0x12, tx2 + QSERDES_V3_TX_RES_CODE_LANE_OFFSET_RX); >> + >> + writel(0x02, layout->dp_serdes + QSERDES_COM_CMN_CONFIG); >> + qmp_usbc_configure_dp_clocks(qmp); >> + >> + ret = cfg->configure_dp_phy(qmp); >> + if (ret) { >> + dev_err(qmp->dev, "failed to config dp phy\n"); >> + goto power_on_unlock; >> + } >> + >> + qmp_usbc_check_dp_phy(qmp, "usbc_dp_power_on_finish"); >> + >> +power_on_unlock: >> + mutex_unlock(&qmp->phy_mutex); >> + >> + return ret; >> +} >> + >> +static int qmp_usbc_dp_power_off(struct phy *phy) >> { >> struct qmp_usbc *qmp = phy_get_drvdata(phy); >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); >> + >> + mutex_lock(&qmp->phy_mutex); >> >> - qmp->mode = mode; >> + /* Assert DP PHY power down */ >> + writel(DP_PHY_PD_CTL_PSR_PWRDN, layout->dp_phy + QSERDES_DP_PHY_PD_CTL); >> + >> + mutex_unlock(&qmp->phy_mutex); >> >> return 0; >> } >> >> -static const struct phy_ops qmp_usbc_phy_ops = { >> - .init = qmp_usbc_enable, >> - .exit = qmp_usbc_disable, >> - .set_mode = qmp_usbc_set_mode, >> +static const struct phy_ops qmp_usbc_usb_phy_ops = { >> + .init = qmp_usbc_usb_enable, >> + .exit = qmp_usbc_usb_disable, >> + .set_mode = qmp_usbc_usb_set_mode, >> + .owner = THIS_MODULE, >> +}; >> + >> +static const struct phy_ops qmp_usbc_dp_phy_ops = { >> + .init = qmp_usbc_dp_init, >> + .exit = qmp_usbc_dp_exit, >> + .configure = qmp_usbc_dp_configure, >> + .calibrate = qmp_usbc_dp_calibrate, >> + .power_on = qmp_usbc_dp_power_on, >> + .power_off = qmp_usbc_dp_power_off, >> .owner = THIS_MODULE, >> }; >> >> static void qmp_usbc_enable_autonomous_mode(struct qmp_usbc *qmp) >> { >> - const struct qmp_phy_cfg *cfg = qmp->cfg; >> - void __iomem *pcs = qmp->pcs; >> + const struct qmp_phy_usb_cfg *cfg = to_usb_cfg(qmp); >> + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); >> + void __iomem *pcs = layout->pcs; >> u32 intr_mask; >> >> - if (qmp->mode == PHY_MODE_USB_HOST_SS || >> - qmp->mode == PHY_MODE_USB_DEVICE_SS) >> + if (layout->mode == PHY_MODE_USB_HOST_SS || >> + layout->mode == PHY_MODE_USB_DEVICE_SS) >> intr_mask = ARCVR_DTCT_EN | ALFPS_DTCT_EN; >> else >> intr_mask = ARCVR_DTCT_EN | ARCVR_DTCT_EVENT_SEL; >> @@ -663,18 +1340,19 @@ static void qmp_usbc_enable_autonomous_mode(struct qmp_usbc *qmp) >> qphy_setbits(pcs, cfg->regs[QPHY_PCS_AUTONOMOUS_MODE_CTRL], intr_mask); >> >> /* Enable i/o clamp_n for autonomous mode */ >> - if (qmp->tcsr_map && qmp->vls_clamp_reg) >> - regmap_write(qmp->tcsr_map, qmp->vls_clamp_reg, 1); >> + if (layout->tcsr_map && layout->vls_clamp_reg) >> + regmap_write(layout->tcsr_map, layout->vls_clamp_reg, 1); >> } >> >> static void qmp_usbc_disable_autonomous_mode(struct qmp_usbc *qmp) >> { >> - const struct qmp_phy_cfg *cfg = qmp->cfg; >> - void __iomem *pcs = qmp->pcs; >> + const struct qmp_phy_usb_cfg *cfg = to_usb_cfg(qmp); >> + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); >> + void __iomem *pcs = layout->pcs; >> >> /* Disable i/o clamp_n on resume for normal mode */ >> - if (qmp->tcsr_map && qmp->vls_clamp_reg) >> - regmap_write(qmp->tcsr_map, qmp->vls_clamp_reg, 0); >> + if (layout->tcsr_map && layout->vls_clamp_reg) >> + regmap_write(layout->tcsr_map, layout->vls_clamp_reg, 0); >> >> qphy_clrbits(pcs, cfg->regs[QPHY_PCS_AUTONOMOUS_MODE_CTRL], >> ARCVR_DTCT_EN | ARCVR_DTCT_EVENT_SEL | ALFPS_DTCT_EN); >> @@ -688,16 +1366,19 @@ static int __maybe_unused qmp_usbc_runtime_suspend(struct device *dev) >> { >> struct qmp_usbc *qmp = dev_get_drvdata(dev); >> >> - dev_vdbg(dev, "Suspending QMP phy, mode:%d\n", qmp->mode); >> - >> if (!qmp->phy->init_count) { >> dev_vdbg(dev, "PHY not initialized, bailing out\n"); >> return 0; >> } >> >> - qmp_usbc_enable_autonomous_mode(qmp); >> + if (qmp->type == QMP_PHY_USBC_USB) { >> + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); >> + >> + dev_vdbg(dev, "Suspending QMP phy, mode:%d\n", layout->mode); >> + qmp_usbc_enable_autonomous_mode(qmp); >> + clk_disable_unprepare(layout->pipe_clk); >> + } >> >> - clk_disable_unprepare(qmp->pipe_clk); >> clk_bulk_disable_unprepare(qmp->num_clks, qmp->clks); >> >> return 0; >> @@ -708,8 +1389,6 @@ static int __maybe_unused qmp_usbc_runtime_resume(struct device *dev) >> struct qmp_usbc *qmp = dev_get_drvdata(dev); >> int ret = 0; >> >> - dev_vdbg(dev, "Resuming QMP phy, mode:%d\n", qmp->mode); >> - >> if (!qmp->phy->init_count) { >> dev_vdbg(dev, "PHY not initialized, bailing out\n"); >> return 0; >> @@ -719,14 +1398,19 @@ static int __maybe_unused qmp_usbc_runtime_resume(struct device *dev) >> if (ret) >> return ret; >> >> - ret = clk_prepare_enable(qmp->pipe_clk); >> - if (ret) { >> - dev_err(dev, "pipe_clk enable failed, err=%d\n", ret); >> - clk_bulk_disable_unprepare(qmp->num_clks, qmp->clks); >> - return ret; >> - } >> + if (qmp->type == QMP_PHY_USBC_USB) { >> + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); >> >> - qmp_usbc_disable_autonomous_mode(qmp); >> + dev_vdbg(dev, "Resuming QMP phy, mode:%d\n", layout->mode); >> + ret = clk_prepare_enable(layout->pipe_clk); >> + if (ret) { >> + dev_err(dev, "pipe_clk enable failed, err=%d\n", ret); >> + clk_bulk_disable_unprepare(qmp->num_clks, qmp->clks); >> + return ret; >> + } >> + >> + qmp_usbc_disable_autonomous_mode(qmp); >> + } >> >> return 0; >> } >> @@ -738,19 +1422,54 @@ static const struct dev_pm_ops qmp_usbc_pm_ops = { >> >> static int qmp_usbc_vreg_init(struct qmp_usbc *qmp) >> { >> - const struct qmp_phy_cfg *cfg = qmp->cfg; >> struct device *dev = qmp->dev; >> - int num = cfg->num_vregs; >> - int i; >> + int ret, i; >> >> - qmp->vregs = devm_kcalloc(dev, num, sizeof(*qmp->vregs), GFP_KERNEL); >> - if (!qmp->vregs) >> - return -ENOMEM; >> + if (qmp->type == QMP_PHY_USBC_USB) { >> + struct qmp_phy_usb_cfg *cfg = to_usb_cfg(qmp); >> + int num = cfg->num_vregs; >> >> - for (i = 0; i < num; i++) >> - qmp->vregs[i].supply = cfg->vreg_list[i]; >> + qmp->vregs = devm_kcalloc(dev, num, sizeof(*qmp->vregs), GFP_KERNEL); >> + if (!qmp->vregs) >> + return -ENOMEM; >> + >> + for (i = 0; i < num; i++) >> + qmp->vregs[i].supply = cfg->vreg_list[i]; >> >> - return devm_regulator_bulk_get(dev, num, qmp->vregs); >> + ret = devm_regulator_bulk_get(dev, num, qmp->vregs); >> + if (ret) { >> + dev_err(dev, "failed at devm_regulator_bulk_get\n"); >> + return ret; >> + } >> + } else { >> + struct qmp_phy_dp_cfg *cfg = to_dp_cfg(qmp); >> + int num = cfg->num_vregs; >> + >> + qmp->vregs = devm_kcalloc(dev, num, sizeof(*qmp->vregs), GFP_KERNEL); >> + if (!qmp->vregs) >> + return -ENOMEM; >> + >> + for (i = 0; i < num; i++) >> + qmp->vregs[i].supply = cfg->vreg_list[i].name; >> + >> + ret = devm_regulator_bulk_get(dev, num, qmp->vregs); >> + if (ret) { >> + dev_err(dev, "failed at devm_regulator_bulk_get\n"); >> + return ret; >> + } >> + >> + for (i = 0; i < num; i++) { >> + ret = regulator_set_load(qmp->vregs[i].consumer, >> + cfg->vreg_list[i].enable_load); >> + if (ret) { >> + dev_err(dev, "failed to set load at %s\n", >> + qmp->vregs[i].supply); >> + return ret; >> + } >> + } >> + } >> + >> + return 0; >> } >> >> static int qmp_usbc_reset_init(struct qmp_usbc *qmp, >> @@ -821,7 +1540,9 @@ static void phy_clk_release_provider(void *res) >> */ >> static int phy_pipe_clk_register(struct qmp_usbc *qmp, struct device_node *np) >> { >> - struct clk_fixed_rate *fixed = &qmp->pipe_clk_fixed; >> + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); >> + >> + struct clk_fixed_rate *fixed = &layout->pipe_clk_fixed; >> struct clk_init_data init = { }; >> int ret; >> >> @@ -864,12 +1585,12 @@ static int qmp_usbc_typec_switch_set(struct typec_switch_dev *sw, >> mutex_lock(&qmp->phy_mutex); >> qmp->orientation = orientation; >> >> - if (qmp->usb_init_count) { >> - qmp_usbc_power_off(qmp->phy); >> - qmp_usbc_exit(qmp->phy); >> + if (qmp->init_count) { >> + qmp_usbc_usb_power_off(qmp->phy); >> + qmp_usbc_com_exit(qmp->phy); >> >> - qmp_usbc_init(qmp->phy); >> - qmp_usbc_power_on(qmp->phy); >> + qmp_usbc_com_init(qmp->phy); >> + qmp_usbc_usb_power_on(qmp->phy); >> } >> >> mutex_unlock(&qmp->phy_mutex); >> @@ -880,22 +1601,24 @@ static int qmp_usbc_typec_switch_set(struct typec_switch_dev *sw, >> static void qmp_usbc_typec_unregister(void *data) >> { >> struct qmp_usbc *qmp = data; >> + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); >> >> - typec_switch_unregister(qmp->sw); >> + typec_switch_unregister(layout->sw); >> } >> >> static int qmp_usbc_typec_switch_register(struct qmp_usbc *qmp) >> { >> struct typec_switch_desc sw_desc = {}; >> struct device *dev = qmp->dev; >> + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); >> >> sw_desc.drvdata = qmp; >> sw_desc.fwnode = dev->fwnode; >> sw_desc.set = qmp_usbc_typec_switch_set; >> - qmp->sw = typec_switch_register(dev, &sw_desc); >> - if (IS_ERR(qmp->sw)) { >> - dev_err(dev, "Unable to register typec switch: %pe\n", qmp->sw); >> - return PTR_ERR(qmp->sw); >> + layout->sw = typec_switch_register(dev, &sw_desc); >> + if (IS_ERR(layout->sw)) { >> + dev_err(dev, "Unable to register typec switch: %pe\n", layout->sw); >> + return PTR_ERR(layout->sw); >> } >> >> return devm_add_action_or_reset(dev, qmp_usbc_typec_unregister, qmp); >> @@ -907,15 +1630,16 @@ static int qmp_usbc_typec_switch_register(struct qmp_usbc *qmp) >> } >> #endif >> >> -static int qmp_usbc_parse_dt_legacy(struct qmp_usbc *qmp, struct device_node *np) >> +static int qmp_usbc_parse_usb_dt_legacy(struct qmp_usbc *qmp, struct device_node *np) >> { >> struct platform_device *pdev = to_platform_device(qmp->dev); >> struct device *dev = qmp->dev; >> + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); >> int ret; >> >> - qmp->serdes = devm_platform_ioremap_resource(pdev, 0); >> - if (IS_ERR(qmp->serdes)) >> - return PTR_ERR(qmp->serdes); >> + layout->serdes = devm_platform_ioremap_resource(pdev, 0); >> + if (IS_ERR(layout->serdes)) >> + return PTR_ERR(layout->serdes); >> >> /* >> * Get memory resources for the PHY: >> @@ -923,35 +1647,35 @@ static int qmp_usbc_parse_dt_legacy(struct qmp_usbc *qmp, struct device_node *np >> * For dual lane PHYs: tx2 -> 3, rx2 -> 4, pcs_misc (optional) -> 5 >> * For single lane PHYs: pcs_misc (optional) -> 3. >> */ >> - qmp->tx = devm_of_iomap(dev, np, 0, NULL); >> - if (IS_ERR(qmp->tx)) >> - return PTR_ERR(qmp->tx); >> + layout->tx = devm_of_iomap(dev, np, 0, NULL); >> + if (IS_ERR(layout->tx)) >> + return PTR_ERR(layout->tx); >> >> - qmp->rx = devm_of_iomap(dev, np, 1, NULL); >> - if (IS_ERR(qmp->rx)) >> - return PTR_ERR(qmp->rx); >> + layout->rx = devm_of_iomap(dev, np, 1, NULL); >> + if (IS_ERR(layout->rx)) >> + return PTR_ERR(layout->rx); >> >> - qmp->pcs = devm_of_iomap(dev, np, 2, NULL); >> - if (IS_ERR(qmp->pcs)) >> - return PTR_ERR(qmp->pcs); >> + layout->pcs = devm_of_iomap(dev, np, 2, NULL); >> + if (IS_ERR(layout->pcs)) >> + return PTR_ERR(layout->pcs); >> >> - qmp->tx2 = devm_of_iomap(dev, np, 3, NULL); >> - if (IS_ERR(qmp->tx2)) >> - return PTR_ERR(qmp->tx2); >> + layout->tx2 = devm_of_iomap(dev, np, 3, NULL); >> + if (IS_ERR(layout->tx2)) >> + return PTR_ERR(layout->tx2); >> >> - qmp->rx2 = devm_of_iomap(dev, np, 4, NULL); >> - if (IS_ERR(qmp->rx2)) >> - return PTR_ERR(qmp->rx2); >> + layout->rx2 = devm_of_iomap(dev, np, 4, NULL); >> + if (IS_ERR(layout->rx2)) >> + return PTR_ERR(layout->rx2); >> >> - qmp->pcs_misc = devm_of_iomap(dev, np, 5, NULL); >> - if (IS_ERR(qmp->pcs_misc)) { >> + layout->pcs_misc = devm_of_iomap(dev, np, 5, NULL); >> + if (IS_ERR(layout->pcs_misc)) { >> dev_vdbg(dev, "PHY pcs_misc-reg not used\n"); >> - qmp->pcs_misc = NULL; >> + layout->pcs_misc = NULL; >> } >> >> - qmp->pipe_clk = devm_get_clk_from_child(dev, np, NULL); >> - if (IS_ERR(qmp->pipe_clk)) { >> - return dev_err_probe(dev, PTR_ERR(qmp->pipe_clk), >> + layout->pipe_clk = devm_get_clk_from_child(dev, np, NULL); >> + if (IS_ERR(layout->pipe_clk)) { >> + return dev_err_probe(dev, PTR_ERR(layout->pipe_clk), >> "failed to get pipe clock\n"); >> } >> >> @@ -969,11 +1693,12 @@ static int qmp_usbc_parse_dt_legacy(struct qmp_usbc *qmp, struct device_node *np >> return 0; >> } >> >> -static int qmp_usbc_parse_dt(struct qmp_usbc *qmp) >> +static int qmp_usbc_parse_usb_dt(struct qmp_usbc *qmp) >> { >> struct platform_device *pdev = to_platform_device(qmp->dev); >> - const struct qmp_phy_cfg *cfg = qmp->cfg; >> - const struct qmp_usbc_offsets *offs = cfg->offsets; >> + const struct qmp_phy_usb_cfg *cfg = to_usb_cfg(qmp); >> + const struct qmp_usbc_usb_offsets *offs = cfg->offsets; >> + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); >> struct device *dev = qmp->dev; >> void __iomem *base; >> int ret; >> @@ -985,23 +1710,23 @@ static int qmp_usbc_parse_dt(struct qmp_usbc *qmp) >> if (IS_ERR(base)) >> return PTR_ERR(base); >> >> - qmp->serdes = base + offs->serdes; >> - qmp->pcs = base + offs->pcs; >> + layout->serdes = base + offs->serdes; >> + layout->pcs = base + offs->pcs; >> if (offs->pcs_misc) >> - qmp->pcs_misc = base + offs->pcs_misc; >> - qmp->tx = base + offs->tx; >> - qmp->rx = base + offs->rx; >> + layout->pcs_misc = base + offs->pcs_misc; >> + layout->tx = base + offs->tx; >> + layout->rx = base + offs->rx; >> >> - qmp->tx2 = base + offs->tx2; >> - qmp->rx2 = base + offs->rx2; >> + layout->tx2 = base + offs->tx2; >> + layout->rx2 = base + offs->rx2; >> >> ret = qmp_usbc_clk_init(qmp); >> if (ret) >> return ret; >> >> - qmp->pipe_clk = devm_clk_get(dev, "pipe"); >> - if (IS_ERR(qmp->pipe_clk)) { >> - return dev_err_probe(dev, PTR_ERR(qmp->pipe_clk), >> + layout->pipe_clk = devm_clk_get(dev, "pipe"); >> + if (IS_ERR(layout->pipe_clk)) { >> + return dev_err_probe(dev, PTR_ERR(layout->pipe_clk), >> "failed to get pipe clock\n"); >> } >> >> @@ -1013,10 +1738,11 @@ static int qmp_usbc_parse_dt(struct qmp_usbc *qmp) >> return 0; >> } >> >> -static int qmp_usbc_parse_vls_clamp(struct qmp_usbc *qmp) >> +static int qmp_usbc_parse_usb_vls_clamp(struct qmp_usbc *qmp) >> { >> struct of_phandle_args tcsr_args; >> struct device *dev = qmp->dev; >> + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); >> int ret; >> >> /* for backwards compatibility ignore if there is no property */ >> @@ -1027,22 +1753,280 @@ static int qmp_usbc_parse_vls_clamp(struct qmp_usbc *qmp) >> else if (ret < 0) >> return dev_err_probe(dev, ret, "Failed to parse qcom,tcsr-reg\n"); >> >> - qmp->tcsr_map = syscon_node_to_regmap(tcsr_args.np); >> + layout->tcsr_map = syscon_node_to_regmap(tcsr_args.np); >> of_node_put(tcsr_args.np); >> - if (IS_ERR(qmp->tcsr_map)) >> - return PTR_ERR(qmp->tcsr_map); >> + if (IS_ERR(layout->tcsr_map)) >> + return PTR_ERR(layout->tcsr_map); >> >> - qmp->vls_clamp_reg = tcsr_args.args[0]; >> + layout->vls_clamp_reg = tcsr_args.args[0]; >> >> return 0; >> } >> >> +static int qmp_usbc_parse_dp_phy_mode(struct qmp_usbc *qmp) >> +{ >> + struct of_phandle_args tcsr_args; >> + struct device *dev = qmp->dev; >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); >> + int ret; >> + >> + /* for backwards compatibility ignore if there is no property */ >> + ret = of_parse_phandle_with_fixed_args(dev->of_node, "qcom,tcsr-reg", 1, 0, >> + &tcsr_args); >> + if (ret < 0) >> + return dev_err_probe(dev, ret, "Failed to parse qcom,tcsr-reg\n"); >> + >> + layout->tcsr_map = syscon_node_to_regmap(tcsr_args.np); >> + of_node_put(tcsr_args.np); >> + if (IS_ERR(layout->tcsr_map)) >> + return PTR_ERR(layout->tcsr_map); >> + >> + layout->dp_phy_mode = tcsr_args.args[0]; >> + >> + return 0; >> +} >> + >> +static int qmp_usbc_parse_dp_dt(struct qmp_usbc *qmp) >> +{ >> + struct platform_device *pdev = to_platform_device(qmp->dev); >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); >> + struct qmp_phy_dp_cfg *cfg = to_dp_cfg(qmp); >> + const struct qmp_usbc_dp_offsets *offs = cfg->offsets; >> + struct device *dev = qmp->dev; >> + void __iomem *base; >> + int ret; >> + >> + base = devm_platform_ioremap_resource(pdev, 0); >> + if (IS_ERR(base)) { >> + dev_err(dev, "get resource fail, ret:%d\n", ret); >> + return PTR_ERR(base); >> + } >> + >> + layout->dp_serdes = base + offs->dp_serdes; >> + layout->dp_tx = base + offs->dp_txa; >> + layout->dp_tx2 = base + offs->dp_txb; >> + layout->dp_phy = base + offs->dp_phy; >> + >> + ret = qmp_usbc_clk_init(qmp); >> + if (ret) { >> + dev_err(dev, "clk init fail, ret:%d\n", ret); >> + return ret; >> + } >> + >> + ret = qmp_usbc_reset_init(qmp, dp_usb3phy_reset_l, >> + ARRAY_SIZE(dp_usb3phy_reset_l)); >> + if (ret) >> + return ret; >> + >> + return 0; >> +} >> + >> +/* >> + * Display Port PLL driver block diagram for branch clocks >> + * >> + * +------------------------------+ >> + * | DP_VCO_CLK | >> + * | | >> + * | +-------------------+ | >> + * | | (DP PLL/VCO) | | >> + * | +---------+---------+ | >> + * | v | >> + * | +----------+-----------+ | >> + * | | hsclk_divsel_clk_src | | >> + * | +----------+-----------+ | >> + * +------------------------------+ >> + * | >> + * +---------<---------v------------>----------+ >> + * | | >> + * +--------v----------------+ | >> + * | dp_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 >> + * | >> + * +----------+-----------------+ >> + * | dp_phy_pll_vco_div_clk | >> + * +---------+------------------+ >> + * | >> + * v >> + * Input to DISPCC block >> + * for DP pixel clock >> + * >> + */ >> +static int qmp_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 qmp_dp_pixel_clk_recalc_rate(struct clk_hw *hw, unsigned long parent_rate) >> +{ >> + // const struct qmp_usbc *qmp; >> + struct qmp_phy_dp_layout *layout; >> + const struct phy_configure_opts_dp *dp_opts; >> + >> + layout = container_of(hw, struct qmp_phy_dp_layout, dp_pixel_hw); >> + >> + dp_opts = &layout->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 qmp_dp_pixel_clk_ops = { >> + .determine_rate = qmp_dp_pixel_clk_determine_rate, >> + .recalc_rate = qmp_dp_pixel_clk_recalc_rate, >> +}; >> + >> +static int qmp_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 qmp_dp_link_clk_recalc_rate(struct clk_hw *hw, unsigned long parent_rate) >> +{ >> + // const struct qmp_combo *qmp; >> + struct qmp_phy_dp_layout *layout; >> + const struct phy_configure_opts_dp *dp_opts; >> + >> + layout = container_of(hw, struct qmp_phy_dp_layout, dp_link_hw); >> + dp_opts = &layout->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 qmp_dp_link_clk_ops = { >> + .determine_rate = qmp_dp_link_clk_determine_rate, >> + .recalc_rate = qmp_dp_link_clk_recalc_rate, >> +}; >> + >> +static int phy_dp_clks_register(struct qmp_usbc *qmp, struct device_node *np) >> +{ >> + struct clk_init_data init = { }; >> + int ret = 0; >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); >> + >> + ret = of_property_read_string_index(np, "clock-output-names", 0, &init.name); >> + if (ret < 0) { >> + dev_err(qmp->dev, "%pOFn: No link clock-output-names\n", np); >> + return ret; >> + } >> + >> + init.ops = &qmp_dp_link_clk_ops; >> + layout->dp_link_hw.init = &init; >> + ret = devm_clk_hw_register(qmp->dev, &layout->dp_link_hw); >> + if (ret < 0) { >> + dev_err(qmp->dev, "link clk reg fail ret=%d\n", ret); >> + return ret; >> + } >> + >> + ret = of_property_read_string_index(np, "clock-output-names", 1, &init.name); >> + if (ret) { >> + dev_err(qmp->dev, "%pOFn: No div clock-output-names\n", np); >> + return ret; >> + } >> + >> + init.ops = &qmp_dp_pixel_clk_ops; >> + layout->dp_pixel_hw.init = &init; >> + ret = devm_clk_hw_register(qmp->dev, &layout->dp_pixel_hw); >> + if (ret) { >> + dev_err(qmp->dev, "pxl clk reg fail ret=%d\n", ret); >> + return ret; >> + } >> + >> + return 0; >> +} >> + >> +static struct clk_hw *qmp_dp_clks_hw_get(struct of_phandle_args *clkspec, void *data) >> +{ >> + struct qmp_usbc *qmp = data; >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); >> + >> + switch (clkspec->args[0]) { >> + case QMP_USB43DP_DP_LINK_CLK: >> + return &layout->dp_link_hw; >> + case QMP_USB43DP_DP_VCO_DIV_CLK: >> + return &layout->dp_pixel_hw; >> + } >> + >> + return ERR_PTR(-EINVAL); >> +} >> + >> +static int qmp_dp_register_clocks(struct qmp_usbc *qmp, struct device_node *dp_np) >> +{ >> + int ret; >> + >> + ret = phy_dp_clks_register(qmp, dp_np); >> + if (ret) { >> + dev_err(qmp->dev, "dp clk reg fail ret:%d\n", ret); >> + return ret; >> + } >> + >> + ret = of_clk_add_hw_provider(dp_np, qmp_dp_clks_hw_get, qmp); >> + if (ret) { >> + dev_err(qmp->dev, "add provider fail ret:%d\n", ret); >> + return ret; >> + } >> + >> + return devm_add_action_or_reset(qmp->dev, phy_clk_release_provider, dp_np); >> +} >> + >> static int qmp_usbc_probe(struct platform_device *pdev) >> { >> struct device *dev = &pdev->dev; >> struct phy_provider *phy_provider; >> struct device_node *np; >> struct qmp_usbc *qmp; >> + const struct dev_cfg *data_cfg; >> int ret; >> >> qmp = devm_kzalloc(dev, sizeof(*qmp), GFP_KERNEL); >> @@ -1050,38 +2034,74 @@ static int qmp_usbc_probe(struct platform_device *pdev) >> return -ENOMEM; >> >> qmp->dev = dev; >> - dev_set_drvdata(dev, qmp); >> >> qmp->orientation = TYPEC_ORIENTATION_NORMAL; >> >> - qmp->cfg = of_device_get_match_data(dev); >> - if (!qmp->cfg) >> + qmp->init_count = 0; >> + >> + data_cfg = of_device_get_match_data(dev); >> + if (!data_cfg) { >> + dev_err(qmp->dev, "get data fail\n"); >> return -EINVAL; >> + } >> >> mutex_init(&qmp->phy_mutex); >> >> - ret = qmp_usbc_vreg_init(qmp); >> - if (ret) >> - return ret; >> + qmp->type = data_cfg->type; >> + qmp->cfg = data_cfg->cfg; >> >> - ret = qmp_usbc_typec_switch_register(qmp); >> - if (ret) >> + ret = qmp_usbc_vreg_init(qmp); >> + if (ret) { >> + dev_err(qmp->dev, "qmp_type(%d) vreg init fail\n", qmp->type); >> return ret; >> + } >> >> - ret = qmp_usbc_parse_vls_clamp(qmp); >> - if (ret) >> - return ret; >> + if (qmp->type == QMP_PHY_USBC_USB) { >> + qmp->layout = devm_kzalloc(dev, sizeof(struct qmp_phy_usb_layout), GFP_KERNEL); >> + if (!qmp->layout) >> + return -ENOMEM; >> + >> + ret = qmp_usbc_typec_switch_register(qmp); >> + if (ret) >> + return ret; >> + >> + ret = qmp_usbc_parse_usb_vls_clamp(qmp); >> + if (ret) >> + return ret; >> + >> + /* Check for legacy binding with child node. */ >> + np = of_get_child_by_name(dev->of_node, "phy"); >> + if (np) { >> + ret = qmp_usbc_parse_usb_dt_legacy(qmp, np); >> + } else { >> + np = of_node_get(dev->of_node); >> + ret = qmp_usbc_parse_usb_dt(qmp); >> + } >> + if (ret) >> + goto err_node_put; >> + } else if (qmp->type == QMP_PHY_USBC_DP) { >> + qmp->layout = devm_kzalloc(dev, sizeof(struct qmp_phy_dp_layout), GFP_KERNEL); >> + if (!qmp->layout) >> + return -ENOMEM; >> >> - /* Check for legacy binding with child node. */ >> - np = of_get_child_by_name(dev->of_node, "phy"); >> - if (np) { >> - ret = qmp_usbc_parse_dt_legacy(qmp, np); >> - } else { >> np = of_node_get(dev->of_node); >> - ret = qmp_usbc_parse_dt(qmp); >> - } >> - if (ret) >> + ret = qmp_usbc_parse_dp_phy_mode(qmp); >> + if (ret) >> + goto err_node_put; >> + >> + ret = qmp_usbc_parse_dp_dt(qmp); >> + if (ret) >> + goto err_node_put; >> + >> + ret = drm_aux_bridge_register(dev); >> + if (ret) { >> + dev_err(qmp->dev, "aux bridge reg fail ret=%d\n", ret); >> + goto err_node_put; >> + } >> + } else { >> + dev_err(dev, "invalid phy type: %d\n", qmp->type); >> goto err_node_put; >> + } >> >> pm_runtime_set_active(dev); >> ret = devm_pm_runtime_enable(dev); >> @@ -1093,19 +2113,33 @@ static int qmp_usbc_probe(struct platform_device *pdev) >> */ >> pm_runtime_forbid(dev); >> >> - ret = phy_pipe_clk_register(qmp, np); >> - if (ret) >> - goto err_node_put; >> - >> - qmp->phy = devm_phy_create(dev, np, &qmp_usbc_phy_ops); >> - if (IS_ERR(qmp->phy)) { >> - ret = PTR_ERR(qmp->phy); >> - dev_err(dev, "failed to create PHY: %d\n", ret); >> - goto err_node_put; >> + if (qmp->type == QMP_PHY_USBC_USB) { >> + // pipe clk process >> + ret = phy_pipe_clk_register(qmp, np); >> + if (ret) >> + goto err_node_put; >> + >> + qmp->phy = devm_phy_create(dev, np, &qmp_usbc_usb_phy_ops); >> + if (IS_ERR(qmp->phy)) { >> + ret = PTR_ERR(qmp->phy); >> + dev_err(dev, "failed to create PHY: %d\n", ret); >> + goto err_node_put; >> + } >> + } else { >> + ret = qmp_dp_register_clocks(qmp, np); >> + if (ret) >> + goto err_node_put; >> + >> + qmp->phy = devm_phy_create(dev, np, &qmp_usbc_dp_phy_ops); >> + if (IS_ERR(qmp->phy)) { >> + ret = PTR_ERR(qmp->phy); >> + dev_err(dev, "failed to create PHY: %d\n", ret); >> + goto err_node_put; >> + } >> } >> >> phy_set_drvdata(qmp->phy, qmp); >> - >> + dev_set_drvdata(dev, qmp); >> of_node_put(np); >> >> phy_provider = devm_of_phy_provider_register(dev, of_phy_simple_xlate); >> @@ -1120,19 +2154,38 @@ static int qmp_usbc_probe(struct platform_device *pdev) >> static const struct of_device_id qmp_usbc_of_match_table[] = { >> { >> .compatible = "qcom,msm8998-qmp-usb3-phy", >> - .data = &msm8998_usb3phy_cfg, >> + .data = &(struct dev_cfg) { >> + .type = QMP_PHY_USBC_USB, >> + .cfg = &msm8998_usb3phy_cfg, >> + }, >> }, { >> .compatible = "qcom,qcm2290-qmp-usb3-phy", >> - .data = &qcm2290_usb3phy_cfg, >> + .data = &(struct dev_cfg) { >> + .type = QMP_PHY_USBC_USB, >> + .cfg = &qcm2290_usb3phy_cfg, >> + }, >> + }, { >> + .compatible = "qcom,qcs615-qmp-dp-phy", >> + .data = &(struct dev_cfg) { >> + .type = QMP_PHY_USBC_DP, >> + .cfg = &qcs615_dpphy_cfg, >> + }, >> }, { >> .compatible = "qcom,sdm660-qmp-usb3-phy", >> - .data = &sdm660_usb3phy_cfg, >> + .data = &(struct dev_cfg) { >> + .type = QMP_PHY_USBC_USB, >> + .cfg = &sdm660_usb3phy_cfg, >> + }, >> }, { >> .compatible = "qcom,sm6115-qmp-usb3-phy", >> - .data = &qcm2290_usb3phy_cfg, >> + .data = &(struct dev_cfg) { >> + .type = QMP_PHY_USBC_USB, >> + .cfg = &qcm2290_usb3phy_cfg, >> + }, >> }, >> { }, >> }; >> + >> MODULE_DEVICE_TABLE(of, qmp_usbc_of_match_table); >> >> static struct platform_driver qmp_usbc_driver = { >> >> -- >> 2.25.1 >> > >
On Thu, Dec 05, 2024 at 09:26:47PM +0800, Xiangxu Yin wrote: > > > On 11/29/2024 10:33 PM, Dmitry Baryshkov wrote: > > On Fri, 29 Nov 2024 at 09:59, Xiangxu Yin <quic_xiangxuy@quicinc.com> wrote: > >> > >> Extended DP support for QCS615 USB or DP phy. Differentiated between > >> USBC and DP PHY using the match table’s type, dynamically generating > >> different types of cfg and layout attributes during initialization based > >> on this type. Static variables are stored in cfg, while parsed values > >> are organized into the layout structure. > > > > We didn't have an understanding / conclusion whether > > qcom,usb-ssphy-qmp-usb3-or-dp PHYs are actually a single device / PHY > > or two PHYs being placed next to each other. Could you please start > > your commit message by explaining it? Or even better, make that a part > > of the cover letter for a new series touching just the USBC PHY > > driver. DP changes don't have anything in common with the PHY changes, > > so you can split the series into two. > > > Before implement DP extension, we have discussed with abhinav and krishna about whether use combo, usbc or separate phy. What is "DP extension"? > > We identified that DP and USB share some common controls for phy_mode and orientation. > Specifically, 'TCSR_USB3_0_DP_PHYMODE' controls who must use the lanes - USB or DP, > while PERIPH_SS_USB0_USB3PHY_PCS_MISC_TYPEC_CTRL controls the orientation. > It would be more efficient for a single driver to manage these controls. The question is about the hardware, not about the driver. > Additionally, this PHY does not support Alt Mode, and the two control registers are located in separate address spaces. > Therefore, even though the orientation for DP on this platform is always normal and connected to the video output board, > we still decided to base it on the USBC extension. Could you please clarify, do usb3-or-dp PHYs support DP-over-USB-C? I thought that usbc-or-dp platforms support that, but they don't support DP+USB pin configuration. Note, the question is broader than just QCS615, it covers the PHY type itself. Also, is TCSR configuration read/write or read-only? Are we supposed to set the register from OS or are we supposed to read it and thus detemine the PHY mode? Anyway, judging on my understanding the platform configuration should contain both USB and DP bits with the driver registering a single PHY which supports switching between USB and DP (TCSR register is R/W) or a single PHY which provides USBC or DP functionality depending on the TCSR register contents (if it is R/O) Andwhat is "USBC extension", BTW? > >> > >> Signed-off-by: Xiangxu Yin <quic_xiangxuy@quicinc.com> > >> --- > >> drivers/phy/qualcomm/phy-qcom-qmp-dp-phy.h | 1 + > >> drivers/phy/qualcomm/phy-qcom-qmp-usbc.c | 1453 ++++++++++++++++++++++++---- > > > > Too many changes for a single patch. Please split into logical chunks. > > > Ok. > Once we have clarified the overall direction, > we can then discuss whether to split on current list or create a new list for the split. > >> 2 files changed, 1254 insertions(+), 200 deletions(-) > >> > >> diff --git a/drivers/phy/qualcomm/phy-qcom-qmp-dp-phy.h b/drivers/phy/qualcomm/phy-qcom-qmp-dp-phy.h > >> index 0ebd405bcaf0cac8215550bfc9b226f30cc43a59..59885616405f878885d0837838a0bac1899fb69f 100644 > >> --- a/drivers/phy/qualcomm/phy-qcom-qmp-dp-phy.h > >> +++ b/drivers/phy/qualcomm/phy-qcom-qmp-dp-phy.h > >> @@ -25,6 +25,7 @@ > >> #define QSERDES_DP_PHY_AUX_CFG7 0x03c > >> #define QSERDES_DP_PHY_AUX_CFG8 0x040 > >> #define QSERDES_DP_PHY_AUX_CFG9 0x044 > >> +#define QSERDES_DP_PHY_VCO_DIV 0x068 > >> > >> /* QSERDES COM_BIAS_EN_CLKBUFLR_EN bits */ > >> # define QSERDES_V3_COM_BIAS_EN 0x0001 > >> diff --git a/drivers/phy/qualcomm/phy-qcom-qmp-usbc.c b/drivers/phy/qualcomm/phy-qcom-qmp-usbc.c > >> index cf12a6f12134dc77ff032f967b2efa43e3de4b21..7fece9d7dc959ed5a7c62077d8552324c3734859 100644 > >> --- a/drivers/phy/qualcomm/phy-qcom-qmp-usbc.c > >> +++ b/drivers/phy/qualcomm/phy-qcom-qmp-usbc.c > >> @@ -22,13 +22,20 @@ > >> #include <linux/slab.h> > >> #include <linux/usb/typec.h> > >> #include <linux/usb/typec_mux.h> > >> +#include <dt-bindings/phy/phy-qcom-qmp.h> > >> +#include <drm/bridge/aux-bridge.h> > >> > >> #include "phy-qcom-qmp-common.h" > >> > >> #include "phy-qcom-qmp.h" > >> #include "phy-qcom-qmp-pcs-misc-v3.h" > >> > >> +#include "phy-qcom-qmp-dp-phy.h" > >> +#include "phy-qcom-qmp-dp-phy-v3.h" > >> + > >> #define PHY_INIT_COMPLETE_TIMEOUT 10000 > >> +#define SW_PORTSELECT_VAL BIT(0) > >> +#define SW_PORTSELECT_MUX BIT(1) > >> > >> /* set of registers with offsets different per-PHY */ > >> enum qphy_reg_layout { > >> @@ -284,7 +291,26 @@ static const struct qmp_phy_init_tbl qcm2290_usb3_pcs_tbl[] = { > >> QMP_PHY_INIT_CFG(QPHY_V3_PCS_RX_SIGDET_LVL, 0x88), > >> }; > >> > >> -struct qmp_usbc_offsets { > >> +enum qmp_phy_usbc_type { > >> + QMP_PHY_USBC_INVALID, > > > > How can a type be invalid? > > > I thought that platformdata must specify a type, so I set the default value to ‘invalid’. > I will remove this in a future patch. > >> + QMP_PHY_USBC_USB, > >> + QMP_PHY_USBC_DP, > >> +}; > >> + > >> +/* list of regulators */ > >> +struct qmp_regulator_data { > >> + const char *name; > >> + unsigned int enable_load; > >> +}; > >> + > >> +struct dev_cfg { > >> + int type; > >> + const void *cfg; > >> +}; > >> + > >> +struct qmp_usbc; > >> + > >> +struct qmp_usbc_usb_offsets { > >> u16 serdes; > >> u16 pcs; > >> u16 pcs_misc; > >> @@ -295,9 +321,9 @@ struct qmp_usbc_offsets { > >> u16 rx2; > >> }; > >> > >> -/* struct qmp_phy_cfg - per-PHY initialization config */ > >> -struct qmp_phy_cfg { > >> - const struct qmp_usbc_offsets *offsets; > >> +/* struct qmp_phy_usb_cfg - per-usb PHY initialization config */ > > > > what is "per-usb PHY"? > > > Each usb phy in which defined in platform data. > Shall I remove this annotation? I don't know how to answer your question, I can not understand the comment at all. First of all, it's USB not usb. Then, dropping "per" makes that sound more logically. > >> +struct qmp_phy_usb_cfg { > >> + const struct qmp_usbc_usb_offsets *offsets; > >> > >> /* Init sequence for PHY blocks - serdes, tx, rx, pcs */ > >> const struct qmp_phy_init_tbl *serdes_tbl; > >> @@ -317,11 +343,7 @@ struct qmp_phy_cfg { > >> const unsigned int *regs; > >> }; > >> > >> -struct qmp_usbc { > >> - struct device *dev; > >> - > >> - const struct qmp_phy_cfg *cfg; > >> - > >> +struct qmp_phy_usb_layout { > >> void __iomem *serdes; > >> void __iomem *pcs; > >> void __iomem *pcs_misc; > >> @@ -329,28 +351,67 @@ struct qmp_usbc { > >> void __iomem *rx; > >> void __iomem *tx2; > >> void __iomem *rx2; > >> - > >> struct regmap *tcsr_map; > >> u32 vls_clamp_reg; > >> - > >> + enum phy_mode mode; > >> + struct typec_switch_dev *sw; > >> struct clk *pipe_clk; > >> + struct clk_fixed_rate pipe_clk_fixed; > >> +}; > >> + > >> +struct qmp_usbc_dp_offsets { > >> + u16 dp_serdes; > >> + u16 dp_txa; > >> + u16 dp_txb; > >> + u16 dp_phy; > >> +}; > >> + > >> +/* struct qmp_phy_dp_cfg - per-dp PHY initialization config */ Likewise. There is no per-DP, because there are no multiple DP PHYs. It's just a DP PHY config. > >> +struct qmp_phy_dp_cfg { > >> + const struct qmp_usbc_dp_offsets *offsets; > >> + > >> + /* DP PHY swing and pre_emphasis tables */ > >> + const u8 (*swing_tbl)[4][4]; > >> + const u8 (*pre_emphasis_tbl)[4][4]; > >> + > >> + // /* DP PHY callbacks */ > >> + int (*dp_aux_init)(struct qmp_usbc *qmp); > >> + int (*configure_dp_serdes)(struct qmp_usbc *qmp); > >> + int (*configure_dp_voltages)(struct qmp_usbc *qmp); > >> + int (*configure_dp_phy)(struct qmp_usbc *qmp); > >> + int (*calibrate_dp_phy)(struct qmp_usbc *qmp); > >> + > >> + const struct qmp_regulator_data *vreg_list; > >> + int num_vregs; > >> +}; > >> + > >> +struct qmp_phy_dp_layout { > >> + void __iomem *dp_phy; > >> + void __iomem *dp_tx; > >> + void __iomem *dp_tx2; > >> + void __iomem *dp_serdes; > >> + struct regmap *tcsr_map; > >> + u32 dp_phy_mode; > >> + unsigned int dp_aux_cfg; > >> + struct phy_configure_opts_dp dp_opts; > >> + struct clk_hw dp_link_hw; > >> + struct clk_hw dp_pixel_hw; > >> +}; > >> + > >> +struct qmp_usbc { > >> + struct device *dev; > >> + int type; > >> struct clk_bulk_data *clks; > >> int num_clks; > >> int num_resets; > >> struct reset_control_bulk_data *resets; > >> struct regulator_bulk_data *vregs; > >> - > >> struct mutex phy_mutex; > >> - > >> - enum phy_mode mode; > >> - unsigned int usb_init_count; > >> - > >> struct phy *phy; > >> - > >> - struct clk_fixed_rate pipe_clk_fixed; > >> - > >> - struct typec_switch_dev *sw; > >> enum typec_orientation orientation; > >> + unsigned int init_count; > >> + const void *cfg; > >> + void *layout; > > > > The patch contains a mixture of renames bundled with actual changes. > > Please explain why old names are bad in a separate patch. > > > Ok, The renaming is mainly to distinguish which structures are for USB or DP, which are fixed configurations, and which are dynamically parsed variables. > After we clarify the overall direction, If still implement in usbc, > will seperate to below 4 patchsets. > 1.renaming and structural adjustments for the USB driver > 2.structure definitions for DP extension. > 3.common callback functions for DP. > 4.platform-related functions for DP. > > >> }; > >> > >> static inline void qphy_setbits(void __iomem *base, u32 offset, u32 val) > >> @@ -391,12 +452,21 @@ static const char * const usb3phy_reset_l[] = { > >> "phy_phy", "phy", > >> }; > >> > >> +static const char * const dp_usb3phy_reset_l[] = { > >> + "phy", > >> +}; > >> + > >> /* list of regulators */ > >> -static const char * const qmp_phy_vreg_l[] = { > >> +static const char * const qmp_phy_usb_vreg_l[] = { > >> "vdda-phy", "vdda-pll", > >> }; > >> > >> -static const struct qmp_usbc_offsets qmp_usbc_offsets_v3_qcm2290 = { > >> +static struct qmp_regulator_data qmp_phy_dp_vreg_l[] = { > >> + { .name = "vdda-phy", .enable_load = 21800 }, > >> + { .name = "vdda-pll", .enable_load = 36000 }, > >> +}; > >> + > >> +static const struct qmp_usbc_usb_offsets qmp_usbc_usb_offsets_v3_qcm2290 = { > >> .serdes = 0x0, > >> .pcs = 0xc00, > >> .pcs_misc = 0xa00, > >> @@ -406,8 +476,15 @@ static const struct qmp_usbc_offsets qmp_usbc_offsets_v3_qcm2290 = { > >> .rx2 = 0x800, > >> }; > >> > >> -static const struct qmp_phy_cfg msm8998_usb3phy_cfg = { > >> - .offsets = &qmp_usbc_offsets_v3_qcm2290, > >> +static const struct qmp_usbc_dp_offsets qmp_usbc_dp_offsets_qcs615 = { > >> + .dp_serdes = 0x0C00, > >> + .dp_txa = 0x0400, > >> + .dp_txb = 0x0800, > >> + .dp_phy = 0x0000, > >> +}; > >> + > >> +static const struct qmp_phy_usb_cfg msm8998_usb3phy_cfg = { > >> + .offsets = &qmp_usbc_usb_offsets_v3_qcm2290, > >> > >> .serdes_tbl = msm8998_usb3_serdes_tbl, > >> .serdes_tbl_num = ARRAY_SIZE(msm8998_usb3_serdes_tbl), > >> @@ -417,13 +494,13 @@ static const struct qmp_phy_cfg msm8998_usb3phy_cfg = { > >> .rx_tbl_num = ARRAY_SIZE(msm8998_usb3_rx_tbl), > >> .pcs_tbl = msm8998_usb3_pcs_tbl, > >> .pcs_tbl_num = ARRAY_SIZE(msm8998_usb3_pcs_tbl), > >> - .vreg_list = qmp_phy_vreg_l, > >> - .num_vregs = ARRAY_SIZE(qmp_phy_vreg_l), > >> + .vreg_list = qmp_phy_usb_vreg_l, > >> + .num_vregs = ARRAY_SIZE(qmp_phy_usb_vreg_l), > >> .regs = qmp_v3_usb3phy_regs_layout, > >> }; > >> > >> -static const struct qmp_phy_cfg qcm2290_usb3phy_cfg = { > >> - .offsets = &qmp_usbc_offsets_v3_qcm2290, > >> +static const struct qmp_phy_usb_cfg qcm2290_usb3phy_cfg = { > >> + .offsets = &qmp_usbc_usb_offsets_v3_qcm2290, > >> > >> .serdes_tbl = qcm2290_usb3_serdes_tbl, > >> .serdes_tbl_num = ARRAY_SIZE(qcm2290_usb3_serdes_tbl), > >> @@ -433,13 +510,13 @@ static const struct qmp_phy_cfg qcm2290_usb3phy_cfg = { > >> .rx_tbl_num = ARRAY_SIZE(qcm2290_usb3_rx_tbl), > >> .pcs_tbl = qcm2290_usb3_pcs_tbl, > >> .pcs_tbl_num = ARRAY_SIZE(qcm2290_usb3_pcs_tbl), > >> - .vreg_list = qmp_phy_vreg_l, > >> - .num_vregs = ARRAY_SIZE(qmp_phy_vreg_l), > >> + .vreg_list = qmp_phy_usb_vreg_l, > >> + .num_vregs = ARRAY_SIZE(qmp_phy_usb_vreg_l), > >> .regs = qmp_v3_usb3phy_regs_layout_qcm2290, > >> }; > >> > >> -static const struct qmp_phy_cfg sdm660_usb3phy_cfg = { > >> - .offsets = &qmp_usbc_offsets_v3_qcm2290, > >> +static const struct qmp_phy_usb_cfg sdm660_usb3phy_cfg = { > >> + .offsets = &qmp_usbc_usb_offsets_v3_qcm2290, > >> > >> .serdes_tbl = qcm2290_usb3_serdes_tbl, > >> .serdes_tbl_num = ARRAY_SIZE(qcm2290_usb3_serdes_tbl), > >> @@ -449,20 +526,352 @@ static const struct qmp_phy_cfg sdm660_usb3phy_cfg = { > >> .rx_tbl_num = ARRAY_SIZE(sdm660_usb3_rx_tbl), > >> .pcs_tbl = qcm2290_usb3_pcs_tbl, > >> .pcs_tbl_num = ARRAY_SIZE(qcm2290_usb3_pcs_tbl), > >> - .vreg_list = qmp_phy_vreg_l, > >> - .num_vregs = ARRAY_SIZE(qmp_phy_vreg_l), > >> + .vreg_list = qmp_phy_usb_vreg_l, > >> + .num_vregs = ARRAY_SIZE(qmp_phy_usb_vreg_l), > >> .regs = qmp_v3_usb3phy_regs_layout_qcm2290, > >> }; > >> > >> -static int qmp_usbc_init(struct phy *phy) > >> +static const u8 qmp_dp_pre_emphasis_hbr2_rbr[4][4] = { > >> + {0x00, 0x0B, 0x12, 0xFF}, /* pe0, 0 db */ > >> + {0x00, 0x0A, 0x12, 0xFF}, /* pe1, 3.5 db */ > >> + {0x00, 0x0C, 0xFF, 0xFF}, /* pe2, 6.0 db */ > >> + {0xFF, 0xFF, 0xFF, 0xFF} /* pe3, 9.5 db */ > >> +}; > >> + > >> +static const u8 qmp_dp_voltage_swing_hbr2_rbr[4][4] = { > >> + {0x07, 0x0F, 0x14, 0xFF}, /* sw0, 0.4v */ > >> + {0x11, 0x1D, 0x1F, 0xFF}, /* sw1, 0.6 v */ > >> + {0x18, 0x1F, 0xFF, 0xFF}, /* sw1, 0.8 v */ > >> + {0xFF, 0xFF, 0xFF, 0xFF} /* sw1, 1.2 v, optional */ > >> +}; > >> + > >> +static int qcs615_qmp_dp_aux_init(struct qmp_usbc *qmp); > >> +static int qcs615_qmp_configure_dp_serdes(struct qmp_usbc *qmp); > >> +static int qcs615_qmp_configure_dp_voltages(struct qmp_usbc *qmp); > >> +static int qcs615_qmp_configure_dp_phy(struct qmp_usbc *qmp); > >> +static int qcs615_qmp_calibrate_dp_phy(struct qmp_usbc *qmp); > > > > Are those functions really platform-specific? > > > I mainly compared the driver of the combo PHY to identify reusable functions. > I extracted the dp_aux_init, configure_dp_phy and calibrate_dp_phy, > and based on the differences in the flow of the HPG in the 14nm DP PHY, > I separated out the configure_dp_voltages and configure_dp_serdes functions. Could you please answer the question that has been answered, not some other random question? > > Detailed explanation is provided in the following comment. > >> + > >> +static void qmp_usbc_check_dp_phy(struct qmp_usbc *qmp, const char *pos); > >> + > >> +static const struct qmp_phy_dp_cfg qcs615_dpphy_cfg = { > >> + .offsets = &qmp_usbc_dp_offsets_qcs615, > >> + > >> + .swing_tbl = &qmp_dp_voltage_swing_hbr2_rbr, > >> + .pre_emphasis_tbl = &qmp_dp_pre_emphasis_hbr2_rbr, > >> + > >> + .dp_aux_init = qcs615_qmp_dp_aux_init, > >> + .configure_dp_serdes = qcs615_qmp_configure_dp_serdes, > >> + .configure_dp_voltages = qcs615_qmp_configure_dp_voltages, > >> + .configure_dp_phy = qcs615_qmp_configure_dp_phy, > >> + .calibrate_dp_phy = qcs615_qmp_calibrate_dp_phy, > >> + > >> + .vreg_list = qmp_phy_dp_vreg_l, > >> + .num_vregs = ARRAY_SIZE(qmp_phy_dp_vreg_l), > >> +}; > >> + > >> +#define to_usb_cfg(x) ((struct qmp_phy_usb_cfg *)(x->cfg)) > >> +#define to_dp_cfg(x) ((struct qmp_phy_dp_cfg *)(x->cfg)) > >> +#define to_usb_layout(x) ((struct qmp_phy_usb_layout *)(x->layout)) > >> +#define to_dp_layout(x) ((struct qmp_phy_dp_layout *)(x->layout)) > >> + > >> +static int qcs615_qmp_dp_aux_init(struct qmp_usbc *qmp) > >> +{ > >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); > >> + > >> + regmap_write(layout->tcsr_map, layout->dp_phy_mode, 0x1); > >> + > >> + writel(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, > >> + layout->dp_phy + QSERDES_DP_PHY_PD_CTL); > >> + > >> + 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, > >> + layout->dp_phy + QSERDES_DP_PHY_PD_CTL); > >> + > >> + writel(0x00, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG0); > >> + writel(0x13, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG1); > >> + writel(0x00, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG2); > >> + writel(0x00, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG3); > >> + writel(0x0a, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG4); > >> + writel(0x26, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG5); > >> + writel(0x0a, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG6); > >> + writel(0x03, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG7); > >> + writel(0xbb, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG8); > >> + writel(0x03, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG9); > >> + layout->dp_aux_cfg = 0; > >> + > >> + 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, > >> + layout->dp_phy + QSERDES_V3_DP_PHY_AUX_INTERRUPT_MASK); > >> + return 0; > >> +} > > > > We've had DP PHY implementation in QMP Combo PHY and in eDP PHY. > > Please review them and work on extracting common bits into some kind > > of a library. At least -combo and your -usbc implementation seem close > > enough to warrant common library code. > > > Initially, I intended to reference the register tables of combo. > However, I discovered some flow differences in the 14nm PHY, > So, I only kept the sw and pe tables, and the rest was implemented as functions. > > 1.configure_dp_serdes: > The configuration of dp_serdes in the 14nm PHY is similar to that of eDP. > The configurations corresponding to RBR to HBR2 need to be set in the middle of the dp_serdes. > Therefore, I didn’t split it into five tables, but instead referenced the eDP implementation such like com_configure_pll. Usually there is no difference in the order of SERDES register writes between power down and power up. > > 2.configure_dp_voltages: > 14nm DP phy have only one pair of reference swing table and pre_emphasis_tbl. > Similar implement with combo V3. > > 3.configure_dp_phy & power_on: > This PHY requires alternating configurations among the dp_phy, dp_serdes, and dp_tx, dp_tx2 register groups, > which makes grouped configuration less convenient. I don't think I follow the comment. > >> + > >> +static int qcs615_qmp_configure_dp_serdes(struct qmp_usbc *qmp) > >> +{ > >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); > >> + void __iomem *serdes = layout->dp_serdes; > >> + const struct phy_configure_opts_dp *dp_opts = &layout->dp_opts; > >> + u8 hsclk_sel; > >> + u8 dec_start_mode0; > >> + u8 div_frac_start1_mode0; > >> + u8 div_frac_start2_mode0; > >> + u8 div_frac_start3_mode0; > >> + u8 lock_cmp1_mode0; > >> + u8 lock_cmp2_mode0; > >> + u8 lock_cmp3_mode0; > >> + > >> + switch (dp_opts->link_rate) { > >> + case 1620: > >> + hsclk_sel = 0x2c; > >> + dec_start_mode0 = 0x69; > >> + div_frac_start1_mode0 = 0x00; > >> + div_frac_start2_mode0 = 0x80; > >> + div_frac_start3_mode0 = 0x07; > >> + lock_cmp1_mode0 = 0xbf; > >> + lock_cmp2_mode0 = 0x21; > >> + lock_cmp3_mode0 = 0x00; > >> + break; > >> + case 2700: > >> + hsclk_sel = 0x24; > >> + dec_start_mode0 = 0x69; > >> + div_frac_start1_mode0 = 0x00; > >> + div_frac_start2_mode0 = 0x80; > >> + div_frac_start3_mode0 = 0x07; > >> + lock_cmp1_mode0 = 0x3f; > >> + lock_cmp2_mode0 = 0x38; > >> + lock_cmp3_mode0 = 0x00; > >> + break; > >> + case 5400: > >> + hsclk_sel = 0x20; > >> + dec_start_mode0 = 0x8c; > >> + div_frac_start1_mode0 = 0x00; > >> + div_frac_start2_mode0 = 0x00; > >> + div_frac_start3_mode0 = 0x0a; > >> + lock_cmp1_mode0 = 0x7f; > >> + lock_cmp2_mode0 = 0x70; > >> + lock_cmp3_mode0 = 0x00; > >> + break; > >> + default: > >> + /* Other link rates aren't supported */ > >> + return -EINVAL; > >> + } > >> + > >> + writel(0x01, serdes + QSERDES_COM_SVS_MODE_CLK_SEL); > >> + writel(0x37, serdes + QSERDES_COM_SYSCLK_EN_SEL); > >> + writel(0x00, serdes + QSERDES_COM_CLK_SELECT); > >> + writel(0x06, serdes + QSERDES_COM_SYS_CLK_CTRL); > >> + writel(0x3f, serdes + QSERDES_COM_BIAS_EN_CLKBUFLR_EN); > >> + writel(0x0e, serdes + QSERDES_COM_CLK_ENABLE1); > >> + writel(0x0f, serdes + QSERDES_COM_BG_CTRL); > >> + writel(0x06, serdes + QSERDES_COM_SYSCLK_BUF_ENABLE); > >> + writel(0x30, serdes + QSERDES_COM_CLK_SELECT); > >> + writel(0x0f, serdes + QSERDES_COM_PLL_IVCO); > >> + writel(0x28, serdes + QSERDES_COM_PLL_CCTRL_MODE0); > >> + writel(0x16, serdes + QSERDES_COM_PLL_RCTRL_MODE0); > >> + writel(0x0b, serdes + QSERDES_COM_CP_CTRL_MODE0); > >> + > >> + writel(hsclk_sel, serdes + QSERDES_COM_HSCLK_SEL); > >> + writel(dec_start_mode0, serdes + QSERDES_COM_DEC_START_MODE0); > >> + writel(div_frac_start1_mode0, serdes + QSERDES_COM_DIV_FRAC_START1_MODE0); > >> + writel(div_frac_start2_mode0, serdes + QSERDES_COM_DIV_FRAC_START2_MODE0); > >> + writel(div_frac_start3_mode0, serdes + QSERDES_COM_DIV_FRAC_START3_MODE0); > >> + writel(lock_cmp1_mode0, serdes + QSERDES_COM_LOCK_CMP1_MODE0); > >> + writel(lock_cmp2_mode0, serdes + QSERDES_COM_LOCK_CMP2_MODE0); > >> + writel(lock_cmp3_mode0, serdes + QSERDES_COM_LOCK_CMP3_MODE0); > >> + > >> + writel(0x40, serdes + QSERDES_COM_INTEGLOOP_GAIN0_MODE0); > >> + writel(0x00, serdes + QSERDES_COM_INTEGLOOP_GAIN1_MODE0); > >> + writel(0x00, serdes + QSERDES_COM_VCO_TUNE_MAP); > >> + writel(0x08, serdes + QSERDES_COM_BG_TIMER); > >> + writel(0x05, serdes + QSERDES_COM_CORECLK_DIV); > >> + writel(0x00, serdes + QSERDES_COM_VCO_TUNE_CTRL); > >> + writel(0x00, serdes + QSERDES_COM_VCO_TUNE1_MODE0); > >> + writel(0x00, serdes + QSERDES_COM_VCO_TUNE2_MODE0); > >> + writel(0x00, serdes + QSERDES_COM_VCO_TUNE_CTRL); > >> + > >> + writel(0x0f, serdes + QSERDES_COM_CORE_CLK_EN); > >> + > >> + return 0; > >> +} > >> + > >> +static int qcs615_qmp_configure_dp_voltages(struct qmp_usbc *qmp) > >> +{ > >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); > >> + struct qmp_phy_dp_cfg *cfg = to_dp_cfg(qmp); > >> + const struct phy_configure_opts_dp *dp_opts = &layout->dp_opts; > >> + void __iomem *tx = layout->dp_tx; > >> + void __iomem *tx2 = layout->dp_tx2; > >> + unsigned int v_level = 0, p_level = 0; > >> + u8 voltage_swing_cfg, pre_emphasis_cfg; > >> + int i; > >> + > >> + if (dp_opts->lanes > 4) { > >> + dev_err(qmp->dev, "Invalid lane_num(%d)\n", dp_opts->lanes); > >> + return -EINVAL; > >> + } > >> + > >> + 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 ((v_level > 4) || (pre_emphasis_cfg > 4)) { > >> + dev_err(qmp->dev, "Invalid v(%d) | p(%d) level)\n", > >> + v_level, pre_emphasis_cfg); > >> + return -EINVAL; > >> + } > >> + > >> + voltage_swing_cfg = (*cfg->swing_tbl)[v_level][p_level]; > >> + pre_emphasis_cfg = (*cfg->pre_emphasis_tbl)[v_level][p_level]; > >> + > >> + /* Enable MUX to use Cursor values from these registers */ > >> + voltage_swing_cfg |= DP_PHY_TXn_TX_DRV_LVL_MUX_EN; > >> + pre_emphasis_cfg |= DP_PHY_TXn_TX_EMP_POST1_LVL_MUX_EN; > >> + > >> + if (voltage_swing_cfg == 0xFF && pre_emphasis_cfg == 0xFF) > >> + return -EINVAL; > >> + > >> + /* program default setting first */ > >> + writel(0x2A, tx + QSERDES_V3_TX_TX_DRV_LVL); > >> + writel(0x20, tx + QSERDES_V3_TX_TX_EMP_POST1_LVL); > >> + writel(0x2A, tx2 + QSERDES_V3_TX_TX_DRV_LVL); > >> + writel(0x20, tx2 + QSERDES_V3_TX_TX_EMP_POST1_LVL); > > > > Lowercase all hex numbers. > > > Ok, will update in next patch. > >> + > >> + writel(voltage_swing_cfg, tx + QSERDES_V3_TX_TX_DRV_LVL); > >> + writel(pre_emphasis_cfg, tx + QSERDES_V3_TX_TX_EMP_POST1_LVL); > >> + writel(voltage_swing_cfg, tx2 + QSERDES_V3_TX_TX_DRV_LVL); > >> + writel(pre_emphasis_cfg, tx2 + QSERDES_V3_TX_TX_EMP_POST1_LVL); > >> + > >> + return 0; > >> +} > >> + > >> +static int qcs615_qmp_configure_dp_phy(struct qmp_usbc *qmp) > >> +{ > >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); > >> + u32 status; > >> + > >> + writel(0x01, layout->dp_phy + QSERDES_DP_PHY_CFG); > >> + writel(0x05, layout->dp_phy + QSERDES_DP_PHY_CFG); > >> + writel(0x01, layout->dp_phy + QSERDES_DP_PHY_CFG); > >> + writel(0x09, layout->dp_phy + QSERDES_DP_PHY_CFG); > >> + > >> + writel(0x20, layout->dp_serdes + QSERDES_COM_RESETSM_CNTRL); > >> + > >> + // C_READY > >> + if (readl_poll_timeout(layout->dp_serdes + QSERDES_COM_C_READY_STATUS, > >> + status, > >> + ((status & BIT(0)) > 0), > >> + 500, > >> + 10000)) { > >> + dev_err(qmp->dev, "C_READY not ready\n"); > >> + return -ETIMEDOUT; > >> + } > >> + > >> + // FREQ_DONE > >> + if (readl_poll_timeout(layout->dp_serdes + QSERDES_COM_CMN_STATUS, > >> + status, > >> + ((status & BIT(0)) > 0), > >> + 500, > >> + 10000)){ > >> + dev_err(qmp->dev, "FREQ_DONE not ready\n"); > >> + return -ETIMEDOUT; > >> + } > >> + > >> + // PLL_LOCKED > >> + if (readl_poll_timeout(layout->dp_serdes + QSERDES_COM_CMN_STATUS, > >> + status, > >> + ((status & BIT(1)) > 0), > >> + 500, > >> + 10000)){ > >> + dev_err(qmp->dev, "PLL_LOCKED not ready\n"); > >> + return -ETIMEDOUT; > >> + } > >> + > >> + writel(0x19, layout->dp_phy + QSERDES_DP_PHY_CFG); > >> + udelay(10); > >> + > >> + // TSYNC_DONE > >> + if (readl_poll_timeout(layout->dp_phy + QSERDES_V3_DP_PHY_STATUS, > >> + status, > >> + ((status & BIT(0)) > 0), > >> + 500, > >> + 10000)){ > >> + dev_err(qmp->dev, "TSYNC_DONE not ready\n"); > >> + return -ETIMEDOUT; > >> + } > >> + > >> + // PHY_READY > >> + if (readl_poll_timeout(layout->dp_phy + QSERDES_V3_DP_PHY_STATUS, > >> + status, > >> + ((status & BIT(1)) > 0), > >> + 500, > >> + 10000)){ > >> + dev_err(qmp->dev, "PHY_READY not ready\n"); > >> + return -ETIMEDOUT; > >> + } > >> + > >> + writel(0x3f, layout->dp_tx + QSERDES_V3_TX_TRANSCEIVER_BIAS_EN); > >> + writel(0x10, layout->dp_tx + QSERDES_V3_TX_HIGHZ_DRVR_EN); > >> + writel(0x0a, layout->dp_tx + QSERDES_V3_TX_TX_POL_INV); > >> + writel(0x3f, layout->dp_tx2 + QSERDES_V3_TX_TRANSCEIVER_BIAS_EN); > >> + writel(0x10, layout->dp_tx2 + QSERDES_V3_TX_HIGHZ_DRVR_EN); > >> + writel(0x0a, layout->dp_tx2 + QSERDES_V3_TX_TX_POL_INV); > >> + > >> + writel(0x18, layout->dp_phy + QSERDES_DP_PHY_CFG); > >> + writel(0x19, layout->dp_phy + QSERDES_DP_PHY_CFG); > >> + > >> + if (readl_poll_timeout(layout->dp_phy + QSERDES_V3_DP_PHY_STATUS, > >> + status, > >> + ((status & BIT(1)) > 0), > >> + 500, > >> + 10000)){ > >> + dev_err(qmp->dev, "PHY_READY not ready\n"); > >> + return -ETIMEDOUT; > >> + } > >> + > >> + return 0; > >> +} > >> + > >> +static int qcs615_qmp_calibrate_dp_phy(struct qmp_usbc *qmp) > >> +{ > >> + static const u8 cfg1_settings[] = {0x13, 0x23, 0x1d}; > >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); > >> + u8 val; > >> + > >> + layout->dp_aux_cfg++; > >> + layout->dp_aux_cfg %= ARRAY_SIZE(cfg1_settings); > >> + val = cfg1_settings[layout->dp_aux_cfg]; > >> + > >> + writel(val, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG1); > >> + > >> + qmp_usbc_check_dp_phy(qmp, "pos_calibrate"); > >> + > >> + return 0; > >> +} > >> + > >> +static int qmp_usbc_com_init(struct phy *phy) > >> { > >> struct qmp_usbc *qmp = phy_get_drvdata(phy); > >> - const struct qmp_phy_cfg *cfg = qmp->cfg; > >> - void __iomem *pcs = qmp->pcs; > >> + int num_vregs; > >> u32 val = 0; > >> int ret; > >> + unsigned int reg_pwr_dn; > >> > >> - ret = regulator_bulk_enable(cfg->num_vregs, qmp->vregs); > >> + if (qmp->type == QMP_PHY_USBC_USB) { > >> + struct qmp_phy_usb_cfg *cfg = to_usb_cfg(qmp); > >> + > >> + num_vregs = cfg->num_vregs; > >> + reg_pwr_dn = cfg->regs[QPHY_PCS_POWER_DOWN_CONTROL]; > >> + } else { > >> + struct qmp_phy_dp_cfg *cfg = to_dp_cfg(qmp); > >> + > >> + num_vregs = cfg->num_vregs; > >> + } > >> + > >> + ret = regulator_bulk_enable(num_vregs, qmp->vregs); > >> if (ret) { > >> dev_err(qmp->dev, "failed to enable regulators, err=%d\n", ret); > >> return ret; > >> @@ -484,73 +893,85 @@ static int qmp_usbc_init(struct phy *phy) > >> if (ret) > >> goto err_assert_reset; > >> > >> - qphy_setbits(pcs, cfg->regs[QPHY_PCS_POWER_DOWN_CONTROL], SW_PWRDN); > >> - > >> -#define SW_PORTSELECT_VAL BIT(0) > >> -#define SW_PORTSELECT_MUX BIT(1) > >> /* Use software based port select and switch on typec orientation */ > >> val = SW_PORTSELECT_MUX; > >> if (qmp->orientation == TYPEC_ORIENTATION_REVERSE) > >> val |= SW_PORTSELECT_VAL; > >> - writel(val, qmp->pcs_misc); > >> + > >> + if (qmp->type == QMP_PHY_USBC_USB) { > > > > Why? > > > On QCS615 ADP AIR platform, Type-C DP orientation is fixed in one direction due to connected to the external video-out expansion board through the expansion slot. > Therefore, we cannot validate DP orientation behaviour. > As a result, the orientation part remains consistent with the original implementation of the USB-C driver and only applies to USB devices. 1) You've also put SW_PWRDN under the if(). If that's intended, please explain, why. 2) I don't get the DP orientation part. You've wrote that there is no DP AltMode support. What is DP orientation in such a case? If the SoC supports swapping lanes 0/1 vs 2/3, then just keep the register write here. > >> + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); > >> + > >> + qphy_setbits(layout->pcs, reg_pwr_dn, SW_PWRDN); > >> + writel(val, layout->pcs_misc); > >> + } > >> > >> return 0; > >> > >> err_assert_reset: > >> reset_control_bulk_assert(qmp->num_resets, qmp->resets); > >> err_disable_regulators: > >> - regulator_bulk_disable(cfg->num_vregs, qmp->vregs); > >> + regulator_bulk_disable(num_vregs, qmp->vregs); > >> > >> return ret; > >> } > >> > >> -static int qmp_usbc_exit(struct phy *phy) > >> +static int qmp_usbc_com_exit(struct phy *phy) > >> { > >> struct qmp_usbc *qmp = phy_get_drvdata(phy); > >> - const struct qmp_phy_cfg *cfg = qmp->cfg; > >> + int num_vregs; > >> > >> reset_control_bulk_assert(qmp->num_resets, qmp->resets); > >> > >> clk_bulk_disable_unprepare(qmp->num_clks, qmp->clks); > >> > >> - regulator_bulk_disable(cfg->num_vregs, qmp->vregs); > >> + if (qmp->type == QMP_PHY_USBC_USB) { > >> + struct qmp_phy_usb_cfg *cfg = to_usb_cfg(qmp); > >> + > >> + num_vregs = cfg->num_vregs; > >> + } else { > >> + struct qmp_phy_dp_cfg *cfg = to_dp_cfg(qmp); > >> + > >> + num_vregs = cfg->num_vregs; > >> + } > >> + regulator_bulk_disable(num_vregs, qmp->vregs); > >> > >> return 0; > >> } > >> > >> -static int qmp_usbc_power_on(struct phy *phy) > >> +static int qmp_usbc_usb_power_on(struct phy *phy) > >> { > >> struct qmp_usbc *qmp = phy_get_drvdata(phy); > >> - const struct qmp_phy_cfg *cfg = qmp->cfg; > >> + const struct qmp_phy_usb_cfg *cfg = to_usb_cfg(qmp); > >> + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); > >> void __iomem *status; > >> unsigned int val; > >> int ret; > >> > >> - qmp_configure(qmp->dev, qmp->serdes, cfg->serdes_tbl, > >> + qmp_configure(qmp->dev, layout->serdes, cfg->serdes_tbl, > >> cfg->serdes_tbl_num); > >> > >> - ret = clk_prepare_enable(qmp->pipe_clk); > >> + ret = clk_prepare_enable(layout->pipe_clk); > >> if (ret) { > >> dev_err(qmp->dev, "pipe_clk enable failed err=%d\n", ret); > >> return ret; > >> } > >> > >> /* Tx, Rx, and PCS configurations */ > >> - qmp_configure_lane(qmp->dev, qmp->tx, cfg->tx_tbl, cfg->tx_tbl_num, 1); > >> - qmp_configure_lane(qmp->dev, qmp->rx, cfg->rx_tbl, cfg->rx_tbl_num, 1); > >> + qmp_configure_lane(qmp->dev, layout->tx, cfg->tx_tbl, cfg->tx_tbl_num, 1); > >> + qmp_configure_lane(qmp->dev, layout->rx, cfg->rx_tbl, cfg->rx_tbl_num, 1); > >> > >> - qmp_configure_lane(qmp->dev, qmp->tx2, cfg->tx_tbl, cfg->tx_tbl_num, 2); > >> - qmp_configure_lane(qmp->dev, qmp->rx2, cfg->rx_tbl, cfg->rx_tbl_num, 2); > >> + qmp_configure_lane(qmp->dev, layout->tx2, cfg->tx_tbl, cfg->tx_tbl_num, 2); > >> + qmp_configure_lane(qmp->dev, layout->rx2, cfg->rx_tbl, cfg->rx_tbl_num, 2); > >> > >> - qmp_configure(qmp->dev, qmp->pcs, cfg->pcs_tbl, cfg->pcs_tbl_num); > >> + qmp_configure(qmp->dev, layout->pcs, cfg->pcs_tbl, cfg->pcs_tbl_num); > >> > >> /* Pull PHY out of reset state */ > >> - qphy_clrbits(qmp->pcs, cfg->regs[QPHY_SW_RESET], SW_RESET); > >> + qphy_clrbits(layout->pcs, cfg->regs[QPHY_SW_RESET], SW_RESET); > >> > >> /* start SerDes and Phy-Coding-Sublayer */ > >> - qphy_setbits(qmp->pcs, cfg->regs[QPHY_START_CTRL], SERDES_START | PCS_START); > >> + qphy_setbits(layout->pcs, cfg->regs[QPHY_START_CTRL], SERDES_START | PCS_START); > >> > >> - status = qmp->pcs + cfg->regs[QPHY_PCS_STATUS]; > >> + status = layout->pcs + cfg->regs[QPHY_PCS_STATUS]; > >> ret = readl_poll_timeout(status, val, !(val & PHYSTATUS), 200, > >> PHY_INIT_COMPLETE_TIMEOUT); > >> if (ret) { > >> @@ -561,92 +982,348 @@ static int qmp_usbc_power_on(struct phy *phy) > >> return 0; > >> > >> err_disable_pipe_clk: > >> - clk_disable_unprepare(qmp->pipe_clk); > >> + clk_disable_unprepare(layout->pipe_clk); > >> > >> return ret; > >> } > >> > >> -static int qmp_usbc_power_off(struct phy *phy) > >> +static int qmp_usbc_usb_power_off(struct phy *phy) > >> { > >> struct qmp_usbc *qmp = phy_get_drvdata(phy); > >> - const struct qmp_phy_cfg *cfg = qmp->cfg; > >> + const struct qmp_phy_usb_cfg *cfg = to_usb_cfg(qmp); > >> + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); > >> > >> - clk_disable_unprepare(qmp->pipe_clk); > >> + clk_disable_unprepare(layout->pipe_clk); > >> > >> /* PHY reset */ > >> - qphy_setbits(qmp->pcs, cfg->regs[QPHY_SW_RESET], SW_RESET); > >> + qphy_setbits(layout->pcs, cfg->regs[QPHY_SW_RESET], SW_RESET); > >> > >> /* stop SerDes and Phy-Coding-Sublayer */ > >> - qphy_clrbits(qmp->pcs, cfg->regs[QPHY_START_CTRL], > >> + qphy_clrbits(layout->pcs, cfg->regs[QPHY_START_CTRL], > >> SERDES_START | PCS_START); > >> > >> /* Put PHY into POWER DOWN state: active low */ > >> - qphy_clrbits(qmp->pcs, cfg->regs[QPHY_PCS_POWER_DOWN_CONTROL], > >> + qphy_clrbits(layout->pcs, cfg->regs[QPHY_PCS_POWER_DOWN_CONTROL], > >> SW_PWRDN); > >> > >> return 0; > >> } > >> > >> -static int qmp_usbc_enable(struct phy *phy) > >> +static int qmp_usbc_usb_enable(struct phy *phy) > >> { > >> struct qmp_usbc *qmp = phy_get_drvdata(phy); > >> int ret; > >> > >> mutex_lock(&qmp->phy_mutex); > >> > >> - ret = qmp_usbc_init(phy); > >> + ret = qmp_usbc_com_init(phy); > >> if (ret) > >> goto out_unlock; > >> > >> - ret = qmp_usbc_power_on(phy); > >> + ret = qmp_usbc_usb_power_on(phy); > >> if (ret) { > >> - qmp_usbc_exit(phy); > >> + qmp_usbc_com_exit(phy); > >> goto out_unlock; > >> } > >> > >> - qmp->usb_init_count++; > >> + qmp->init_count++; > >> out_unlock: > >> mutex_unlock(&qmp->phy_mutex); > >> > >> return ret; > >> } > >> > >> -static int qmp_usbc_disable(struct phy *phy) > >> +static int qmp_usbc_usb_disable(struct phy *phy) > >> { > >> struct qmp_usbc *qmp = phy_get_drvdata(phy); > >> int ret; > >> > >> - qmp->usb_init_count--; > >> - ret = qmp_usbc_power_off(phy); > >> + qmp->init_count--; > >> + ret = qmp_usbc_usb_power_off(phy); > >> if (ret) > >> return ret; > >> - return qmp_usbc_exit(phy); > >> + return qmp_usbc_com_exit(phy); > >> +} > >> + > >> +static int qmp_usbc_usb_set_mode(struct phy *phy, enum phy_mode mode, int submode) > >> +{ > >> + struct qmp_usbc *qmp = phy_get_drvdata(phy); > >> + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); > >> + > >> + layout->mode = mode; > >> + > >> + return 0; > >> +} > >> + > >> +static int qmp_usbc_dp_init(struct phy *phy) > >> +{ > >> + struct qmp_usbc *qmp = phy_get_drvdata(phy); > >> + const struct qmp_phy_dp_cfg *cfg = to_dp_cfg(qmp); > >> + int ret; > >> + > >> + if (qmp->init_count) { > >> + dev_err(qmp->dev, "type(%d) inited(%d)\n", qmp->type, qmp->init_count); > >> + return 0; > >> + } > >> + > >> + mutex_lock(&qmp->phy_mutex); > >> + > >> + ret = qmp_usbc_com_init(phy); > >> + if (ret) { > >> + dev_err(qmp->dev, "type(%d) com_init fail\n", qmp->type); > >> + goto dp_init_unlock; > >> + } > >> + > >> + cfg->dp_aux_init(qmp); > >> + > >> + qmp->init_count++; > >> + > >> +dp_init_unlock: > >> + mutex_unlock(&qmp->phy_mutex); > >> + return ret; > >> +} > >> + > >> +static int qmp_usbc_dp_exit(struct phy *phy) > >> +{ > >> + struct qmp_usbc *qmp = phy_get_drvdata(phy); > >> + > >> + mutex_lock(&qmp->phy_mutex); > >> + > >> + qmp_usbc_com_exit(phy); > >> + > >> + qmp->init_count--; > >> + > >> + mutex_unlock(&qmp->phy_mutex); > >> + > >> + return 0; > >> +} > >> + > >> +static int qmp_usbc_dp_configure(struct phy *phy, union phy_configure_opts *opts) > >> +{ > >> + const struct phy_configure_opts_dp *dp_opts = &opts->dp; > >> + struct qmp_usbc *qmp = phy_get_drvdata(phy); > >> + struct qmp_phy_dp_cfg *cfg = to_dp_cfg(qmp); > >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); > >> + int ret; > >> + > >> + mutex_lock(&qmp->phy_mutex); > >> + > >> + memcpy(&layout->dp_opts, dp_opts, sizeof(*dp_opts)); > >> + if (layout->dp_opts.set_voltages) { > >> + ret = cfg->configure_dp_voltages(qmp); > >> + if (ret) { > >> + dev_err(qmp->dev, "type(%d) err(%d)\n", qmp->type, ret); > >> + mutex_unlock(&qmp->phy_mutex); > >> + return ret; > >> + } > >> + > >> + layout->dp_opts.set_voltages = 0; > >> + } > >> + > >> + mutex_unlock(&qmp->phy_mutex); > >> + > >> + return 0; > >> +} > >> + > >> +static int qmp_usbc_dp_calibrate(struct phy *phy) > >> +{ > >> + struct qmp_usbc *qmp = phy_get_drvdata(phy); > >> + struct qmp_phy_dp_cfg *cfg = to_dp_cfg(qmp); > >> + int ret = 0; > >> + > >> + mutex_lock(&qmp->phy_mutex); > >> + > >> + if (cfg->calibrate_dp_phy) { > >> + ret = cfg->calibrate_dp_phy(qmp); > >> + if (ret) { > >> + dev_err(qmp->dev, "type(%d) err(%d)\n", qmp->type, ret); > >> + mutex_unlock(&qmp->phy_mutex); > >> + return ret; > >> + } > >> + } > >> + > >> + mutex_unlock(&qmp->phy_mutex); > >> + return 0; > >> } > >> > >> -static int qmp_usbc_set_mode(struct phy *phy, enum phy_mode mode, int submode) > >> +static int qmp_usbc_configure_dp_clocks(struct qmp_usbc *qmp) > >> +{ > >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); > >> + const struct phy_configure_opts_dp *dp_opts = &layout->dp_opts; > >> + u32 phy_vco_div; > >> + unsigned long pixel_freq; > >> + > >> + switch (dp_opts->link_rate) { > >> + case 1620: > >> + phy_vco_div = 0x1; > >> + pixel_freq = 1620000000UL / 2; > >> + break; > >> + case 2700: > >> + phy_vco_div = 0x1; > >> + pixel_freq = 2700000000UL / 2; > >> + break; > >> + case 5400: > >> + phy_vco_div = 0x2; > >> + pixel_freq = 5400000000UL / 4; > >> + break; > >> + case 8100: > >> + phy_vco_div = 0x0; > >> + pixel_freq = 8100000000UL / 6; > >> + break; > >> + default: > >> + /* Other link rates aren't supported */ > >> + return -EINVAL; > >> + } > >> + writel(phy_vco_div, layout->dp_phy + QSERDES_DP_PHY_VCO_DIV); > >> + > >> + clk_set_rate(layout->dp_link_hw.clk, dp_opts->link_rate * 100000); > >> + clk_set_rate(layout->dp_pixel_hw.clk, pixel_freq); > >> + > >> + return 0; > >> +} > >> + > >> +static void qmp_usbc_check_dp_phy(struct qmp_usbc *qmp, const char *pos) > >> +{ > >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); > >> + u8 c_ready, cmn_status, phy_status; > >> + > >> + c_ready = readl(layout->dp_serdes + QSERDES_COM_C_READY_STATUS); > >> + cmn_status = readl(layout->dp_serdes + QSERDES_COM_CMN_STATUS); > >> + phy_status = readl(layout->dp_phy + QSERDES_V3_DP_PHY_STATUS); > >> + > >> + dev_dbg(qmp->dev, "pos(%s) c_ready(0x%x) cmn_status(0x%x) phy_status(0x%x)\n", > >> + pos, c_ready, cmn_status, phy_status); > >> +} > >> + > >> +static int qmp_usbc_dp_power_on(struct phy *phy) > >> +{ > >> + struct qmp_usbc *qmp = phy_get_drvdata(phy); > >> + const struct qmp_phy_dp_cfg *cfg = to_dp_cfg(qmp); > >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); > >> + const struct phy_configure_opts_dp *dp_opts = &layout->dp_opts; > >> + bool reverse = (qmp->orientation == TYPEC_ORIENTATION_REVERSE); > >> + void __iomem *tx = layout->dp_tx; > >> + void __iomem *tx2 = layout->dp_tx2; > >> + u8 lane_mode_1; > >> + int ret = 0; > >> + > >> + mutex_lock(&qmp->phy_mutex); > >> + > >> + 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, > >> + layout->dp_phy + QSERDES_DP_PHY_PD_CTL); > >> + > >> + ret = cfg->configure_dp_serdes(qmp); > >> + if (ret) { > >> + dev_err(qmp->dev, "failed to config pll\n"); > >> + goto power_on_unlock; > >> + } > >> + > >> + if (dp_opts->link_rate >= 2700) > >> + lane_mode_1 = 0xc4; > >> + else > >> + lane_mode_1 = 0xc6; > >> + > >> + writel(lane_mode_1, tx + QSERDES_V3_TX_LANE_MODE_1); > >> + writel(lane_mode_1, tx2 + QSERDES_V3_TX_LANE_MODE_1); > >> + > >> + if (reverse) > >> + writel(0xc9, layout->dp_phy + QSERDES_DP_PHY_MODE); > >> + else > >> + writel(0xd9, layout->dp_phy + QSERDES_DP_PHY_MODE); > >> + > >> + writel(0x05, layout->dp_phy + QSERDES_V3_DP_PHY_TX0_TX1_LANE_CTL); > >> + writel(0x05, layout->dp_phy + QSERDES_V3_DP_PHY_TX2_TX3_LANE_CTL); > >> + > >> + writel(0x1a, tx + QSERDES_V3_TX_TRANSCEIVER_BIAS_EN); > >> + writel(0x40, tx + QSERDES_V3_TX_VMODE_CTRL1); > >> + writel(0x30, tx + QSERDES_V3_TX_PRE_STALL_LDO_BOOST_EN); > >> + writel(0x3d, tx + QSERDES_V3_TX_INTERFACE_SELECT); > >> + writel(0x0f, tx + QSERDES_V3_TX_CLKBUF_ENABLE); > >> + writel(0x03, tx + QSERDES_V3_TX_RESET_TSYNC_EN); > >> + writel(0x03, tx + QSERDES_V3_TX_TRAN_DRVR_EMP_EN); > >> + writel(0x00, tx + QSERDES_V3_TX_PARRATE_REC_DETECT_IDLE_EN); > >> + writel(0x00, tx + QSERDES_V3_TX_TX_INTERFACE_MODE); > >> + writel(0x2b, tx + QSERDES_V3_TX_TX_EMP_POST1_LVL); > >> + writel(0x2f, tx + QSERDES_V3_TX_TX_DRV_LVL); > >> + writel(0x04, tx + QSERDES_V3_TX_TX_BAND); > >> + writel(0x12, tx + QSERDES_V3_TX_RES_CODE_LANE_OFFSET_TX); > >> + writel(0x12, tx + QSERDES_V3_TX_RES_CODE_LANE_OFFSET_RX); > >> + > >> + writel(0x1a, tx2 + QSERDES_V3_TX_TRANSCEIVER_BIAS_EN); > >> + writel(0x40, tx2 + QSERDES_V3_TX_VMODE_CTRL1); > >> + writel(0x30, tx2 + QSERDES_V3_TX_PRE_STALL_LDO_BOOST_EN); > >> + writel(0x3d, tx2 + QSERDES_V3_TX_INTERFACE_SELECT); > >> + writel(0x0f, tx2 + QSERDES_V3_TX_CLKBUF_ENABLE); > >> + writel(0x03, tx2 + QSERDES_V3_TX_RESET_TSYNC_EN); > >> + writel(0x03, tx2 + QSERDES_V3_TX_TRAN_DRVR_EMP_EN); > >> + writel(0x00, tx2 + QSERDES_V3_TX_PARRATE_REC_DETECT_IDLE_EN); > >> + writel(0x00, tx2 + QSERDES_V3_TX_TX_INTERFACE_MODE); > >> + writel(0x2b, tx2 + QSERDES_V3_TX_TX_EMP_POST1_LVL); > >> + writel(0x2f, tx2 + QSERDES_V3_TX_TX_DRV_LVL); > >> + writel(0x04, tx2 + QSERDES_V3_TX_TX_BAND); > >> + writel(0x12, tx2 + QSERDES_V3_TX_RES_CODE_LANE_OFFSET_TX); > >> + writel(0x12, tx2 + QSERDES_V3_TX_RES_CODE_LANE_OFFSET_RX); > >> + > >> + writel(0x02, layout->dp_serdes + QSERDES_COM_CMN_CONFIG); > >> + qmp_usbc_configure_dp_clocks(qmp); > >> + > >> + ret = cfg->configure_dp_phy(qmp); > >> + if (ret) { > >> + dev_err(qmp->dev, "failed to config dp phy\n"); > >> + goto power_on_unlock; > >> + } > >> + > >> + qmp_usbc_check_dp_phy(qmp, "usbc_dp_power_on_finish"); > >> + > >> +power_on_unlock: > >> + mutex_unlock(&qmp->phy_mutex); > >> + > >> + return ret; > >> +} > >> + > >> +static int qmp_usbc_dp_power_off(struct phy *phy) > >> { > >> struct qmp_usbc *qmp = phy_get_drvdata(phy); > >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); > >> + > >> + mutex_lock(&qmp->phy_mutex); > >> > >> - qmp->mode = mode; > >> + /* Assert DP PHY power down */ > >> + writel(DP_PHY_PD_CTL_PSR_PWRDN, layout->dp_phy + QSERDES_DP_PHY_PD_CTL); > >> + > >> + mutex_unlock(&qmp->phy_mutex); > >> > >> return 0; > >> } > >> > >> -static const struct phy_ops qmp_usbc_phy_ops = { > >> - .init = qmp_usbc_enable, > >> - .exit = qmp_usbc_disable, > >> - .set_mode = qmp_usbc_set_mode, > >> +static const struct phy_ops qmp_usbc_usb_phy_ops = { > >> + .init = qmp_usbc_usb_enable, > >> + .exit = qmp_usbc_usb_disable, > >> + .set_mode = qmp_usbc_usb_set_mode, > >> + .owner = THIS_MODULE, > >> +}; > >> + > >> +static const struct phy_ops qmp_usbc_dp_phy_ops = { > >> + .init = qmp_usbc_dp_init, > >> + .exit = qmp_usbc_dp_exit, > >> + .configure = qmp_usbc_dp_configure, > >> + .calibrate = qmp_usbc_dp_calibrate, > >> + .power_on = qmp_usbc_dp_power_on, > >> + .power_off = qmp_usbc_dp_power_off, > >> .owner = THIS_MODULE, > >> }; > >> > >> static void qmp_usbc_enable_autonomous_mode(struct qmp_usbc *qmp) > >> { > >> - const struct qmp_phy_cfg *cfg = qmp->cfg; > >> - void __iomem *pcs = qmp->pcs; > >> + const struct qmp_phy_usb_cfg *cfg = to_usb_cfg(qmp); > >> + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); > >> + void __iomem *pcs = layout->pcs; > >> u32 intr_mask; > >> > >> - if (qmp->mode == PHY_MODE_USB_HOST_SS || > >> - qmp->mode == PHY_MODE_USB_DEVICE_SS) > >> + if (layout->mode == PHY_MODE_USB_HOST_SS || > >> + layout->mode == PHY_MODE_USB_DEVICE_SS) > >> intr_mask = ARCVR_DTCT_EN | ALFPS_DTCT_EN; > >> else > >> intr_mask = ARCVR_DTCT_EN | ARCVR_DTCT_EVENT_SEL; > >> @@ -663,18 +1340,19 @@ static void qmp_usbc_enable_autonomous_mode(struct qmp_usbc *qmp) > >> qphy_setbits(pcs, cfg->regs[QPHY_PCS_AUTONOMOUS_MODE_CTRL], intr_mask); > >> > >> /* Enable i/o clamp_n for autonomous mode */ > >> - if (qmp->tcsr_map && qmp->vls_clamp_reg) > >> - regmap_write(qmp->tcsr_map, qmp->vls_clamp_reg, 1); > >> + if (layout->tcsr_map && layout->vls_clamp_reg) > >> + regmap_write(layout->tcsr_map, layout->vls_clamp_reg, 1); > >> } > >> > >> static void qmp_usbc_disable_autonomous_mode(struct qmp_usbc *qmp) > >> { > >> - const struct qmp_phy_cfg *cfg = qmp->cfg; > >> - void __iomem *pcs = qmp->pcs; > >> + const struct qmp_phy_usb_cfg *cfg = to_usb_cfg(qmp); > >> + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); > >> + void __iomem *pcs = layout->pcs; > >> > >> /* Disable i/o clamp_n on resume for normal mode */ > >> - if (qmp->tcsr_map && qmp->vls_clamp_reg) > >> - regmap_write(qmp->tcsr_map, qmp->vls_clamp_reg, 0); > >> + if (layout->tcsr_map && layout->vls_clamp_reg) > >> + regmap_write(layout->tcsr_map, layout->vls_clamp_reg, 0); > >> > >> qphy_clrbits(pcs, cfg->regs[QPHY_PCS_AUTONOMOUS_MODE_CTRL], > >> ARCVR_DTCT_EN | ARCVR_DTCT_EVENT_SEL | ALFPS_DTCT_EN); > >> @@ -688,16 +1366,19 @@ static int __maybe_unused qmp_usbc_runtime_suspend(struct device *dev) > >> { > >> struct qmp_usbc *qmp = dev_get_drvdata(dev); > >> > >> - dev_vdbg(dev, "Suspending QMP phy, mode:%d\n", qmp->mode); > >> - > >> if (!qmp->phy->init_count) { > >> dev_vdbg(dev, "PHY not initialized, bailing out\n"); > >> return 0; > >> } > >> > >> - qmp_usbc_enable_autonomous_mode(qmp); > >> + if (qmp->type == QMP_PHY_USBC_USB) { > >> + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); > >> + > >> + dev_vdbg(dev, "Suspending QMP phy, mode:%d\n", layout->mode); > >> + qmp_usbc_enable_autonomous_mode(qmp); > >> + clk_disable_unprepare(layout->pipe_clk); > >> + } > >> > >> - clk_disable_unprepare(qmp->pipe_clk); > >> clk_bulk_disable_unprepare(qmp->num_clks, qmp->clks); > >> > >> return 0; > >> @@ -708,8 +1389,6 @@ static int __maybe_unused qmp_usbc_runtime_resume(struct device *dev) > >> struct qmp_usbc *qmp = dev_get_drvdata(dev); > >> int ret = 0; > >> > >> - dev_vdbg(dev, "Resuming QMP phy, mode:%d\n", qmp->mode); > >> - > >> if (!qmp->phy->init_count) { > >> dev_vdbg(dev, "PHY not initialized, bailing out\n"); > >> return 0; > >> @@ -719,14 +1398,19 @@ static int __maybe_unused qmp_usbc_runtime_resume(struct device *dev) > >> if (ret) > >> return ret; > >> > >> - ret = clk_prepare_enable(qmp->pipe_clk); > >> - if (ret) { > >> - dev_err(dev, "pipe_clk enable failed, err=%d\n", ret); > >> - clk_bulk_disable_unprepare(qmp->num_clks, qmp->clks); > >> - return ret; > >> - } > >> + if (qmp->type == QMP_PHY_USBC_USB) { > >> + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); > >> > >> - qmp_usbc_disable_autonomous_mode(qmp); > >> + dev_vdbg(dev, "Resuming QMP phy, mode:%d\n", layout->mode); > >> + ret = clk_prepare_enable(layout->pipe_clk); > >> + if (ret) { > >> + dev_err(dev, "pipe_clk enable failed, err=%d\n", ret); > >> + clk_bulk_disable_unprepare(qmp->num_clks, qmp->clks); > >> + return ret; > >> + } > >> + > >> + qmp_usbc_disable_autonomous_mode(qmp); > >> + } > >> > >> return 0; > >> } > >> @@ -738,19 +1422,54 @@ static const struct dev_pm_ops qmp_usbc_pm_ops = { > >> > >> static int qmp_usbc_vreg_init(struct qmp_usbc *qmp) > >> { > >> - const struct qmp_phy_cfg *cfg = qmp->cfg; > >> struct device *dev = qmp->dev; > >> - int num = cfg->num_vregs; > >> - int i; > >> + int ret, i; > >> > >> - qmp->vregs = devm_kcalloc(dev, num, sizeof(*qmp->vregs), GFP_KERNEL); > >> - if (!qmp->vregs) > >> - return -ENOMEM; > >> + if (qmp->type == QMP_PHY_USBC_USB) { > >> + struct qmp_phy_usb_cfg *cfg = to_usb_cfg(qmp); > >> + int num = cfg->num_vregs; > >> > >> - for (i = 0; i < num; i++) > >> - qmp->vregs[i].supply = cfg->vreg_list[i]; > >> + qmp->vregs = devm_kcalloc(dev, num, sizeof(*qmp->vregs), GFP_KERNEL); > >> + if (!qmp->vregs) > >> + return -ENOMEM; > >> + > >> + for (i = 0; i < num; i++) > >> + qmp->vregs[i].supply = cfg->vreg_list[i]; > >> > >> - return devm_regulator_bulk_get(dev, num, qmp->vregs); > >> + ret = devm_regulator_bulk_get(dev, num, qmp->vregs); > >> + if (ret) { > >> + dev_err(dev, "failed at devm_regulator_bulk_get\n"); > >> + return ret; > >> + } > >> + } else { > >> + struct qmp_phy_dp_cfg *cfg = to_dp_cfg(qmp); > >> + int num = cfg->num_vregs; > >> + > >> + qmp->vregs = devm_kcalloc(dev, num, sizeof(*qmp->vregs), GFP_KERNEL); > >> + if (!qmp->vregs) > >> + return -ENOMEM; > >> + > >> + for (i = 0; i < num; i++) > >> + qmp->vregs[i].supply = cfg->vreg_list[i].name; > >> + > >> + ret = devm_regulator_bulk_get(dev, num, qmp->vregs); > >> + if (ret) { > >> + dev_err(dev, "failed at devm_regulator_bulk_get\n"); > >> + return ret; > >> + } > >> + > >> + for (i = 0; i < num; i++) { > >> + ret = regulator_set_load(qmp->vregs[i].consumer, > >> + cfg->vreg_list[i].enable_load); > >> + if (ret) { > >> + dev_err(dev, "failed to set load at %s\n", > >> + qmp->vregs[i].supply); > >> + return ret; > >> + } > >> + } > >> + } > >> + > >> + return 0; > >> } > >> > >> static int qmp_usbc_reset_init(struct qmp_usbc *qmp, > >> @@ -821,7 +1540,9 @@ static void phy_clk_release_provider(void *res) > >> */ > >> static int phy_pipe_clk_register(struct qmp_usbc *qmp, struct device_node *np) > >> { > >> - struct clk_fixed_rate *fixed = &qmp->pipe_clk_fixed; > >> + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); > >> + > >> + struct clk_fixed_rate *fixed = &layout->pipe_clk_fixed; > >> struct clk_init_data init = { }; > >> int ret; > >> > >> @@ -864,12 +1585,12 @@ static int qmp_usbc_typec_switch_set(struct typec_switch_dev *sw, > >> mutex_lock(&qmp->phy_mutex); > >> qmp->orientation = orientation; > >> > >> - if (qmp->usb_init_count) { > >> - qmp_usbc_power_off(qmp->phy); > >> - qmp_usbc_exit(qmp->phy); > >> + if (qmp->init_count) { > >> + qmp_usbc_usb_power_off(qmp->phy); > >> + qmp_usbc_com_exit(qmp->phy); > >> > >> - qmp_usbc_init(qmp->phy); > >> - qmp_usbc_power_on(qmp->phy); > >> + qmp_usbc_com_init(qmp->phy); > >> + qmp_usbc_usb_power_on(qmp->phy); > >> } > >> > >> mutex_unlock(&qmp->phy_mutex); > >> @@ -880,22 +1601,24 @@ static int qmp_usbc_typec_switch_set(struct typec_switch_dev *sw, > >> static void qmp_usbc_typec_unregister(void *data) > >> { > >> struct qmp_usbc *qmp = data; > >> + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); > >> > >> - typec_switch_unregister(qmp->sw); > >> + typec_switch_unregister(layout->sw); > >> } > >> > >> static int qmp_usbc_typec_switch_register(struct qmp_usbc *qmp) > >> { > >> struct typec_switch_desc sw_desc = {}; > >> struct device *dev = qmp->dev; > >> + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); > >> > >> sw_desc.drvdata = qmp; > >> sw_desc.fwnode = dev->fwnode; > >> sw_desc.set = qmp_usbc_typec_switch_set; > >> - qmp->sw = typec_switch_register(dev, &sw_desc); > >> - if (IS_ERR(qmp->sw)) { > >> - dev_err(dev, "Unable to register typec switch: %pe\n", qmp->sw); > >> - return PTR_ERR(qmp->sw); > >> + layout->sw = typec_switch_register(dev, &sw_desc); > >> + if (IS_ERR(layout->sw)) { > >> + dev_err(dev, "Unable to register typec switch: %pe\n", layout->sw); > >> + return PTR_ERR(layout->sw); > >> } > >> > >> return devm_add_action_or_reset(dev, qmp_usbc_typec_unregister, qmp); > >> @@ -907,15 +1630,16 @@ static int qmp_usbc_typec_switch_register(struct qmp_usbc *qmp) > >> } > >> #endif > >> > >> -static int qmp_usbc_parse_dt_legacy(struct qmp_usbc *qmp, struct device_node *np) > >> +static int qmp_usbc_parse_usb_dt_legacy(struct qmp_usbc *qmp, struct device_node *np) > >> { > >> struct platform_device *pdev = to_platform_device(qmp->dev); > >> struct device *dev = qmp->dev; > >> + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); > >> int ret; > >> > >> - qmp->serdes = devm_platform_ioremap_resource(pdev, 0); > >> - if (IS_ERR(qmp->serdes)) > >> - return PTR_ERR(qmp->serdes); > >> + layout->serdes = devm_platform_ioremap_resource(pdev, 0); > >> + if (IS_ERR(layout->serdes)) > >> + return PTR_ERR(layout->serdes); > >> > >> /* > >> * Get memory resources for the PHY: > >> @@ -923,35 +1647,35 @@ static int qmp_usbc_parse_dt_legacy(struct qmp_usbc *qmp, struct device_node *np > >> * For dual lane PHYs: tx2 -> 3, rx2 -> 4, pcs_misc (optional) -> 5 > >> * For single lane PHYs: pcs_misc (optional) -> 3. > >> */ > >> - qmp->tx = devm_of_iomap(dev, np, 0, NULL); > >> - if (IS_ERR(qmp->tx)) > >> - return PTR_ERR(qmp->tx); > >> + layout->tx = devm_of_iomap(dev, np, 0, NULL); > >> + if (IS_ERR(layout->tx)) > >> + return PTR_ERR(layout->tx); > >> > >> - qmp->rx = devm_of_iomap(dev, np, 1, NULL); > >> - if (IS_ERR(qmp->rx)) > >> - return PTR_ERR(qmp->rx); > >> + layout->rx = devm_of_iomap(dev, np, 1, NULL); > >> + if (IS_ERR(layout->rx)) > >> + return PTR_ERR(layout->rx); > >> > >> - qmp->pcs = devm_of_iomap(dev, np, 2, NULL); > >> - if (IS_ERR(qmp->pcs)) > >> - return PTR_ERR(qmp->pcs); > >> + layout->pcs = devm_of_iomap(dev, np, 2, NULL); > >> + if (IS_ERR(layout->pcs)) > >> + return PTR_ERR(layout->pcs); > >> > >> - qmp->tx2 = devm_of_iomap(dev, np, 3, NULL); > >> - if (IS_ERR(qmp->tx2)) > >> - return PTR_ERR(qmp->tx2); > >> + layout->tx2 = devm_of_iomap(dev, np, 3, NULL); > >> + if (IS_ERR(layout->tx2)) > >> + return PTR_ERR(layout->tx2); > >> > >> - qmp->rx2 = devm_of_iomap(dev, np, 4, NULL); > >> - if (IS_ERR(qmp->rx2)) > >> - return PTR_ERR(qmp->rx2); > >> + layout->rx2 = devm_of_iomap(dev, np, 4, NULL); > >> + if (IS_ERR(layout->rx2)) > >> + return PTR_ERR(layout->rx2); > >> > >> - qmp->pcs_misc = devm_of_iomap(dev, np, 5, NULL); > >> - if (IS_ERR(qmp->pcs_misc)) { > >> + layout->pcs_misc = devm_of_iomap(dev, np, 5, NULL); > >> + if (IS_ERR(layout->pcs_misc)) { > >> dev_vdbg(dev, "PHY pcs_misc-reg not used\n"); > >> - qmp->pcs_misc = NULL; > >> + layout->pcs_misc = NULL; > >> } > >> > >> - qmp->pipe_clk = devm_get_clk_from_child(dev, np, NULL); > >> - if (IS_ERR(qmp->pipe_clk)) { > >> - return dev_err_probe(dev, PTR_ERR(qmp->pipe_clk), > >> + layout->pipe_clk = devm_get_clk_from_child(dev, np, NULL); > >> + if (IS_ERR(layout->pipe_clk)) { > >> + return dev_err_probe(dev, PTR_ERR(layout->pipe_clk), > >> "failed to get pipe clock\n"); > >> } > >> > >> @@ -969,11 +1693,12 @@ static int qmp_usbc_parse_dt_legacy(struct qmp_usbc *qmp, struct device_node *np > >> return 0; > >> } > >> > >> -static int qmp_usbc_parse_dt(struct qmp_usbc *qmp) > >> +static int qmp_usbc_parse_usb_dt(struct qmp_usbc *qmp) > >> { > >> struct platform_device *pdev = to_platform_device(qmp->dev); > >> - const struct qmp_phy_cfg *cfg = qmp->cfg; > >> - const struct qmp_usbc_offsets *offs = cfg->offsets; > >> + const struct qmp_phy_usb_cfg *cfg = to_usb_cfg(qmp); > >> + const struct qmp_usbc_usb_offsets *offs = cfg->offsets; > >> + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); > >> struct device *dev = qmp->dev; > >> void __iomem *base; > >> int ret; > >> @@ -985,23 +1710,23 @@ static int qmp_usbc_parse_dt(struct qmp_usbc *qmp) > >> if (IS_ERR(base)) > >> return PTR_ERR(base); > >> > >> - qmp->serdes = base + offs->serdes; > >> - qmp->pcs = base + offs->pcs; > >> + layout->serdes = base + offs->serdes; > >> + layout->pcs = base + offs->pcs; > >> if (offs->pcs_misc) > >> - qmp->pcs_misc = base + offs->pcs_misc; > >> - qmp->tx = base + offs->tx; > >> - qmp->rx = base + offs->rx; > >> + layout->pcs_misc = base + offs->pcs_misc; > >> + layout->tx = base + offs->tx; > >> + layout->rx = base + offs->rx; > >> > >> - qmp->tx2 = base + offs->tx2; > >> - qmp->rx2 = base + offs->rx2; > >> + layout->tx2 = base + offs->tx2; > >> + layout->rx2 = base + offs->rx2; > >> > >> ret = qmp_usbc_clk_init(qmp); > >> if (ret) > >> return ret; > >> > >> - qmp->pipe_clk = devm_clk_get(dev, "pipe"); > >> - if (IS_ERR(qmp->pipe_clk)) { > >> - return dev_err_probe(dev, PTR_ERR(qmp->pipe_clk), > >> + layout->pipe_clk = devm_clk_get(dev, "pipe"); > >> + if (IS_ERR(layout->pipe_clk)) { > >> + return dev_err_probe(dev, PTR_ERR(layout->pipe_clk), > >> "failed to get pipe clock\n"); > >> } > >> > >> @@ -1013,10 +1738,11 @@ static int qmp_usbc_parse_dt(struct qmp_usbc *qmp) > >> return 0; > >> } > >> > >> -static int qmp_usbc_parse_vls_clamp(struct qmp_usbc *qmp) > >> +static int qmp_usbc_parse_usb_vls_clamp(struct qmp_usbc *qmp) > >> { > >> struct of_phandle_args tcsr_args; > >> struct device *dev = qmp->dev; > >> + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); > >> int ret; > >> > >> /* for backwards compatibility ignore if there is no property */ > >> @@ -1027,22 +1753,280 @@ static int qmp_usbc_parse_vls_clamp(struct qmp_usbc *qmp) > >> else if (ret < 0) > >> return dev_err_probe(dev, ret, "Failed to parse qcom,tcsr-reg\n"); > >> > >> - qmp->tcsr_map = syscon_node_to_regmap(tcsr_args.np); > >> + layout->tcsr_map = syscon_node_to_regmap(tcsr_args.np); > >> of_node_put(tcsr_args.np); > >> - if (IS_ERR(qmp->tcsr_map)) > >> - return PTR_ERR(qmp->tcsr_map); > >> + if (IS_ERR(layout->tcsr_map)) > >> + return PTR_ERR(layout->tcsr_map); > >> > >> - qmp->vls_clamp_reg = tcsr_args.args[0]; > >> + layout->vls_clamp_reg = tcsr_args.args[0]; > >> > >> return 0; > >> } > >> > >> +static int qmp_usbc_parse_dp_phy_mode(struct qmp_usbc *qmp) > >> +{ > >> + struct of_phandle_args tcsr_args; > >> + struct device *dev = qmp->dev; > >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); > >> + int ret; > >> + > >> + /* for backwards compatibility ignore if there is no property */ > >> + ret = of_parse_phandle_with_fixed_args(dev->of_node, "qcom,tcsr-reg", 1, 0, > >> + &tcsr_args); > >> + if (ret < 0) > >> + return dev_err_probe(dev, ret, "Failed to parse qcom,tcsr-reg\n"); > >> + > >> + layout->tcsr_map = syscon_node_to_regmap(tcsr_args.np); > >> + of_node_put(tcsr_args.np); > >> + if (IS_ERR(layout->tcsr_map)) > >> + return PTR_ERR(layout->tcsr_map); > >> + > >> + layout->dp_phy_mode = tcsr_args.args[0]; > >> + > >> + return 0; > >> +} > >> + > >> +static int qmp_usbc_parse_dp_dt(struct qmp_usbc *qmp) > >> +{ > >> + struct platform_device *pdev = to_platform_device(qmp->dev); > >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); > >> + struct qmp_phy_dp_cfg *cfg = to_dp_cfg(qmp); > >> + const struct qmp_usbc_dp_offsets *offs = cfg->offsets; > >> + struct device *dev = qmp->dev; > >> + void __iomem *base; > >> + int ret; > >> + > >> + base = devm_platform_ioremap_resource(pdev, 0); > >> + if (IS_ERR(base)) { > >> + dev_err(dev, "get resource fail, ret:%d\n", ret); > >> + return PTR_ERR(base); > >> + } > >> + > >> + layout->dp_serdes = base + offs->dp_serdes; > >> + layout->dp_tx = base + offs->dp_txa; > >> + layout->dp_tx2 = base + offs->dp_txb; > >> + layout->dp_phy = base + offs->dp_phy; > >> + > >> + ret = qmp_usbc_clk_init(qmp); > >> + if (ret) { > >> + dev_err(dev, "clk init fail, ret:%d\n", ret); > >> + return ret; > >> + } > >> + > >> + ret = qmp_usbc_reset_init(qmp, dp_usb3phy_reset_l, > >> + ARRAY_SIZE(dp_usb3phy_reset_l)); > >> + if (ret) > >> + return ret; > >> + > >> + return 0; > >> +} > >> + > >> +/* > >> + * Display Port PLL driver block diagram for branch clocks > >> + * > >> + * +------------------------------+ > >> + * | DP_VCO_CLK | > >> + * | | > >> + * | +-------------------+ | > >> + * | | (DP PLL/VCO) | | > >> + * | +---------+---------+ | > >> + * | v | > >> + * | +----------+-----------+ | > >> + * | | hsclk_divsel_clk_src | | > >> + * | +----------+-----------+ | > >> + * +------------------------------+ > >> + * | > >> + * +---------<---------v------------>----------+ > >> + * | | > >> + * +--------v----------------+ | > >> + * | dp_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 > >> + * | > >> + * +----------+-----------------+ > >> + * | dp_phy_pll_vco_div_clk | > >> + * +---------+------------------+ > >> + * | > >> + * v > >> + * Input to DISPCC block > >> + * for DP pixel clock > >> + * > >> + */ > >> +static int qmp_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 qmp_dp_pixel_clk_recalc_rate(struct clk_hw *hw, unsigned long parent_rate) > >> +{ > >> + // const struct qmp_usbc *qmp; > >> + struct qmp_phy_dp_layout *layout; > >> + const struct phy_configure_opts_dp *dp_opts; > >> + > >> + layout = container_of(hw, struct qmp_phy_dp_layout, dp_pixel_hw); > >> + > >> + dp_opts = &layout->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 qmp_dp_pixel_clk_ops = { > >> + .determine_rate = qmp_dp_pixel_clk_determine_rate, > >> + .recalc_rate = qmp_dp_pixel_clk_recalc_rate, > >> +}; > >> + > >> +static int qmp_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 qmp_dp_link_clk_recalc_rate(struct clk_hw *hw, unsigned long parent_rate) > >> +{ > >> + // const struct qmp_combo *qmp; > >> + struct qmp_phy_dp_layout *layout; > >> + const struct phy_configure_opts_dp *dp_opts; > >> + > >> + layout = container_of(hw, struct qmp_phy_dp_layout, dp_link_hw); > >> + dp_opts = &layout->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 qmp_dp_link_clk_ops = { > >> + .determine_rate = qmp_dp_link_clk_determine_rate, > >> + .recalc_rate = qmp_dp_link_clk_recalc_rate, > >> +}; > >> + > >> +static int phy_dp_clks_register(struct qmp_usbc *qmp, struct device_node *np) > >> +{ > >> + struct clk_init_data init = { }; > >> + int ret = 0; > >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); > >> + > >> + ret = of_property_read_string_index(np, "clock-output-names", 0, &init.name); > >> + if (ret < 0) { > >> + dev_err(qmp->dev, "%pOFn: No link clock-output-names\n", np); > >> + return ret; > >> + } > >> + > >> + init.ops = &qmp_dp_link_clk_ops; > >> + layout->dp_link_hw.init = &init; > >> + ret = devm_clk_hw_register(qmp->dev, &layout->dp_link_hw); > >> + if (ret < 0) { > >> + dev_err(qmp->dev, "link clk reg fail ret=%d\n", ret); > >> + return ret; > >> + } > >> + > >> + ret = of_property_read_string_index(np, "clock-output-names", 1, &init.name); > >> + if (ret) { > >> + dev_err(qmp->dev, "%pOFn: No div clock-output-names\n", np); > >> + return ret; > >> + } > >> + > >> + init.ops = &qmp_dp_pixel_clk_ops; > >> + layout->dp_pixel_hw.init = &init; > >> + ret = devm_clk_hw_register(qmp->dev, &layout->dp_pixel_hw); > >> + if (ret) { > >> + dev_err(qmp->dev, "pxl clk reg fail ret=%d\n", ret); > >> + return ret; > >> + } > >> + > >> + return 0; > >> +} > >> + > >> +static struct clk_hw *qmp_dp_clks_hw_get(struct of_phandle_args *clkspec, void *data) > >> +{ > >> + struct qmp_usbc *qmp = data; > >> + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); > >> + > >> + switch (clkspec->args[0]) { > >> + case QMP_USB43DP_DP_LINK_CLK: > >> + return &layout->dp_link_hw; > >> + case QMP_USB43DP_DP_VCO_DIV_CLK: > >> + return &layout->dp_pixel_hw; > >> + } > >> + > >> + return ERR_PTR(-EINVAL); > >> +} > >> + > >> +static int qmp_dp_register_clocks(struct qmp_usbc *qmp, struct device_node *dp_np) > >> +{ > >> + int ret; > >> + > >> + ret = phy_dp_clks_register(qmp, dp_np); > >> + if (ret) { > >> + dev_err(qmp->dev, "dp clk reg fail ret:%d\n", ret); > >> + return ret; > >> + } > >> + > >> + ret = of_clk_add_hw_provider(dp_np, qmp_dp_clks_hw_get, qmp); > >> + if (ret) { > >> + dev_err(qmp->dev, "add provider fail ret:%d\n", ret); > >> + return ret; > >> + } > >> + > >> + return devm_add_action_or_reset(qmp->dev, phy_clk_release_provider, dp_np); > >> +} > >> + > >> static int qmp_usbc_probe(struct platform_device *pdev) > >> { > >> struct device *dev = &pdev->dev; > >> struct phy_provider *phy_provider; > >> struct device_node *np; > >> struct qmp_usbc *qmp; > >> + const struct dev_cfg *data_cfg; > >> int ret; > >> > >> qmp = devm_kzalloc(dev, sizeof(*qmp), GFP_KERNEL); > >> @@ -1050,38 +2034,74 @@ static int qmp_usbc_probe(struct platform_device *pdev) > >> return -ENOMEM; > >> > >> qmp->dev = dev; > >> - dev_set_drvdata(dev, qmp); > >> > >> qmp->orientation = TYPEC_ORIENTATION_NORMAL; > >> > >> - qmp->cfg = of_device_get_match_data(dev); > >> - if (!qmp->cfg) > >> + qmp->init_count = 0; > >> + > >> + data_cfg = of_device_get_match_data(dev); > >> + if (!data_cfg) { > >> + dev_err(qmp->dev, "get data fail\n"); > >> return -EINVAL; > >> + } > >> > >> mutex_init(&qmp->phy_mutex); > >> > >> - ret = qmp_usbc_vreg_init(qmp); > >> - if (ret) > >> - return ret; > >> + qmp->type = data_cfg->type; > >> + qmp->cfg = data_cfg->cfg; > >> > >> - ret = qmp_usbc_typec_switch_register(qmp); > >> - if (ret) > >> + ret = qmp_usbc_vreg_init(qmp); > >> + if (ret) { > >> + dev_err(qmp->dev, "qmp_type(%d) vreg init fail\n", qmp->type); > >> return ret; > >> + } > >> > >> - ret = qmp_usbc_parse_vls_clamp(qmp); > >> - if (ret) > >> - return ret; > >> + if (qmp->type == QMP_PHY_USBC_USB) { > >> + qmp->layout = devm_kzalloc(dev, sizeof(struct qmp_phy_usb_layout), GFP_KERNEL); > >> + if (!qmp->layout) > >> + return -ENOMEM; > >> + > >> + ret = qmp_usbc_typec_switch_register(qmp); > >> + if (ret) > >> + return ret; > >> + > >> + ret = qmp_usbc_parse_usb_vls_clamp(qmp); > >> + if (ret) > >> + return ret; > >> + > >> + /* Check for legacy binding with child node. */ > >> + np = of_get_child_by_name(dev->of_node, "phy"); > >> + if (np) { > >> + ret = qmp_usbc_parse_usb_dt_legacy(qmp, np); > >> + } else { > >> + np = of_node_get(dev->of_node); > >> + ret = qmp_usbc_parse_usb_dt(qmp); > >> + } > >> + if (ret) > >> + goto err_node_put; > >> + } else if (qmp->type == QMP_PHY_USBC_DP) { > >> + qmp->layout = devm_kzalloc(dev, sizeof(struct qmp_phy_dp_layout), GFP_KERNEL); > >> + if (!qmp->layout) > >> + return -ENOMEM; > >> > >> - /* Check for legacy binding with child node. */ > >> - np = of_get_child_by_name(dev->of_node, "phy"); > >> - if (np) { > >> - ret = qmp_usbc_parse_dt_legacy(qmp, np); > >> - } else { > >> np = of_node_get(dev->of_node); > >> - ret = qmp_usbc_parse_dt(qmp); > >> - } > >> - if (ret) > >> + ret = qmp_usbc_parse_dp_phy_mode(qmp); > >> + if (ret) > >> + goto err_node_put; > >> + > >> + ret = qmp_usbc_parse_dp_dt(qmp); > >> + if (ret) > >> + goto err_node_put; > >> + > >> + ret = drm_aux_bridge_register(dev); > >> + if (ret) { > >> + dev_err(qmp->dev, "aux bridge reg fail ret=%d\n", ret); > >> + goto err_node_put; > >> + } > >> + } else { > >> + dev_err(dev, "invalid phy type: %d\n", qmp->type); > >> goto err_node_put; > >> + } > >> > >> pm_runtime_set_active(dev); > >> ret = devm_pm_runtime_enable(dev); > >> @@ -1093,19 +2113,33 @@ static int qmp_usbc_probe(struct platform_device *pdev) > >> */ > >> pm_runtime_forbid(dev); > >> > >> - ret = phy_pipe_clk_register(qmp, np); > >> - if (ret) > >> - goto err_node_put; > >> - > >> - qmp->phy = devm_phy_create(dev, np, &qmp_usbc_phy_ops); > >> - if (IS_ERR(qmp->phy)) { > >> - ret = PTR_ERR(qmp->phy); > >> - dev_err(dev, "failed to create PHY: %d\n", ret); > >> - goto err_node_put; > >> + if (qmp->type == QMP_PHY_USBC_USB) { > >> + // pipe clk process > >> + ret = phy_pipe_clk_register(qmp, np); > >> + if (ret) > >> + goto err_node_put; > >> + > >> + qmp->phy = devm_phy_create(dev, np, &qmp_usbc_usb_phy_ops); > >> + if (IS_ERR(qmp->phy)) { > >> + ret = PTR_ERR(qmp->phy); > >> + dev_err(dev, "failed to create PHY: %d\n", ret); > >> + goto err_node_put; > >> + } > >> + } else { > >> + ret = qmp_dp_register_clocks(qmp, np); > >> + if (ret) > >> + goto err_node_put; > >> + > >> + qmp->phy = devm_phy_create(dev, np, &qmp_usbc_dp_phy_ops); > >> + if (IS_ERR(qmp->phy)) { > >> + ret = PTR_ERR(qmp->phy); > >> + dev_err(dev, "failed to create PHY: %d\n", ret); > >> + goto err_node_put; > >> + } > >> } > >> > >> phy_set_drvdata(qmp->phy, qmp); > >> - > >> + dev_set_drvdata(dev, qmp); > >> of_node_put(np); > >> > >> phy_provider = devm_of_phy_provider_register(dev, of_phy_simple_xlate); > >> @@ -1120,19 +2154,38 @@ static int qmp_usbc_probe(struct platform_device *pdev) > >> static const struct of_device_id qmp_usbc_of_match_table[] = { > >> { > >> .compatible = "qcom,msm8998-qmp-usb3-phy", > >> - .data = &msm8998_usb3phy_cfg, > >> + .data = &(struct dev_cfg) { > >> + .type = QMP_PHY_USBC_USB, > >> + .cfg = &msm8998_usb3phy_cfg, > >> + }, > >> }, { > >> .compatible = "qcom,qcm2290-qmp-usb3-phy", > >> - .data = &qcm2290_usb3phy_cfg, > >> + .data = &(struct dev_cfg) { > >> + .type = QMP_PHY_USBC_USB, > >> + .cfg = &qcm2290_usb3phy_cfg, > >> + }, > >> + }, { > >> + .compatible = "qcom,qcs615-qmp-dp-phy", > >> + .data = &(struct dev_cfg) { > >> + .type = QMP_PHY_USBC_DP, > >> + .cfg = &qcs615_dpphy_cfg, > >> + }, > >> }, { > >> .compatible = "qcom,sdm660-qmp-usb3-phy", > >> - .data = &sdm660_usb3phy_cfg, > >> + .data = &(struct dev_cfg) { > >> + .type = QMP_PHY_USBC_USB, > >> + .cfg = &sdm660_usb3phy_cfg, > >> + }, > >> }, { > >> .compatible = "qcom,sm6115-qmp-usb3-phy", > >> - .data = &qcm2290_usb3phy_cfg, > >> + .data = &(struct dev_cfg) { > >> + .type = QMP_PHY_USBC_USB, > >> + .cfg = &qcm2290_usb3phy_cfg, > >> + }, > >> }, > >> { }, > >> }; > >> + > >> MODULE_DEVICE_TABLE(of, qmp_usbc_of_match_table); > >> > >> static struct platform_driver qmp_usbc_driver = { > >> > >> -- > >> 2.25.1 > >> > > > > > > > -- > linux-phy mailing list > linux-phy@lists.infradead.org > https://lists.infradead.org/mailman/listinfo/linux-phy
On Thu, Dec 05, 2024 at 08:31:24PM +0200, Dmitry Baryshkov wrote: > On Thu, Dec 05, 2024 at 09:26:47PM +0800, Xiangxu Yin wrote: > > > > > > On 11/29/2024 10:33 PM, Dmitry Baryshkov wrote: > > > On Fri, 29 Nov 2024 at 09:59, Xiangxu Yin <quic_xiangxuy@quicinc.com> wrote: > > >> > > >> Extended DP support for QCS615 USB or DP phy. Differentiated between > > >> USBC and DP PHY using the match table’s type, dynamically generating > > >> different types of cfg and layout attributes during initialization based > > >> on this type. Static variables are stored in cfg, while parsed values > > >> are organized into the layout structure. > > > > > > We didn't have an understanding / conclusion whether > > > qcom,usb-ssphy-qmp-usb3-or-dp PHYs are actually a single device / PHY > > > or two PHYs being placed next to each other. Could you please start > > > your commit message by explaining it? Or even better, make that a part > > > of the cover letter for a new series touching just the USBC PHY > > > driver. DP changes don't have anything in common with the PHY changes, > > > so you can split the series into two. > > > > > Before implement DP extension, we have discussed with abhinav and krishna about whether use combo, usbc or separate phy. > > What is "DP extension"? > > > > > We identified that DP and USB share some common controls for phy_mode and orientation. > > Specifically, 'TCSR_USB3_0_DP_PHYMODE' controls who must use the lanes - USB or DP, > > while PERIPH_SS_USB0_USB3PHY_PCS_MISC_TYPEC_CTRL controls the orientation. > > It would be more efficient for a single driver to manage these controls. > > The question is about the hardware, not about the driver. > > > Additionally, this PHY does not support Alt Mode, and the two control registers are located in separate address spaces. > > Therefore, even though the orientation for DP on this platform is always normal and connected to the video output board, > > we still decided to base it on the USBC extension. > > Could you please clarify, do usb3-or-dp PHYs support DP-over-USB-C? I > thought that usbc-or-dp platforms support that, but they don't > support DP+USB pin configuration. Note, the question is broader than > just QCS615, it covers the PHY type itself. > > Also, is TCSR configuration read/write or read-only? Are we supposed to > set the register from OS or are we supposed to read it and thus detemine > the PHY mode? Any updates on these two topics?
On 12/10/2024 11:09 PM, Dmitry Baryshkov wrote: > On Thu, Dec 05, 2024 at 08:31:24PM +0200, Dmitry Baryshkov wrote: >> On Thu, Dec 05, 2024 at 09:26:47PM +0800, Xiangxu Yin wrote: >>> >>> >>> On 11/29/2024 10:33 PM, Dmitry Baryshkov wrote: >>>> On Fri, 29 Nov 2024 at 09:59, Xiangxu Yin <quic_xiangxuy@quicinc.com> wrote: >>>>> >>>>> Extended DP support for QCS615 USB or DP phy. Differentiated between >>>>> USBC and DP PHY using the match table’s type, dynamically generating >>>>> different types of cfg and layout attributes during initialization based >>>>> on this type. Static variables are stored in cfg, while parsed values >>>>> are organized into the layout structure. >>>> >>>> We didn't have an understanding / conclusion whether >>>> qcom,usb-ssphy-qmp-usb3-or-dp PHYs are actually a single device / PHY >>>> or two PHYs being placed next to each other. Could you please start >>>> your commit message by explaining it? Or even better, make that a part >>>> of the cover letter for a new series touching just the USBC PHY >>>> driver. DP changes don't have anything in common with the PHY changes, >>>> so you can split the series into two. >>>> >>> Before implement DP extension, we have discussed with abhinav and krishna about whether use combo, usbc or separate phy. >> >> What is "DP extension"? >> I'm sorry confusion casued by my description. It's means extend DP implemnt for USBC phy driver. >>> >>> We identified that DP and USB share some common controls for phy_mode and orientation. >>> Specifically, 'TCSR_USB3_0_DP_PHYMODE' controls who must use the lanes - USB or DP, >>> while PERIPH_SS_USB0_USB3PHY_PCS_MISC_TYPEC_CTRL controls the orientation. >>> It would be more efficient for a single driver to manage these controls. >> >> The question is about the hardware, not about the driver. >> >>> Additionally, this PHY does not support Alt Mode, and the two control registers are located in separate address spaces. >>> Therefore, even though the orientation for DP on this platform is always normal and connected to the video output board, >>> we still decided to base it on the USBC extension. >> >> Could you please clarify, do usb3-or-dp PHYs support DP-over-USB-C? I >> thought that usbc-or-dp platforms support that, but they don't >> support DP+USB pin configuration. Note, the question is broader than >> just QCS615, it covers the PHY type itself. >> >> Also, is TCSR configuration read/write or read-only? Are we supposed to >> set the register from OS or are we supposed to read it and thus detemine >> the PHY mode? > > Any updates on these two topics? > Still confirming detail info with HW & design team. I’ll update the information that has been confirmed so far. This phy support DP-over-USB-C,but it's not support alt-mode which 2 lane work for DP, other 2 lane work for USB. TCSR phy mode is read/write reg and we can read for determine phy mode.
On Wed, Dec 11, 2024 at 08:46:16AM +0800, Xiangxu Yin wrote: > > > On 12/10/2024 11:09 PM, Dmitry Baryshkov wrote: > > On Thu, Dec 05, 2024 at 08:31:24PM +0200, Dmitry Baryshkov wrote: > >> On Thu, Dec 05, 2024 at 09:26:47PM +0800, Xiangxu Yin wrote: > >>> > >>> > >>> On 11/29/2024 10:33 PM, Dmitry Baryshkov wrote: > >>>> On Fri, 29 Nov 2024 at 09:59, Xiangxu Yin <quic_xiangxuy@quicinc.com> wrote: > >>>>> > >>>>> Extended DP support for QCS615 USB or DP phy. Differentiated between > >>>>> USBC and DP PHY using the match table’s type, dynamically generating > >>>>> different types of cfg and layout attributes during initialization based > >>>>> on this type. Static variables are stored in cfg, while parsed values > >>>>> are organized into the layout structure. > >>>> > >>>> We didn't have an understanding / conclusion whether > >>>> qcom,usb-ssphy-qmp-usb3-or-dp PHYs are actually a single device / PHY > >>>> or two PHYs being placed next to each other. Could you please start > >>>> your commit message by explaining it? Or even better, make that a part > >>>> of the cover letter for a new series touching just the USBC PHY > >>>> driver. DP changes don't have anything in common with the PHY changes, > >>>> so you can split the series into two. > >>>> > >>> Before implement DP extension, we have discussed with abhinav and krishna about whether use combo, usbc or separate phy. > >> > >> What is "DP extension"? > >> > I'm sorry confusion casued by my description. It's means extend DP implemnt for USBC phy driver. > >>> > >>> We identified that DP and USB share some common controls for phy_mode and orientation. > >>> Specifically, 'TCSR_USB3_0_DP_PHYMODE' controls who must use the lanes - USB or DP, > >>> while PERIPH_SS_USB0_USB3PHY_PCS_MISC_TYPEC_CTRL controls the orientation. > >>> It would be more efficient for a single driver to manage these controls. > >> > >> The question is about the hardware, not about the driver. > >> > >>> Additionally, this PHY does not support Alt Mode, and the two control registers are located in separate address spaces. > >>> Therefore, even though the orientation for DP on this platform is always normal and connected to the video output board, > >>> we still decided to base it on the USBC extension. > >> > >> Could you please clarify, do usb3-or-dp PHYs support DP-over-USB-C? I > >> thought that usbc-or-dp platforms support that, but they don't > >> support DP+USB pin configuration. Note, the question is broader than > >> just QCS615, it covers the PHY type itself. > >> > >> Also, is TCSR configuration read/write or read-only? Are we supposed to > >> set the register from OS or are we supposed to read it and thus detemine > >> the PHY mode? > > > > Any updates on these two topics? > > > Still confirming detail info with HW & design team. > I’ll update the information that has been confirmed so far. > This phy support DP-over-USB-C,but it's not support alt-mode which 2 lane work for DP, other 2 lane work for USB. > TCSR phy mode is read/write reg and we can read for determine phy mode. Ok, thanks for the explanation. From my point of view: - Implement the DP PHY to be a part of the same driver. Each device supported by the usbc driver should get both PHYs. - Make sure not to break the ABI: #phy-cells = <0> should still work and return USB PHY, keeping backwards compatibility. Newer devices or upgraded DT for old devices should return USB PHY for <... 0> and DP PHY for <... 1>. - I'm not shure how to handle the USB and DP coexistence, especially in your case of the USB-or-DP PHY.
On 12/11/2024 5:46 PM, Dmitry Baryshkov wrote: > On Wed, Dec 11, 2024 at 08:46:16AM +0800, Xiangxu Yin wrote: >> >> >> On 12/10/2024 11:09 PM, Dmitry Baryshkov wrote: >>> On Thu, Dec 05, 2024 at 08:31:24PM +0200, Dmitry Baryshkov wrote: >>>> On Thu, Dec 05, 2024 at 09:26:47PM +0800, Xiangxu Yin wrote: >>>>> >>>>> >>>>> On 11/29/2024 10:33 PM, Dmitry Baryshkov wrote: >>>>>> On Fri, 29 Nov 2024 at 09:59, Xiangxu Yin <quic_xiangxuy@quicinc.com> wrote: >>>>>>> >>>>>>> Extended DP support for QCS615 USB or DP phy. Differentiated between >>>>>>> USBC and DP PHY using the match table’s type, dynamically generating >>>>>>> different types of cfg and layout attributes during initialization based >>>>>>> on this type. Static variables are stored in cfg, while parsed values >>>>>>> are organized into the layout structure. >>>>>> >>>>>> We didn't have an understanding / conclusion whether >>>>>> qcom,usb-ssphy-qmp-usb3-or-dp PHYs are actually a single device / PHY >>>>>> or two PHYs being placed next to each other. Could you please start >>>>>> your commit message by explaining it? Or even better, make that a part >>>>>> of the cover letter for a new series touching just the USBC PHY >>>>>> driver. DP changes don't have anything in common with the PHY changes, >>>>>> so you can split the series into two. >>>>>> >>>>> Before implement DP extension, we have discussed with abhinav and krishna about whether use combo, usbc or separate phy. >>>> >>>> What is "DP extension"? >>>> >> I'm sorry confusion casued by my description. It's means extend DP implemnt for USBC phy driver. >>>>> >>>>> We identified that DP and USB share some common controls for phy_mode and orientation. >>>>> Specifically, 'TCSR_USB3_0_DP_PHYMODE' controls who must use the lanes - USB or DP, >>>>> while PERIPH_SS_USB0_USB3PHY_PCS_MISC_TYPEC_CTRL controls the orientation. >>>>> It would be more efficient for a single driver to manage these controls. >>>> >>>> The question is about the hardware, not about the driver. >>>> >>>>> Additionally, this PHY does not support Alt Mode, and the two control registers are located in separate address spaces. >>>>> Therefore, even though the orientation for DP on this platform is always normal and connected to the video output board, >>>>> we still decided to base it on the USBC extension. >>>> >>>> Could you please clarify, do usb3-or-dp PHYs support DP-over-USB-C? I >>>> thought that usbc-or-dp platforms support that, but they don't >>>> support DP+USB pin configuration. Note, the question is broader than >>>> just QCS615, it covers the PHY type itself. >>>> >>>> Also, is TCSR configuration read/write or read-only? Are we supposed to >>>> set the register from OS or are we supposed to read it and thus detemine >>>> the PHY mode? >>> >>> Any updates on these two topics? >>> >> Still confirming detail info with HW & design team. >> I’ll update the information that has been confirmed so far. >> This phy support DP-over-USB-C,but it's not support alt-mode which 2 lane work for DP, other 2 lane work for USB. >> TCSR phy mode is read/write reg and we can read for determine phy mode. > > Ok, thanks for the explanation. From my point of view: > > - Implement the DP PHY to be a part of the same driver. Each device > supported by the usbc driver should get both PHYs. > > - Make sure not to break the ABI: #phy-cells = <0> should still work and > return USB PHY, keeping backwards compatibility. Newer devices or > upgraded DT for old devices should return USB PHY for <... 0> and DP > PHY for <... 1>. > Yes, currently we have implemented like your description, Each deivce shoud get both PHYs, DP PHY for <... 1> and USB PHY for <... 0>. > - I'm not shure how to handle the USB and DP coexistence, especially in > your case of the USB-or-DP PHY. > For coexistence process: When we start implement DP part, usb driver team said only need config TCSR phy mode and orientation during switch in USB-C port. Based on your previous comments avout SW_PWRDN, I'm confirming with the USB team whether SW_REST/SWPWRDN/START_CTRL registers might affect DP. Anyway, even though the original SoC design supports DP or USB over Type-C， but on QCS615 ADP AIR platform, there are only four USB-A port which works with 'qcs615-qmp-usb3-phy' driver, and no USB-C port. DP port is mappped from usb pin to the video out sub-board. so we are unable to verify the switching case between DP and USB devices under USB-C. However, I'm also confirming whether anything other will affect USB and DP each other.
On Wed, Dec 11, 2024 at 08:50:02PM +0800, Xiangxu Yin wrote: > > > On 12/11/2024 5:46 PM, Dmitry Baryshkov wrote: > > On Wed, Dec 11, 2024 at 08:46:16AM +0800, Xiangxu Yin wrote: > >> > >> > >> On 12/10/2024 11:09 PM, Dmitry Baryshkov wrote: > >>> On Thu, Dec 05, 2024 at 08:31:24PM +0200, Dmitry Baryshkov wrote: > >>>> On Thu, Dec 05, 2024 at 09:26:47PM +0800, Xiangxu Yin wrote: > >>>>> > >>>>> > >>>>> On 11/29/2024 10:33 PM, Dmitry Baryshkov wrote: > >>>>>> On Fri, 29 Nov 2024 at 09:59, Xiangxu Yin <quic_xiangxuy@quicinc.com> wrote: > >>>>>>> > >>>>>>> Extended DP support for QCS615 USB or DP phy. Differentiated between > >>>>>>> USBC and DP PHY using the match table’s type, dynamically generating > >>>>>>> different types of cfg and layout attributes during initialization based > >>>>>>> on this type. Static variables are stored in cfg, while parsed values > >>>>>>> are organized into the layout structure. > >>>>>> > >>>>>> We didn't have an understanding / conclusion whether > >>>>>> qcom,usb-ssphy-qmp-usb3-or-dp PHYs are actually a single device / PHY > >>>>>> or two PHYs being placed next to each other. Could you please start > >>>>>> your commit message by explaining it? Or even better, make that a part > >>>>>> of the cover letter for a new series touching just the USBC PHY > >>>>>> driver. DP changes don't have anything in common with the PHY changes, > >>>>>> so you can split the series into two. > >>>>>> > >>>>> Before implement DP extension, we have discussed with abhinav and krishna about whether use combo, usbc or separate phy. > >>>> > >>>> What is "DP extension"? > >>>> > >> I'm sorry confusion casued by my description. It's means extend DP implemnt for USBC phy driver. > >>>>> > >>>>> We identified that DP and USB share some common controls for phy_mode and orientation. > >>>>> Specifically, 'TCSR_USB3_0_DP_PHYMODE' controls who must use the lanes - USB or DP, > >>>>> while PERIPH_SS_USB0_USB3PHY_PCS_MISC_TYPEC_CTRL controls the orientation. > >>>>> It would be more efficient for a single driver to manage these controls. > >>>> > >>>> The question is about the hardware, not about the driver. > >>>> > >>>>> Additionally, this PHY does not support Alt Mode, and the two control registers are located in separate address spaces. > >>>>> Therefore, even though the orientation for DP on this platform is always normal and connected to the video output board, > >>>>> we still decided to base it on the USBC extension. > >>>> > >>>> Could you please clarify, do usb3-or-dp PHYs support DP-over-USB-C? I > >>>> thought that usbc-or-dp platforms support that, but they don't > >>>> support DP+USB pin configuration. Note, the question is broader than > >>>> just QCS615, it covers the PHY type itself. > >>>> > >>>> Also, is TCSR configuration read/write or read-only? Are we supposed to > >>>> set the register from OS or are we supposed to read it and thus detemine > >>>> the PHY mode? > >>> > >>> Any updates on these two topics? > >>> > >> Still confirming detail info with HW & design team. > >> I’ll update the information that has been confirmed so far. > >> This phy support DP-over-USB-C,but it's not support alt-mode which 2 lane work for DP, other 2 lane work for USB. > >> TCSR phy mode is read/write reg and we can read for determine phy mode. > > > > Ok, thanks for the explanation. From my point of view: > > > > - Implement the DP PHY to be a part of the same driver. Each device > > supported by the usbc driver should get both PHYs. > > > > - Make sure not to break the ABI: #phy-cells = <0> should still work and > > return USB PHY, keeping backwards compatibility. Newer devices or > > upgraded DT for old devices should return USB PHY for <... 0> and DP > > PHY for <... 1>. > > > Yes, currently we have implemented like your description, > Each deivce shoud get both PHYs, DP PHY for <... 1> and USB PHY for <... 0>. Please note the backwards compatibility clause. > > - I'm not shure how to handle the USB and DP coexistence, especially in > > your case of the USB-or-DP PHY. > > > For coexistence process: > > When we start implement DP part, usb driver team said only need config TCSR phy mode and orientation during switch in USB-C port. > Based on your previous comments avout SW_PWRDN, I'm confirming with the USB team whether SW_REST/SWPWRDN/START_CTRL registers might affect DP. Thanks! > Anyway, even though the original SoC design supports DP or USB over Type-C， > but on QCS615 ADP AIR platform, there are only four USB-A port which works with 'qcs615-qmp-usb3-phy' driver, and no USB-C port. > DP port is mappped from usb pin to the video out sub-board. > so we are unable to verify the switching case between DP and USB devices under USB-C. That's also fine. We will get to that point once MSM8998 / SDM660 get USB-C support (the only current blocker is the support for the TYPEC block of the PMI8998). > However, I'm also confirming whether anything other will affect USB and DP each other.
On Wed, Dec 18, 2024 at 08:55:54PM +0800, Xiangxu Yin wrote: > > > On 12/12/2024 3:15 AM, Dmitry Baryshkov wrote: > > On Wed, Dec 11, 2024 at 08:50:02PM +0800, Xiangxu Yin wrote: > >> > >> > >> On 12/11/2024 5:46 PM, Dmitry Baryshkov wrote: > >>> On Wed, Dec 11, 2024 at 08:46:16AM +0800, Xiangxu Yin wrote: > >>>> > >>>> > >>>> On 12/10/2024 11:09 PM, Dmitry Baryshkov wrote: > >>>>> On Thu, Dec 05, 2024 at 08:31:24PM +0200, Dmitry Baryshkov wrote: > >>>>>> On Thu, Dec 05, 2024 at 09:26:47PM +0800, Xiangxu Yin wrote: > >>>>>>> > >>>>>>> > >>>>>>> On 11/29/2024 10:33 PM, Dmitry Baryshkov wrote: > >>>>>>>> On Fri, 29 Nov 2024 at 09:59, Xiangxu Yin <quic_xiangxuy@quicinc.com> wrote: > >>>>>>>>> > >>>>>>>>> Extended DP support for QCS615 USB or DP phy. Differentiated between > >>>>>>>>> USBC and DP PHY using the match table’s type, dynamically generating > >>>>>>>>> different types of cfg and layout attributes during initialization based > >>>>>>>>> on this type. Static variables are stored in cfg, while parsed values > >>>>>>>>> are organized into the layout structure. > >>>>>>>> > >>>>>>>> We didn't have an understanding / conclusion whether > >>>>>>>> qcom,usb-ssphy-qmp-usb3-or-dp PHYs are actually a single device / PHY > >>>>>>>> or two PHYs being placed next to each other. Could you please start > >>>>>>>> your commit message by explaining it? Or even better, make that a part > >>>>>>>> of the cover letter for a new series touching just the USBC PHY > >>>>>>>> driver. DP changes don't have anything in common with the PHY changes, > >>>>>>>> so you can split the series into two. > >>>>>>>> > >>>>>>> Before implement DP extension, we have discussed with abhinav and krishna about whether use combo, usbc or separate phy. > >>>>>> > >>>>>> What is "DP extension"? > >>>>>> > >>>> I'm sorry confusion casued by my description. It's means extend DP implemnt for USBC phy driver. > >>>>>>> > >>>>>>> We identified that DP and USB share some common controls for phy_mode and orientation. > >>>>>>> Specifically, 'TCSR_USB3_0_DP_PHYMODE' controls who must use the lanes - USB or DP, > >>>>>>> while PERIPH_SS_USB0_USB3PHY_PCS_MISC_TYPEC_CTRL controls the orientation. > >>>>>>> It would be more efficient for a single driver to manage these controls. > >>>>>> > >>>>>> The question is about the hardware, not about the driver. > >>>>>> > >>>>>>> Additionally, this PHY does not support Alt Mode, and the two control registers are located in separate address spaces. > >>>>>>> Therefore, even though the orientation for DP on this platform is always normal and connected to the video output board, > >>>>>>> we still decided to base it on the USBC extension. > >>>>>> > >>>>>> Could you please clarify, do usb3-or-dp PHYs support DP-over-USB-C? I > >>>>>> thought that usbc-or-dp platforms support that, but they don't > >>>>>> support DP+USB pin configuration. Note, the question is broader than > >>>>>> just QCS615, it covers the PHY type itself. > >>>>>> > >>>>>> Also, is TCSR configuration read/write or read-only? Are we supposed to > >>>>>> set the register from OS or are we supposed to read it and thus detemine > >>>>>> the PHY mode? > >>>>> > >>>>> Any updates on these two topics? > >>>>> > >>>> Still confirming detail info with HW & design team. > >>>> I’ll update the information that has been confirmed so far. > >>>> This phy support DP-over-USB-C,but it's not support alt-mode which 2 lane work for DP, other 2 lane work for USB. > >>>> TCSR phy mode is read/write reg and we can read for determine phy mode. > >>> > >>> Ok, thanks for the explanation. From my point of view: > >>> > >>> - Implement the DP PHY to be a part of the same driver. Each device > >>> supported by the usbc driver should get both PHYs. > >>> > >>> - Make sure not to break the ABI: #phy-cells = <0> should still work and > >>> return USB PHY, keeping backwards compatibility. Newer devices or > >>> upgraded DT for old devices should return USB PHY for <... 0> and DP > >>> PHY for <... 1>. > >>> > >> Yes, currently we have implemented like your description, > >> Each deivce shoud get both PHYs, DP PHY for <... 1> and USB PHY for <... 0>. > > > > Please note the backwards compatibility clause. > > > For the USB node, we kept the same implementation as the original function interface, and the devicetree node definition also remains unchanged. > In subsequent patches, I will follow Krzysztof’s suggestion to use a separate DT-binding to describe the DP PHY configuration, > without making changes to the USB devicetree and DT-binding implementation. > >>> - I'm not shure how to handle the USB and DP coexistence, especially in > >>> your case of the USB-or-DP PHY. > >>> > >> For coexistence process: > >> > >> When we start implement DP part, usb driver team said only need config TCSR phy mode and orientation during switch in USB-C port. > >> Based on your previous comments avout SW_PWRDN, I'm confirming with the USB team whether SW_REST/SWPWRDN/START_CTRL registers might affect DP. > > > > Thanks! > > > >> Anyway, even though the original SoC design supports DP or USB over Type-C， > >> but on QCS615 ADP AIR platform, there are only four USB-A port which works with 'qcs615-qmp-usb3-phy' driver, and no USB-C port. > >> DP port is mappped from usb pin to the video out sub-board. > >> so we are unable to verify the switching case between DP and USB devices under USB-C. > > > > That's also fine. We will get to that point once MSM8998 / SDM660 > > get USB-C support (the only current blocker is the support for the > > TYPEC block of the PMI8998). > > > I can't access MSM8998 / SDM660 documents now, but I have confirmed detail info about USB & DP phy design for sm6150. > > The 'usb-ssphy-qmp-usb3-or-dp PHY' on the current platform is essentially composed of three sub-PHYs, > which can even be considered as three separate PHYs: USB3 primary PHY, USB3 secondary PHY, and USB3 DP PHY. I've looked at sm6150-usb.dtsi and now I'm completely puzzled by your answer. The msm-4.14 kernel lists a single USB QMP PHY at 0x88e6000, used for the primary USB3 host. It it defined as qcom,usb-ssphy-qmp-usb3-or-dp. Secondary USB host is listed as USB 2.0 only. So what do you mean by the USB3 secondary PHY? Which PHY and which pins are connected to your video-out board? > > On the QCS615, the USB primary PHY is currently used to handle USB 3.0 communication for the previously mentioned four USB Type-A ports, > while the USB3 secondary PHY and USB3 DP PHY are used for the output of the Type-C port, > but since the Type-C port is forcibly pin-to-pin configured to the video out board, the Type-C port will always configure as DP PHY. > > The internal registers of these three PHYs are independent of each other, Neither their respective SWPWR_DN nor SWRST will affect the other two PHYs. > Additionally, there was a misunderstanding about the orientation previously. > The USB orientation setting only affects the current PHY and does not impact the DP PHY. The DP PHY is configured in the DP_PHY_CFG_1. > > TSCR_PHY_MODE can specify which PHY outputs to the Type-C port, and the global reset will simultaneously reset the two associated PHYs. > Therefore, the correct switching process is as follows. > When switching the inserted device: > 1.Identify the PHY type. > 2.Enable the regulator. > 3.Trigger a reset. > 4.Enable the clock. > 5.Configure PHY type related orientation > 6.switch the TCSR PHY mode. > 7.Configure the registers of PHY. > During release: > 1.Reset. > 2.Disable the clock. > 3.Disable the regulator. > > Our current design overall complies with this process, but it lacks the configuration for DP_PHY_CFG_1. > > Shall we continue the discussion to clarify remain comments of the USBC driver? > > >> However, I'm also confirming whether anything other will affect USB and DP each other. > > >
diff --git a/drivers/phy/qualcomm/phy-qcom-qmp-dp-phy.h b/drivers/phy/qualcomm/phy-qcom-qmp-dp-phy.h index 0ebd405bcaf0cac8215550bfc9b226f30cc43a59..59885616405f878885d0837838a0bac1899fb69f 100644 --- a/drivers/phy/qualcomm/phy-qcom-qmp-dp-phy.h +++ b/drivers/phy/qualcomm/phy-qcom-qmp-dp-phy.h @@ -25,6 +25,7 @@ #define QSERDES_DP_PHY_AUX_CFG7 0x03c #define QSERDES_DP_PHY_AUX_CFG8 0x040 #define QSERDES_DP_PHY_AUX_CFG9 0x044 +#define QSERDES_DP_PHY_VCO_DIV 0x068 /* QSERDES COM_BIAS_EN_CLKBUFLR_EN bits */ # define QSERDES_V3_COM_BIAS_EN 0x0001 diff --git a/drivers/phy/qualcomm/phy-qcom-qmp-usbc.c b/drivers/phy/qualcomm/phy-qcom-qmp-usbc.c index cf12a6f12134dc77ff032f967b2efa43e3de4b21..7fece9d7dc959ed5a7c62077d8552324c3734859 100644 --- a/drivers/phy/qualcomm/phy-qcom-qmp-usbc.c +++ b/drivers/phy/qualcomm/phy-qcom-qmp-usbc.c @@ -22,13 +22,20 @@ #include <linux/slab.h> #include <linux/usb/typec.h> #include <linux/usb/typec_mux.h> +#include <dt-bindings/phy/phy-qcom-qmp.h> +#include <drm/bridge/aux-bridge.h> #include "phy-qcom-qmp-common.h" #include "phy-qcom-qmp.h" #include "phy-qcom-qmp-pcs-misc-v3.h" +#include "phy-qcom-qmp-dp-phy.h" +#include "phy-qcom-qmp-dp-phy-v3.h" + #define PHY_INIT_COMPLETE_TIMEOUT 10000 +#define SW_PORTSELECT_VAL BIT(0) +#define SW_PORTSELECT_MUX BIT(1) /* set of registers with offsets different per-PHY */ enum qphy_reg_layout { @@ -284,7 +291,26 @@ static const struct qmp_phy_init_tbl qcm2290_usb3_pcs_tbl[] = { QMP_PHY_INIT_CFG(QPHY_V3_PCS_RX_SIGDET_LVL, 0x88), }; -struct qmp_usbc_offsets { +enum qmp_phy_usbc_type { + QMP_PHY_USBC_INVALID, + QMP_PHY_USBC_USB, + QMP_PHY_USBC_DP, +}; + +/* list of regulators */ +struct qmp_regulator_data { + const char *name; + unsigned int enable_load; +}; + +struct dev_cfg { + int type; + const void *cfg; +}; + +struct qmp_usbc; + +struct qmp_usbc_usb_offsets { u16 serdes; u16 pcs; u16 pcs_misc; @@ -295,9 +321,9 @@ struct qmp_usbc_offsets { u16 rx2; }; -/* struct qmp_phy_cfg - per-PHY initialization config */ -struct qmp_phy_cfg { - const struct qmp_usbc_offsets *offsets; +/* struct qmp_phy_usb_cfg - per-usb PHY initialization config */ +struct qmp_phy_usb_cfg { + const struct qmp_usbc_usb_offsets *offsets; /* Init sequence for PHY blocks - serdes, tx, rx, pcs */ const struct qmp_phy_init_tbl *serdes_tbl; @@ -317,11 +343,7 @@ struct qmp_phy_cfg { const unsigned int *regs; }; -struct qmp_usbc { - struct device *dev; - - const struct qmp_phy_cfg *cfg; - +struct qmp_phy_usb_layout { void __iomem *serdes; void __iomem *pcs; void __iomem *pcs_misc; @@ -329,28 +351,67 @@ struct qmp_usbc { void __iomem *rx; void __iomem *tx2; void __iomem *rx2; - struct regmap *tcsr_map; u32 vls_clamp_reg; - + enum phy_mode mode; + struct typec_switch_dev *sw; struct clk *pipe_clk; + struct clk_fixed_rate pipe_clk_fixed; +}; + +struct qmp_usbc_dp_offsets { + u16 dp_serdes; + u16 dp_txa; + u16 dp_txb; + u16 dp_phy; +}; + +/* struct qmp_phy_dp_cfg - per-dp PHY initialization config */ +struct qmp_phy_dp_cfg { + const struct qmp_usbc_dp_offsets *offsets; + + /* DP PHY swing and pre_emphasis tables */ + const u8 (*swing_tbl)[4][4]; + const u8 (*pre_emphasis_tbl)[4][4]; + + // /* DP PHY callbacks */ + int (*dp_aux_init)(struct qmp_usbc *qmp); + int (*configure_dp_serdes)(struct qmp_usbc *qmp); + int (*configure_dp_voltages)(struct qmp_usbc *qmp); + int (*configure_dp_phy)(struct qmp_usbc *qmp); + int (*calibrate_dp_phy)(struct qmp_usbc *qmp); + + const struct qmp_regulator_data *vreg_list; + int num_vregs; +}; + +struct qmp_phy_dp_layout { + void __iomem *dp_phy; + void __iomem *dp_tx; + void __iomem *dp_tx2; + void __iomem *dp_serdes; + struct regmap *tcsr_map; + u32 dp_phy_mode; + unsigned int dp_aux_cfg; + struct phy_configure_opts_dp dp_opts; + struct clk_hw dp_link_hw; + struct clk_hw dp_pixel_hw; +}; + +struct qmp_usbc { + struct device *dev; + int type; struct clk_bulk_data *clks; int num_clks; int num_resets; struct reset_control_bulk_data *resets; struct regulator_bulk_data *vregs; - struct mutex phy_mutex; - - enum phy_mode mode; - unsigned int usb_init_count; - struct phy *phy; - - struct clk_fixed_rate pipe_clk_fixed; - - struct typec_switch_dev *sw; enum typec_orientation orientation; + unsigned int init_count; + const void *cfg; + void *layout; }; static inline void qphy_setbits(void __iomem *base, u32 offset, u32 val) @@ -391,12 +452,21 @@ static const char * const usb3phy_reset_l[] = { "phy_phy", "phy", }; +static const char * const dp_usb3phy_reset_l[] = { + "phy", +}; + /* list of regulators */ -static const char * const qmp_phy_vreg_l[] = { +static const char * const qmp_phy_usb_vreg_l[] = { "vdda-phy", "vdda-pll", }; -static const struct qmp_usbc_offsets qmp_usbc_offsets_v3_qcm2290 = { +static struct qmp_regulator_data qmp_phy_dp_vreg_l[] = { + { .name = "vdda-phy", .enable_load = 21800 }, + { .name = "vdda-pll", .enable_load = 36000 }, +}; + +static const struct qmp_usbc_usb_offsets qmp_usbc_usb_offsets_v3_qcm2290 = { .serdes = 0x0, .pcs = 0xc00, .pcs_misc = 0xa00, @@ -406,8 +476,15 @@ static const struct qmp_usbc_offsets qmp_usbc_offsets_v3_qcm2290 = { .rx2 = 0x800, }; -static const struct qmp_phy_cfg msm8998_usb3phy_cfg = { - .offsets = &qmp_usbc_offsets_v3_qcm2290, +static const struct qmp_usbc_dp_offsets qmp_usbc_dp_offsets_qcs615 = { + .dp_serdes = 0x0C00, + .dp_txa = 0x0400, + .dp_txb = 0x0800, + .dp_phy = 0x0000, +}; + +static const struct qmp_phy_usb_cfg msm8998_usb3phy_cfg = { + .offsets = &qmp_usbc_usb_offsets_v3_qcm2290, .serdes_tbl = msm8998_usb3_serdes_tbl, .serdes_tbl_num = ARRAY_SIZE(msm8998_usb3_serdes_tbl), @@ -417,13 +494,13 @@ static const struct qmp_phy_cfg msm8998_usb3phy_cfg = { .rx_tbl_num = ARRAY_SIZE(msm8998_usb3_rx_tbl), .pcs_tbl = msm8998_usb3_pcs_tbl, .pcs_tbl_num = ARRAY_SIZE(msm8998_usb3_pcs_tbl), - .vreg_list = qmp_phy_vreg_l, - .num_vregs = ARRAY_SIZE(qmp_phy_vreg_l), + .vreg_list = qmp_phy_usb_vreg_l, + .num_vregs = ARRAY_SIZE(qmp_phy_usb_vreg_l), .regs = qmp_v3_usb3phy_regs_layout, }; -static const struct qmp_phy_cfg qcm2290_usb3phy_cfg = { - .offsets = &qmp_usbc_offsets_v3_qcm2290, +static const struct qmp_phy_usb_cfg qcm2290_usb3phy_cfg = { + .offsets = &qmp_usbc_usb_offsets_v3_qcm2290, .serdes_tbl = qcm2290_usb3_serdes_tbl, .serdes_tbl_num = ARRAY_SIZE(qcm2290_usb3_serdes_tbl), @@ -433,13 +510,13 @@ static const struct qmp_phy_cfg qcm2290_usb3phy_cfg = { .rx_tbl_num = ARRAY_SIZE(qcm2290_usb3_rx_tbl), .pcs_tbl = qcm2290_usb3_pcs_tbl, .pcs_tbl_num = ARRAY_SIZE(qcm2290_usb3_pcs_tbl), - .vreg_list = qmp_phy_vreg_l, - .num_vregs = ARRAY_SIZE(qmp_phy_vreg_l), + .vreg_list = qmp_phy_usb_vreg_l, + .num_vregs = ARRAY_SIZE(qmp_phy_usb_vreg_l), .regs = qmp_v3_usb3phy_regs_layout_qcm2290, }; -static const struct qmp_phy_cfg sdm660_usb3phy_cfg = { - .offsets = &qmp_usbc_offsets_v3_qcm2290, +static const struct qmp_phy_usb_cfg sdm660_usb3phy_cfg = { + .offsets = &qmp_usbc_usb_offsets_v3_qcm2290, .serdes_tbl = qcm2290_usb3_serdes_tbl, .serdes_tbl_num = ARRAY_SIZE(qcm2290_usb3_serdes_tbl), @@ -449,20 +526,352 @@ static const struct qmp_phy_cfg sdm660_usb3phy_cfg = { .rx_tbl_num = ARRAY_SIZE(sdm660_usb3_rx_tbl), .pcs_tbl = qcm2290_usb3_pcs_tbl, .pcs_tbl_num = ARRAY_SIZE(qcm2290_usb3_pcs_tbl), - .vreg_list = qmp_phy_vreg_l, - .num_vregs = ARRAY_SIZE(qmp_phy_vreg_l), + .vreg_list = qmp_phy_usb_vreg_l, + .num_vregs = ARRAY_SIZE(qmp_phy_usb_vreg_l), .regs = qmp_v3_usb3phy_regs_layout_qcm2290, }; -static int qmp_usbc_init(struct phy *phy) +static const u8 qmp_dp_pre_emphasis_hbr2_rbr[4][4] = { + {0x00, 0x0B, 0x12, 0xFF}, /* pe0, 0 db */ + {0x00, 0x0A, 0x12, 0xFF}, /* pe1, 3.5 db */ + {0x00, 0x0C, 0xFF, 0xFF}, /* pe2, 6.0 db */ + {0xFF, 0xFF, 0xFF, 0xFF} /* pe3, 9.5 db */ +}; + +static const u8 qmp_dp_voltage_swing_hbr2_rbr[4][4] = { + {0x07, 0x0F, 0x14, 0xFF}, /* sw0, 0.4v */ + {0x11, 0x1D, 0x1F, 0xFF}, /* sw1, 0.6 v */ + {0x18, 0x1F, 0xFF, 0xFF}, /* sw1, 0.8 v */ + {0xFF, 0xFF, 0xFF, 0xFF} /* sw1, 1.2 v, optional */ +}; + +static int qcs615_qmp_dp_aux_init(struct qmp_usbc *qmp); +static int qcs615_qmp_configure_dp_serdes(struct qmp_usbc *qmp); +static int qcs615_qmp_configure_dp_voltages(struct qmp_usbc *qmp); +static int qcs615_qmp_configure_dp_phy(struct qmp_usbc *qmp); +static int qcs615_qmp_calibrate_dp_phy(struct qmp_usbc *qmp); + +static void qmp_usbc_check_dp_phy(struct qmp_usbc *qmp, const char *pos); + +static const struct qmp_phy_dp_cfg qcs615_dpphy_cfg = { + .offsets = &qmp_usbc_dp_offsets_qcs615, + + .swing_tbl = &qmp_dp_voltage_swing_hbr2_rbr, + .pre_emphasis_tbl = &qmp_dp_pre_emphasis_hbr2_rbr, + + .dp_aux_init = qcs615_qmp_dp_aux_init, + .configure_dp_serdes = qcs615_qmp_configure_dp_serdes, + .configure_dp_voltages = qcs615_qmp_configure_dp_voltages, + .configure_dp_phy = qcs615_qmp_configure_dp_phy, + .calibrate_dp_phy = qcs615_qmp_calibrate_dp_phy, + + .vreg_list = qmp_phy_dp_vreg_l, + .num_vregs = ARRAY_SIZE(qmp_phy_dp_vreg_l), +}; + +#define to_usb_cfg(x) ((struct qmp_phy_usb_cfg *)(x->cfg)) +#define to_dp_cfg(x) ((struct qmp_phy_dp_cfg *)(x->cfg)) +#define to_usb_layout(x) ((struct qmp_phy_usb_layout *)(x->layout)) +#define to_dp_layout(x) ((struct qmp_phy_dp_layout *)(x->layout)) + +static int qcs615_qmp_dp_aux_init(struct qmp_usbc *qmp) +{ + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); + + regmap_write(layout->tcsr_map, layout->dp_phy_mode, 0x1); + + writel(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, + layout->dp_phy + QSERDES_DP_PHY_PD_CTL); + + 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, + layout->dp_phy + QSERDES_DP_PHY_PD_CTL); + + writel(0x00, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG0); + writel(0x13, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG1); + writel(0x00, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG2); + writel(0x00, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG3); + writel(0x0a, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG4); + writel(0x26, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG5); + writel(0x0a, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG6); + writel(0x03, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG7); + writel(0xbb, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG8); + writel(0x03, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG9); + layout->dp_aux_cfg = 0; + + 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, + layout->dp_phy + QSERDES_V3_DP_PHY_AUX_INTERRUPT_MASK); + return 0; +} + +static int qcs615_qmp_configure_dp_serdes(struct qmp_usbc *qmp) +{ + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); + void __iomem *serdes = layout->dp_serdes; + const struct phy_configure_opts_dp *dp_opts = &layout->dp_opts; + u8 hsclk_sel; + u8 dec_start_mode0; + u8 div_frac_start1_mode0; + u8 div_frac_start2_mode0; + u8 div_frac_start3_mode0; + u8 lock_cmp1_mode0; + u8 lock_cmp2_mode0; + u8 lock_cmp3_mode0; + + switch (dp_opts->link_rate) { + case 1620: + hsclk_sel = 0x2c; + dec_start_mode0 = 0x69; + div_frac_start1_mode0 = 0x00; + div_frac_start2_mode0 = 0x80; + div_frac_start3_mode0 = 0x07; + lock_cmp1_mode0 = 0xbf; + lock_cmp2_mode0 = 0x21; + lock_cmp3_mode0 = 0x00; + break; + case 2700: + hsclk_sel = 0x24; + dec_start_mode0 = 0x69; + div_frac_start1_mode0 = 0x00; + div_frac_start2_mode0 = 0x80; + div_frac_start3_mode0 = 0x07; + lock_cmp1_mode0 = 0x3f; + lock_cmp2_mode0 = 0x38; + lock_cmp3_mode0 = 0x00; + break; + case 5400: + hsclk_sel = 0x20; + dec_start_mode0 = 0x8c; + div_frac_start1_mode0 = 0x00; + div_frac_start2_mode0 = 0x00; + div_frac_start3_mode0 = 0x0a; + lock_cmp1_mode0 = 0x7f; + lock_cmp2_mode0 = 0x70; + lock_cmp3_mode0 = 0x00; + break; + default: + /* Other link rates aren't supported */ + return -EINVAL; + } + + writel(0x01, serdes + QSERDES_COM_SVS_MODE_CLK_SEL); + writel(0x37, serdes + QSERDES_COM_SYSCLK_EN_SEL); + writel(0x00, serdes + QSERDES_COM_CLK_SELECT); + writel(0x06, serdes + QSERDES_COM_SYS_CLK_CTRL); + writel(0x3f, serdes + QSERDES_COM_BIAS_EN_CLKBUFLR_EN); + writel(0x0e, serdes + QSERDES_COM_CLK_ENABLE1); + writel(0x0f, serdes + QSERDES_COM_BG_CTRL); + writel(0x06, serdes + QSERDES_COM_SYSCLK_BUF_ENABLE); + writel(0x30, serdes + QSERDES_COM_CLK_SELECT); + writel(0x0f, serdes + QSERDES_COM_PLL_IVCO); + writel(0x28, serdes + QSERDES_COM_PLL_CCTRL_MODE0); + writel(0x16, serdes + QSERDES_COM_PLL_RCTRL_MODE0); + writel(0x0b, serdes + QSERDES_COM_CP_CTRL_MODE0); + + writel(hsclk_sel, serdes + QSERDES_COM_HSCLK_SEL); + writel(dec_start_mode0, serdes + QSERDES_COM_DEC_START_MODE0); + writel(div_frac_start1_mode0, serdes + QSERDES_COM_DIV_FRAC_START1_MODE0); + writel(div_frac_start2_mode0, serdes + QSERDES_COM_DIV_FRAC_START2_MODE0); + writel(div_frac_start3_mode0, serdes + QSERDES_COM_DIV_FRAC_START3_MODE0); + writel(lock_cmp1_mode0, serdes + QSERDES_COM_LOCK_CMP1_MODE0); + writel(lock_cmp2_mode0, serdes + QSERDES_COM_LOCK_CMP2_MODE0); + writel(lock_cmp3_mode0, serdes + QSERDES_COM_LOCK_CMP3_MODE0); + + writel(0x40, serdes + QSERDES_COM_INTEGLOOP_GAIN0_MODE0); + writel(0x00, serdes + QSERDES_COM_INTEGLOOP_GAIN1_MODE0); + writel(0x00, serdes + QSERDES_COM_VCO_TUNE_MAP); + writel(0x08, serdes + QSERDES_COM_BG_TIMER); + writel(0x05, serdes + QSERDES_COM_CORECLK_DIV); + writel(0x00, serdes + QSERDES_COM_VCO_TUNE_CTRL); + writel(0x00, serdes + QSERDES_COM_VCO_TUNE1_MODE0); + writel(0x00, serdes + QSERDES_COM_VCO_TUNE2_MODE0); + writel(0x00, serdes + QSERDES_COM_VCO_TUNE_CTRL); + + writel(0x0f, serdes + QSERDES_COM_CORE_CLK_EN); + + return 0; +} + +static int qcs615_qmp_configure_dp_voltages(struct qmp_usbc *qmp) +{ + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); + struct qmp_phy_dp_cfg *cfg = to_dp_cfg(qmp); + const struct phy_configure_opts_dp *dp_opts = &layout->dp_opts; + void __iomem *tx = layout->dp_tx; + void __iomem *tx2 = layout->dp_tx2; + unsigned int v_level = 0, p_level = 0; + u8 voltage_swing_cfg, pre_emphasis_cfg; + int i; + + if (dp_opts->lanes > 4) { + dev_err(qmp->dev, "Invalid lane_num(%d)\n", dp_opts->lanes); + return -EINVAL; + } + + 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 ((v_level > 4) || (pre_emphasis_cfg > 4)) { + dev_err(qmp->dev, "Invalid v(%d) | p(%d) level)\n", + v_level, pre_emphasis_cfg); + return -EINVAL; + } + + voltage_swing_cfg = (*cfg->swing_tbl)[v_level][p_level]; + pre_emphasis_cfg = (*cfg->pre_emphasis_tbl)[v_level][p_level]; + + /* Enable MUX to use Cursor values from these registers */ + voltage_swing_cfg |= DP_PHY_TXn_TX_DRV_LVL_MUX_EN; + pre_emphasis_cfg |= DP_PHY_TXn_TX_EMP_POST1_LVL_MUX_EN; + + if (voltage_swing_cfg == 0xFF && pre_emphasis_cfg == 0xFF) + return -EINVAL; + + /* program default setting first */ + writel(0x2A, tx + QSERDES_V3_TX_TX_DRV_LVL); + writel(0x20, tx + QSERDES_V3_TX_TX_EMP_POST1_LVL); + writel(0x2A, tx2 + QSERDES_V3_TX_TX_DRV_LVL); + writel(0x20, tx2 + QSERDES_V3_TX_TX_EMP_POST1_LVL); + + writel(voltage_swing_cfg, tx + QSERDES_V3_TX_TX_DRV_LVL); + writel(pre_emphasis_cfg, tx + QSERDES_V3_TX_TX_EMP_POST1_LVL); + writel(voltage_swing_cfg, tx2 + QSERDES_V3_TX_TX_DRV_LVL); + writel(pre_emphasis_cfg, tx2 + QSERDES_V3_TX_TX_EMP_POST1_LVL); + + return 0; +} + +static int qcs615_qmp_configure_dp_phy(struct qmp_usbc *qmp) +{ + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); + u32 status; + + writel(0x01, layout->dp_phy + QSERDES_DP_PHY_CFG); + writel(0x05, layout->dp_phy + QSERDES_DP_PHY_CFG); + writel(0x01, layout->dp_phy + QSERDES_DP_PHY_CFG); + writel(0x09, layout->dp_phy + QSERDES_DP_PHY_CFG); + + writel(0x20, layout->dp_serdes + QSERDES_COM_RESETSM_CNTRL); + + // C_READY + if (readl_poll_timeout(layout->dp_serdes + QSERDES_COM_C_READY_STATUS, + status, + ((status & BIT(0)) > 0), + 500, + 10000)) { + dev_err(qmp->dev, "C_READY not ready\n"); + return -ETIMEDOUT; + } + + // FREQ_DONE + if (readl_poll_timeout(layout->dp_serdes + QSERDES_COM_CMN_STATUS, + status, + ((status & BIT(0)) > 0), + 500, + 10000)){ + dev_err(qmp->dev, "FREQ_DONE not ready\n"); + return -ETIMEDOUT; + } + + // PLL_LOCKED + if (readl_poll_timeout(layout->dp_serdes + QSERDES_COM_CMN_STATUS, + status, + ((status & BIT(1)) > 0), + 500, + 10000)){ + dev_err(qmp->dev, "PLL_LOCKED not ready\n"); + return -ETIMEDOUT; + } + + writel(0x19, layout->dp_phy + QSERDES_DP_PHY_CFG); + udelay(10); + + // TSYNC_DONE + if (readl_poll_timeout(layout->dp_phy + QSERDES_V3_DP_PHY_STATUS, + status, + ((status & BIT(0)) > 0), + 500, + 10000)){ + dev_err(qmp->dev, "TSYNC_DONE not ready\n"); + return -ETIMEDOUT; + } + + // PHY_READY + if (readl_poll_timeout(layout->dp_phy + QSERDES_V3_DP_PHY_STATUS, + status, + ((status & BIT(1)) > 0), + 500, + 10000)){ + dev_err(qmp->dev, "PHY_READY not ready\n"); + return -ETIMEDOUT; + } + + writel(0x3f, layout->dp_tx + QSERDES_V3_TX_TRANSCEIVER_BIAS_EN); + writel(0x10, layout->dp_tx + QSERDES_V3_TX_HIGHZ_DRVR_EN); + writel(0x0a, layout->dp_tx + QSERDES_V3_TX_TX_POL_INV); + writel(0x3f, layout->dp_tx2 + QSERDES_V3_TX_TRANSCEIVER_BIAS_EN); + writel(0x10, layout->dp_tx2 + QSERDES_V3_TX_HIGHZ_DRVR_EN); + writel(0x0a, layout->dp_tx2 + QSERDES_V3_TX_TX_POL_INV); + + writel(0x18, layout->dp_phy + QSERDES_DP_PHY_CFG); + writel(0x19, layout->dp_phy + QSERDES_DP_PHY_CFG); + + if (readl_poll_timeout(layout->dp_phy + QSERDES_V3_DP_PHY_STATUS, + status, + ((status & BIT(1)) > 0), + 500, + 10000)){ + dev_err(qmp->dev, "PHY_READY not ready\n"); + return -ETIMEDOUT; + } + + return 0; +} + +static int qcs615_qmp_calibrate_dp_phy(struct qmp_usbc *qmp) +{ + static const u8 cfg1_settings[] = {0x13, 0x23, 0x1d}; + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); + u8 val; + + layout->dp_aux_cfg++; + layout->dp_aux_cfg %= ARRAY_SIZE(cfg1_settings); + val = cfg1_settings[layout->dp_aux_cfg]; + + writel(val, layout->dp_phy + QSERDES_DP_PHY_AUX_CFG1); + + qmp_usbc_check_dp_phy(qmp, "pos_calibrate"); + + return 0; +} + +static int qmp_usbc_com_init(struct phy *phy) { struct qmp_usbc *qmp = phy_get_drvdata(phy); - const struct qmp_phy_cfg *cfg = qmp->cfg; - void __iomem *pcs = qmp->pcs; + int num_vregs; u32 val = 0; int ret; + unsigned int reg_pwr_dn; - ret = regulator_bulk_enable(cfg->num_vregs, qmp->vregs); + if (qmp->type == QMP_PHY_USBC_USB) { + struct qmp_phy_usb_cfg *cfg = to_usb_cfg(qmp); + + num_vregs = cfg->num_vregs; + reg_pwr_dn = cfg->regs[QPHY_PCS_POWER_DOWN_CONTROL]; + } else { + struct qmp_phy_dp_cfg *cfg = to_dp_cfg(qmp); + + num_vregs = cfg->num_vregs; + } + + ret = regulator_bulk_enable(num_vregs, qmp->vregs); if (ret) { dev_err(qmp->dev, "failed to enable regulators, err=%d\n", ret); return ret; @@ -484,73 +893,85 @@ static int qmp_usbc_init(struct phy *phy) if (ret) goto err_assert_reset; - qphy_setbits(pcs, cfg->regs[QPHY_PCS_POWER_DOWN_CONTROL], SW_PWRDN); - -#define SW_PORTSELECT_VAL BIT(0) -#define SW_PORTSELECT_MUX BIT(1) /* Use software based port select and switch on typec orientation */ val = SW_PORTSELECT_MUX; if (qmp->orientation == TYPEC_ORIENTATION_REVERSE) val |= SW_PORTSELECT_VAL; - writel(val, qmp->pcs_misc); + + if (qmp->type == QMP_PHY_USBC_USB) { + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); + + qphy_setbits(layout->pcs, reg_pwr_dn, SW_PWRDN); + writel(val, layout->pcs_misc); + } return 0; err_assert_reset: reset_control_bulk_assert(qmp->num_resets, qmp->resets); err_disable_regulators: - regulator_bulk_disable(cfg->num_vregs, qmp->vregs); + regulator_bulk_disable(num_vregs, qmp->vregs); return ret; } -static int qmp_usbc_exit(struct phy *phy) +static int qmp_usbc_com_exit(struct phy *phy) { struct qmp_usbc *qmp = phy_get_drvdata(phy); - const struct qmp_phy_cfg *cfg = qmp->cfg; + int num_vregs; reset_control_bulk_assert(qmp->num_resets, qmp->resets); clk_bulk_disable_unprepare(qmp->num_clks, qmp->clks); - regulator_bulk_disable(cfg->num_vregs, qmp->vregs); + if (qmp->type == QMP_PHY_USBC_USB) { + struct qmp_phy_usb_cfg *cfg = to_usb_cfg(qmp); + + num_vregs = cfg->num_vregs; + } else { + struct qmp_phy_dp_cfg *cfg = to_dp_cfg(qmp); + + num_vregs = cfg->num_vregs; + } + regulator_bulk_disable(num_vregs, qmp->vregs); return 0; } -static int qmp_usbc_power_on(struct phy *phy) +static int qmp_usbc_usb_power_on(struct phy *phy) { struct qmp_usbc *qmp = phy_get_drvdata(phy); - const struct qmp_phy_cfg *cfg = qmp->cfg; + const struct qmp_phy_usb_cfg *cfg = to_usb_cfg(qmp); + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); void __iomem *status; unsigned int val; int ret; - qmp_configure(qmp->dev, qmp->serdes, cfg->serdes_tbl, + qmp_configure(qmp->dev, layout->serdes, cfg->serdes_tbl, cfg->serdes_tbl_num); - ret = clk_prepare_enable(qmp->pipe_clk); + ret = clk_prepare_enable(layout->pipe_clk); if (ret) { dev_err(qmp->dev, "pipe_clk enable failed err=%d\n", ret); return ret; } /* Tx, Rx, and PCS configurations */ - qmp_configure_lane(qmp->dev, qmp->tx, cfg->tx_tbl, cfg->tx_tbl_num, 1); - qmp_configure_lane(qmp->dev, qmp->rx, cfg->rx_tbl, cfg->rx_tbl_num, 1); + qmp_configure_lane(qmp->dev, layout->tx, cfg->tx_tbl, cfg->tx_tbl_num, 1); + qmp_configure_lane(qmp->dev, layout->rx, cfg->rx_tbl, cfg->rx_tbl_num, 1); - qmp_configure_lane(qmp->dev, qmp->tx2, cfg->tx_tbl, cfg->tx_tbl_num, 2); - qmp_configure_lane(qmp->dev, qmp->rx2, cfg->rx_tbl, cfg->rx_tbl_num, 2); + qmp_configure_lane(qmp->dev, layout->tx2, cfg->tx_tbl, cfg->tx_tbl_num, 2); + qmp_configure_lane(qmp->dev, layout->rx2, cfg->rx_tbl, cfg->rx_tbl_num, 2); - qmp_configure(qmp->dev, qmp->pcs, cfg->pcs_tbl, cfg->pcs_tbl_num); + qmp_configure(qmp->dev, layout->pcs, cfg->pcs_tbl, cfg->pcs_tbl_num); /* Pull PHY out of reset state */ - qphy_clrbits(qmp->pcs, cfg->regs[QPHY_SW_RESET], SW_RESET); + qphy_clrbits(layout->pcs, cfg->regs[QPHY_SW_RESET], SW_RESET); /* start SerDes and Phy-Coding-Sublayer */ - qphy_setbits(qmp->pcs, cfg->regs[QPHY_START_CTRL], SERDES_START | PCS_START); + qphy_setbits(layout->pcs, cfg->regs[QPHY_START_CTRL], SERDES_START | PCS_START); - status = qmp->pcs + cfg->regs[QPHY_PCS_STATUS]; + status = layout->pcs + cfg->regs[QPHY_PCS_STATUS]; ret = readl_poll_timeout(status, val, !(val & PHYSTATUS), 200, PHY_INIT_COMPLETE_TIMEOUT); if (ret) { @@ -561,92 +982,348 @@ static int qmp_usbc_power_on(struct phy *phy) return 0; err_disable_pipe_clk: - clk_disable_unprepare(qmp->pipe_clk); + clk_disable_unprepare(layout->pipe_clk); return ret; } -static int qmp_usbc_power_off(struct phy *phy) +static int qmp_usbc_usb_power_off(struct phy *phy) { struct qmp_usbc *qmp = phy_get_drvdata(phy); - const struct qmp_phy_cfg *cfg = qmp->cfg; + const struct qmp_phy_usb_cfg *cfg = to_usb_cfg(qmp); + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); - clk_disable_unprepare(qmp->pipe_clk); + clk_disable_unprepare(layout->pipe_clk); /* PHY reset */ - qphy_setbits(qmp->pcs, cfg->regs[QPHY_SW_RESET], SW_RESET); + qphy_setbits(layout->pcs, cfg->regs[QPHY_SW_RESET], SW_RESET); /* stop SerDes and Phy-Coding-Sublayer */ - qphy_clrbits(qmp->pcs, cfg->regs[QPHY_START_CTRL], + qphy_clrbits(layout->pcs, cfg->regs[QPHY_START_CTRL], SERDES_START | PCS_START); /* Put PHY into POWER DOWN state: active low */ - qphy_clrbits(qmp->pcs, cfg->regs[QPHY_PCS_POWER_DOWN_CONTROL], + qphy_clrbits(layout->pcs, cfg->regs[QPHY_PCS_POWER_DOWN_CONTROL], SW_PWRDN); return 0; } -static int qmp_usbc_enable(struct phy *phy) +static int qmp_usbc_usb_enable(struct phy *phy) { struct qmp_usbc *qmp = phy_get_drvdata(phy); int ret; mutex_lock(&qmp->phy_mutex); - ret = qmp_usbc_init(phy); + ret = qmp_usbc_com_init(phy); if (ret) goto out_unlock; - ret = qmp_usbc_power_on(phy); + ret = qmp_usbc_usb_power_on(phy); if (ret) { - qmp_usbc_exit(phy); + qmp_usbc_com_exit(phy); goto out_unlock; } - qmp->usb_init_count++; + qmp->init_count++; out_unlock: mutex_unlock(&qmp->phy_mutex); return ret; } -static int qmp_usbc_disable(struct phy *phy) +static int qmp_usbc_usb_disable(struct phy *phy) { struct qmp_usbc *qmp = phy_get_drvdata(phy); int ret; - qmp->usb_init_count--; - ret = qmp_usbc_power_off(phy); + qmp->init_count--; + ret = qmp_usbc_usb_power_off(phy); if (ret) return ret; - return qmp_usbc_exit(phy); + return qmp_usbc_com_exit(phy); +} + +static int qmp_usbc_usb_set_mode(struct phy *phy, enum phy_mode mode, int submode) +{ + struct qmp_usbc *qmp = phy_get_drvdata(phy); + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); + + layout->mode = mode; + + return 0; +} + +static int qmp_usbc_dp_init(struct phy *phy) +{ + struct qmp_usbc *qmp = phy_get_drvdata(phy); + const struct qmp_phy_dp_cfg *cfg = to_dp_cfg(qmp); + int ret; + + if (qmp->init_count) { + dev_err(qmp->dev, "type(%d) inited(%d)\n", qmp->type, qmp->init_count); + return 0; + } + + mutex_lock(&qmp->phy_mutex); + + ret = qmp_usbc_com_init(phy); + if (ret) { + dev_err(qmp->dev, "type(%d) com_init fail\n", qmp->type); + goto dp_init_unlock; + } + + cfg->dp_aux_init(qmp); + + qmp->init_count++; + +dp_init_unlock: + mutex_unlock(&qmp->phy_mutex); + return ret; +} + +static int qmp_usbc_dp_exit(struct phy *phy) +{ + struct qmp_usbc *qmp = phy_get_drvdata(phy); + + mutex_lock(&qmp->phy_mutex); + + qmp_usbc_com_exit(phy); + + qmp->init_count--; + + mutex_unlock(&qmp->phy_mutex); + + return 0; +} + +static int qmp_usbc_dp_configure(struct phy *phy, union phy_configure_opts *opts) +{ + const struct phy_configure_opts_dp *dp_opts = &opts->dp; + struct qmp_usbc *qmp = phy_get_drvdata(phy); + struct qmp_phy_dp_cfg *cfg = to_dp_cfg(qmp); + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); + int ret; + + mutex_lock(&qmp->phy_mutex); + + memcpy(&layout->dp_opts, dp_opts, sizeof(*dp_opts)); + if (layout->dp_opts.set_voltages) { + ret = cfg->configure_dp_voltages(qmp); + if (ret) { + dev_err(qmp->dev, "type(%d) err(%d)\n", qmp->type, ret); + mutex_unlock(&qmp->phy_mutex); + return ret; + } + + layout->dp_opts.set_voltages = 0; + } + + mutex_unlock(&qmp->phy_mutex); + + return 0; +} + +static int qmp_usbc_dp_calibrate(struct phy *phy) +{ + struct qmp_usbc *qmp = phy_get_drvdata(phy); + struct qmp_phy_dp_cfg *cfg = to_dp_cfg(qmp); + int ret = 0; + + mutex_lock(&qmp->phy_mutex); + + if (cfg->calibrate_dp_phy) { + ret = cfg->calibrate_dp_phy(qmp); + if (ret) { + dev_err(qmp->dev, "type(%d) err(%d)\n", qmp->type, ret); + mutex_unlock(&qmp->phy_mutex); + return ret; + } + } + + mutex_unlock(&qmp->phy_mutex); + return 0; } -static int qmp_usbc_set_mode(struct phy *phy, enum phy_mode mode, int submode) +static int qmp_usbc_configure_dp_clocks(struct qmp_usbc *qmp) +{ + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); + const struct phy_configure_opts_dp *dp_opts = &layout->dp_opts; + u32 phy_vco_div; + unsigned long pixel_freq; + + switch (dp_opts->link_rate) { + case 1620: + phy_vco_div = 0x1; + pixel_freq = 1620000000UL / 2; + break; + case 2700: + phy_vco_div = 0x1; + pixel_freq = 2700000000UL / 2; + break; + case 5400: + phy_vco_div = 0x2; + pixel_freq = 5400000000UL / 4; + break; + case 8100: + phy_vco_div = 0x0; + pixel_freq = 8100000000UL / 6; + break; + default: + /* Other link rates aren't supported */ + return -EINVAL; + } + writel(phy_vco_div, layout->dp_phy + QSERDES_DP_PHY_VCO_DIV); + + clk_set_rate(layout->dp_link_hw.clk, dp_opts->link_rate * 100000); + clk_set_rate(layout->dp_pixel_hw.clk, pixel_freq); + + return 0; +} + +static void qmp_usbc_check_dp_phy(struct qmp_usbc *qmp, const char *pos) +{ + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); + u8 c_ready, cmn_status, phy_status; + + c_ready = readl(layout->dp_serdes + QSERDES_COM_C_READY_STATUS); + cmn_status = readl(layout->dp_serdes + QSERDES_COM_CMN_STATUS); + phy_status = readl(layout->dp_phy + QSERDES_V3_DP_PHY_STATUS); + + dev_dbg(qmp->dev, "pos(%s) c_ready(0x%x) cmn_status(0x%x) phy_status(0x%x)\n", + pos, c_ready, cmn_status, phy_status); +} + +static int qmp_usbc_dp_power_on(struct phy *phy) +{ + struct qmp_usbc *qmp = phy_get_drvdata(phy); + const struct qmp_phy_dp_cfg *cfg = to_dp_cfg(qmp); + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); + const struct phy_configure_opts_dp *dp_opts = &layout->dp_opts; + bool reverse = (qmp->orientation == TYPEC_ORIENTATION_REVERSE); + void __iomem *tx = layout->dp_tx; + void __iomem *tx2 = layout->dp_tx2; + u8 lane_mode_1; + int ret = 0; + + mutex_lock(&qmp->phy_mutex); + + 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, + layout->dp_phy + QSERDES_DP_PHY_PD_CTL); + + ret = cfg->configure_dp_serdes(qmp); + if (ret) { + dev_err(qmp->dev, "failed to config pll\n"); + goto power_on_unlock; + } + + if (dp_opts->link_rate >= 2700) + lane_mode_1 = 0xc4; + else + lane_mode_1 = 0xc6; + + writel(lane_mode_1, tx + QSERDES_V3_TX_LANE_MODE_1); + writel(lane_mode_1, tx2 + QSERDES_V3_TX_LANE_MODE_1); + + if (reverse) + writel(0xc9, layout->dp_phy + QSERDES_DP_PHY_MODE); + else + writel(0xd9, layout->dp_phy + QSERDES_DP_PHY_MODE); + + writel(0x05, layout->dp_phy + QSERDES_V3_DP_PHY_TX0_TX1_LANE_CTL); + writel(0x05, layout->dp_phy + QSERDES_V3_DP_PHY_TX2_TX3_LANE_CTL); + + writel(0x1a, tx + QSERDES_V3_TX_TRANSCEIVER_BIAS_EN); + writel(0x40, tx + QSERDES_V3_TX_VMODE_CTRL1); + writel(0x30, tx + QSERDES_V3_TX_PRE_STALL_LDO_BOOST_EN); + writel(0x3d, tx + QSERDES_V3_TX_INTERFACE_SELECT); + writel(0x0f, tx + QSERDES_V3_TX_CLKBUF_ENABLE); + writel(0x03, tx + QSERDES_V3_TX_RESET_TSYNC_EN); + writel(0x03, tx + QSERDES_V3_TX_TRAN_DRVR_EMP_EN); + writel(0x00, tx + QSERDES_V3_TX_PARRATE_REC_DETECT_IDLE_EN); + writel(0x00, tx + QSERDES_V3_TX_TX_INTERFACE_MODE); + writel(0x2b, tx + QSERDES_V3_TX_TX_EMP_POST1_LVL); + writel(0x2f, tx + QSERDES_V3_TX_TX_DRV_LVL); + writel(0x04, tx + QSERDES_V3_TX_TX_BAND); + writel(0x12, tx + QSERDES_V3_TX_RES_CODE_LANE_OFFSET_TX); + writel(0x12, tx + QSERDES_V3_TX_RES_CODE_LANE_OFFSET_RX); + + writel(0x1a, tx2 + QSERDES_V3_TX_TRANSCEIVER_BIAS_EN); + writel(0x40, tx2 + QSERDES_V3_TX_VMODE_CTRL1); + writel(0x30, tx2 + QSERDES_V3_TX_PRE_STALL_LDO_BOOST_EN); + writel(0x3d, tx2 + QSERDES_V3_TX_INTERFACE_SELECT); + writel(0x0f, tx2 + QSERDES_V3_TX_CLKBUF_ENABLE); + writel(0x03, tx2 + QSERDES_V3_TX_RESET_TSYNC_EN); + writel(0x03, tx2 + QSERDES_V3_TX_TRAN_DRVR_EMP_EN); + writel(0x00, tx2 + QSERDES_V3_TX_PARRATE_REC_DETECT_IDLE_EN); + writel(0x00, tx2 + QSERDES_V3_TX_TX_INTERFACE_MODE); + writel(0x2b, tx2 + QSERDES_V3_TX_TX_EMP_POST1_LVL); + writel(0x2f, tx2 + QSERDES_V3_TX_TX_DRV_LVL); + writel(0x04, tx2 + QSERDES_V3_TX_TX_BAND); + writel(0x12, tx2 + QSERDES_V3_TX_RES_CODE_LANE_OFFSET_TX); + writel(0x12, tx2 + QSERDES_V3_TX_RES_CODE_LANE_OFFSET_RX); + + writel(0x02, layout->dp_serdes + QSERDES_COM_CMN_CONFIG); + qmp_usbc_configure_dp_clocks(qmp); + + ret = cfg->configure_dp_phy(qmp); + if (ret) { + dev_err(qmp->dev, "failed to config dp phy\n"); + goto power_on_unlock; + } + + qmp_usbc_check_dp_phy(qmp, "usbc_dp_power_on_finish"); + +power_on_unlock: + mutex_unlock(&qmp->phy_mutex); + + return ret; +} + +static int qmp_usbc_dp_power_off(struct phy *phy) { struct qmp_usbc *qmp = phy_get_drvdata(phy); + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); + + mutex_lock(&qmp->phy_mutex); - qmp->mode = mode; + /* Assert DP PHY power down */ + writel(DP_PHY_PD_CTL_PSR_PWRDN, layout->dp_phy + QSERDES_DP_PHY_PD_CTL); + + mutex_unlock(&qmp->phy_mutex); return 0; } -static const struct phy_ops qmp_usbc_phy_ops = { - .init = qmp_usbc_enable, - .exit = qmp_usbc_disable, - .set_mode = qmp_usbc_set_mode, +static const struct phy_ops qmp_usbc_usb_phy_ops = { + .init = qmp_usbc_usb_enable, + .exit = qmp_usbc_usb_disable, + .set_mode = qmp_usbc_usb_set_mode, + .owner = THIS_MODULE, +}; + +static const struct phy_ops qmp_usbc_dp_phy_ops = { + .init = qmp_usbc_dp_init, + .exit = qmp_usbc_dp_exit, + .configure = qmp_usbc_dp_configure, + .calibrate = qmp_usbc_dp_calibrate, + .power_on = qmp_usbc_dp_power_on, + .power_off = qmp_usbc_dp_power_off, .owner = THIS_MODULE, }; static void qmp_usbc_enable_autonomous_mode(struct qmp_usbc *qmp) { - const struct qmp_phy_cfg *cfg = qmp->cfg; - void __iomem *pcs = qmp->pcs; + const struct qmp_phy_usb_cfg *cfg = to_usb_cfg(qmp); + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); + void __iomem *pcs = layout->pcs; u32 intr_mask; - if (qmp->mode == PHY_MODE_USB_HOST_SS || - qmp->mode == PHY_MODE_USB_DEVICE_SS) + if (layout->mode == PHY_MODE_USB_HOST_SS || + layout->mode == PHY_MODE_USB_DEVICE_SS) intr_mask = ARCVR_DTCT_EN | ALFPS_DTCT_EN; else intr_mask = ARCVR_DTCT_EN | ARCVR_DTCT_EVENT_SEL; @@ -663,18 +1340,19 @@ static void qmp_usbc_enable_autonomous_mode(struct qmp_usbc *qmp) qphy_setbits(pcs, cfg->regs[QPHY_PCS_AUTONOMOUS_MODE_CTRL], intr_mask); /* Enable i/o clamp_n for autonomous mode */ - if (qmp->tcsr_map && qmp->vls_clamp_reg) - regmap_write(qmp->tcsr_map, qmp->vls_clamp_reg, 1); + if (layout->tcsr_map && layout->vls_clamp_reg) + regmap_write(layout->tcsr_map, layout->vls_clamp_reg, 1); } static void qmp_usbc_disable_autonomous_mode(struct qmp_usbc *qmp) { - const struct qmp_phy_cfg *cfg = qmp->cfg; - void __iomem *pcs = qmp->pcs; + const struct qmp_phy_usb_cfg *cfg = to_usb_cfg(qmp); + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); + void __iomem *pcs = layout->pcs; /* Disable i/o clamp_n on resume for normal mode */ - if (qmp->tcsr_map && qmp->vls_clamp_reg) - regmap_write(qmp->tcsr_map, qmp->vls_clamp_reg, 0); + if (layout->tcsr_map && layout->vls_clamp_reg) + regmap_write(layout->tcsr_map, layout->vls_clamp_reg, 0); qphy_clrbits(pcs, cfg->regs[QPHY_PCS_AUTONOMOUS_MODE_CTRL], ARCVR_DTCT_EN | ARCVR_DTCT_EVENT_SEL | ALFPS_DTCT_EN); @@ -688,16 +1366,19 @@ static int __maybe_unused qmp_usbc_runtime_suspend(struct device *dev) { struct qmp_usbc *qmp = dev_get_drvdata(dev); - dev_vdbg(dev, "Suspending QMP phy, mode:%d\n", qmp->mode); - if (!qmp->phy->init_count) { dev_vdbg(dev, "PHY not initialized, bailing out\n"); return 0; } - qmp_usbc_enable_autonomous_mode(qmp); + if (qmp->type == QMP_PHY_USBC_USB) { + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); + + dev_vdbg(dev, "Suspending QMP phy, mode:%d\n", layout->mode); + qmp_usbc_enable_autonomous_mode(qmp); + clk_disable_unprepare(layout->pipe_clk); + } - clk_disable_unprepare(qmp->pipe_clk); clk_bulk_disable_unprepare(qmp->num_clks, qmp->clks); return 0; @@ -708,8 +1389,6 @@ static int __maybe_unused qmp_usbc_runtime_resume(struct device *dev) struct qmp_usbc *qmp = dev_get_drvdata(dev); int ret = 0; - dev_vdbg(dev, "Resuming QMP phy, mode:%d\n", qmp->mode); - if (!qmp->phy->init_count) { dev_vdbg(dev, "PHY not initialized, bailing out\n"); return 0; @@ -719,14 +1398,19 @@ static int __maybe_unused qmp_usbc_runtime_resume(struct device *dev) if (ret) return ret; - ret = clk_prepare_enable(qmp->pipe_clk); - if (ret) { - dev_err(dev, "pipe_clk enable failed, err=%d\n", ret); - clk_bulk_disable_unprepare(qmp->num_clks, qmp->clks); - return ret; - } + if (qmp->type == QMP_PHY_USBC_USB) { + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); - qmp_usbc_disable_autonomous_mode(qmp); + dev_vdbg(dev, "Resuming QMP phy, mode:%d\n", layout->mode); + ret = clk_prepare_enable(layout->pipe_clk); + if (ret) { + dev_err(dev, "pipe_clk enable failed, err=%d\n", ret); + clk_bulk_disable_unprepare(qmp->num_clks, qmp->clks); + return ret; + } + + qmp_usbc_disable_autonomous_mode(qmp); + } return 0; } @@ -738,19 +1422,54 @@ static const struct dev_pm_ops qmp_usbc_pm_ops = { static int qmp_usbc_vreg_init(struct qmp_usbc *qmp) { - const struct qmp_phy_cfg *cfg = qmp->cfg; struct device *dev = qmp->dev; - int num = cfg->num_vregs; - int i; + int ret, i; - qmp->vregs = devm_kcalloc(dev, num, sizeof(*qmp->vregs), GFP_KERNEL); - if (!qmp->vregs) - return -ENOMEM; + if (qmp->type == QMP_PHY_USBC_USB) { + struct qmp_phy_usb_cfg *cfg = to_usb_cfg(qmp); + int num = cfg->num_vregs; - for (i = 0; i < num; i++) - qmp->vregs[i].supply = cfg->vreg_list[i]; + qmp->vregs = devm_kcalloc(dev, num, sizeof(*qmp->vregs), GFP_KERNEL); + if (!qmp->vregs) + return -ENOMEM; + + for (i = 0; i < num; i++) + qmp->vregs[i].supply = cfg->vreg_list[i]; - return devm_regulator_bulk_get(dev, num, qmp->vregs); + ret = devm_regulator_bulk_get(dev, num, qmp->vregs); + if (ret) { + dev_err(dev, "failed at devm_regulator_bulk_get\n"); + return ret; + } + } else { + struct qmp_phy_dp_cfg *cfg = to_dp_cfg(qmp); + int num = cfg->num_vregs; + + qmp->vregs = devm_kcalloc(dev, num, sizeof(*qmp->vregs), GFP_KERNEL); + if (!qmp->vregs) + return -ENOMEM; + + for (i = 0; i < num; i++) + qmp->vregs[i].supply = cfg->vreg_list[i].name; + + ret = devm_regulator_bulk_get(dev, num, qmp->vregs); + if (ret) { + dev_err(dev, "failed at devm_regulator_bulk_get\n"); + return ret; + } + + for (i = 0; i < num; i++) { + ret = regulator_set_load(qmp->vregs[i].consumer, + cfg->vreg_list[i].enable_load); + if (ret) { + dev_err(dev, "failed to set load at %s\n", + qmp->vregs[i].supply); + return ret; + } + } + } + + return 0; } static int qmp_usbc_reset_init(struct qmp_usbc *qmp, @@ -821,7 +1540,9 @@ static void phy_clk_release_provider(void *res) */ static int phy_pipe_clk_register(struct qmp_usbc *qmp, struct device_node *np) { - struct clk_fixed_rate *fixed = &qmp->pipe_clk_fixed; + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); + + struct clk_fixed_rate *fixed = &layout->pipe_clk_fixed; struct clk_init_data init = { }; int ret; @@ -864,12 +1585,12 @@ static int qmp_usbc_typec_switch_set(struct typec_switch_dev *sw, mutex_lock(&qmp->phy_mutex); qmp->orientation = orientation; - if (qmp->usb_init_count) { - qmp_usbc_power_off(qmp->phy); - qmp_usbc_exit(qmp->phy); + if (qmp->init_count) { + qmp_usbc_usb_power_off(qmp->phy); + qmp_usbc_com_exit(qmp->phy); - qmp_usbc_init(qmp->phy); - qmp_usbc_power_on(qmp->phy); + qmp_usbc_com_init(qmp->phy); + qmp_usbc_usb_power_on(qmp->phy); } mutex_unlock(&qmp->phy_mutex); @@ -880,22 +1601,24 @@ static int qmp_usbc_typec_switch_set(struct typec_switch_dev *sw, static void qmp_usbc_typec_unregister(void *data) { struct qmp_usbc *qmp = data; + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); - typec_switch_unregister(qmp->sw); + typec_switch_unregister(layout->sw); } static int qmp_usbc_typec_switch_register(struct qmp_usbc *qmp) { struct typec_switch_desc sw_desc = {}; struct device *dev = qmp->dev; + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); sw_desc.drvdata = qmp; sw_desc.fwnode = dev->fwnode; sw_desc.set = qmp_usbc_typec_switch_set; - qmp->sw = typec_switch_register(dev, &sw_desc); - if (IS_ERR(qmp->sw)) { - dev_err(dev, "Unable to register typec switch: %pe\n", qmp->sw); - return PTR_ERR(qmp->sw); + layout->sw = typec_switch_register(dev, &sw_desc); + if (IS_ERR(layout->sw)) { + dev_err(dev, "Unable to register typec switch: %pe\n", layout->sw); + return PTR_ERR(layout->sw); } return devm_add_action_or_reset(dev, qmp_usbc_typec_unregister, qmp); @@ -907,15 +1630,16 @@ static int qmp_usbc_typec_switch_register(struct qmp_usbc *qmp) } #endif -static int qmp_usbc_parse_dt_legacy(struct qmp_usbc *qmp, struct device_node *np) +static int qmp_usbc_parse_usb_dt_legacy(struct qmp_usbc *qmp, struct device_node *np) { struct platform_device *pdev = to_platform_device(qmp->dev); struct device *dev = qmp->dev; + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); int ret; - qmp->serdes = devm_platform_ioremap_resource(pdev, 0); - if (IS_ERR(qmp->serdes)) - return PTR_ERR(qmp->serdes); + layout->serdes = devm_platform_ioremap_resource(pdev, 0); + if (IS_ERR(layout->serdes)) + return PTR_ERR(layout->serdes); /* * Get memory resources for the PHY: @@ -923,35 +1647,35 @@ static int qmp_usbc_parse_dt_legacy(struct qmp_usbc *qmp, struct device_node *np * For dual lane PHYs: tx2 -> 3, rx2 -> 4, pcs_misc (optional) -> 5 * For single lane PHYs: pcs_misc (optional) -> 3. */ - qmp->tx = devm_of_iomap(dev, np, 0, NULL); - if (IS_ERR(qmp->tx)) - return PTR_ERR(qmp->tx); + layout->tx = devm_of_iomap(dev, np, 0, NULL); + if (IS_ERR(layout->tx)) + return PTR_ERR(layout->tx); - qmp->rx = devm_of_iomap(dev, np, 1, NULL); - if (IS_ERR(qmp->rx)) - return PTR_ERR(qmp->rx); + layout->rx = devm_of_iomap(dev, np, 1, NULL); + if (IS_ERR(layout->rx)) + return PTR_ERR(layout->rx); - qmp->pcs = devm_of_iomap(dev, np, 2, NULL); - if (IS_ERR(qmp->pcs)) - return PTR_ERR(qmp->pcs); + layout->pcs = devm_of_iomap(dev, np, 2, NULL); + if (IS_ERR(layout->pcs)) + return PTR_ERR(layout->pcs); - qmp->tx2 = devm_of_iomap(dev, np, 3, NULL); - if (IS_ERR(qmp->tx2)) - return PTR_ERR(qmp->tx2); + layout->tx2 = devm_of_iomap(dev, np, 3, NULL); + if (IS_ERR(layout->tx2)) + return PTR_ERR(layout->tx2); - qmp->rx2 = devm_of_iomap(dev, np, 4, NULL); - if (IS_ERR(qmp->rx2)) - return PTR_ERR(qmp->rx2); + layout->rx2 = devm_of_iomap(dev, np, 4, NULL); + if (IS_ERR(layout->rx2)) + return PTR_ERR(layout->rx2); - qmp->pcs_misc = devm_of_iomap(dev, np, 5, NULL); - if (IS_ERR(qmp->pcs_misc)) { + layout->pcs_misc = devm_of_iomap(dev, np, 5, NULL); + if (IS_ERR(layout->pcs_misc)) { dev_vdbg(dev, "PHY pcs_misc-reg not used\n"); - qmp->pcs_misc = NULL; + layout->pcs_misc = NULL; } - qmp->pipe_clk = devm_get_clk_from_child(dev, np, NULL); - if (IS_ERR(qmp->pipe_clk)) { - return dev_err_probe(dev, PTR_ERR(qmp->pipe_clk), + layout->pipe_clk = devm_get_clk_from_child(dev, np, NULL); + if (IS_ERR(layout->pipe_clk)) { + return dev_err_probe(dev, PTR_ERR(layout->pipe_clk), "failed to get pipe clock\n"); } @@ -969,11 +1693,12 @@ static int qmp_usbc_parse_dt_legacy(struct qmp_usbc *qmp, struct device_node *np return 0; } -static int qmp_usbc_parse_dt(struct qmp_usbc *qmp) +static int qmp_usbc_parse_usb_dt(struct qmp_usbc *qmp) { struct platform_device *pdev = to_platform_device(qmp->dev); - const struct qmp_phy_cfg *cfg = qmp->cfg; - const struct qmp_usbc_offsets *offs = cfg->offsets; + const struct qmp_phy_usb_cfg *cfg = to_usb_cfg(qmp); + const struct qmp_usbc_usb_offsets *offs = cfg->offsets; + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); struct device *dev = qmp->dev; void __iomem *base; int ret; @@ -985,23 +1710,23 @@ static int qmp_usbc_parse_dt(struct qmp_usbc *qmp) if (IS_ERR(base)) return PTR_ERR(base); - qmp->serdes = base + offs->serdes; - qmp->pcs = base + offs->pcs; + layout->serdes = base + offs->serdes; + layout->pcs = base + offs->pcs; if (offs->pcs_misc) - qmp->pcs_misc = base + offs->pcs_misc; - qmp->tx = base + offs->tx; - qmp->rx = base + offs->rx; + layout->pcs_misc = base + offs->pcs_misc; + layout->tx = base + offs->tx; + layout->rx = base + offs->rx; - qmp->tx2 = base + offs->tx2; - qmp->rx2 = base + offs->rx2; + layout->tx2 = base + offs->tx2; + layout->rx2 = base + offs->rx2; ret = qmp_usbc_clk_init(qmp); if (ret) return ret; - qmp->pipe_clk = devm_clk_get(dev, "pipe"); - if (IS_ERR(qmp->pipe_clk)) { - return dev_err_probe(dev, PTR_ERR(qmp->pipe_clk), + layout->pipe_clk = devm_clk_get(dev, "pipe"); + if (IS_ERR(layout->pipe_clk)) { + return dev_err_probe(dev, PTR_ERR(layout->pipe_clk), "failed to get pipe clock\n"); } @@ -1013,10 +1738,11 @@ static int qmp_usbc_parse_dt(struct qmp_usbc *qmp) return 0; } -static int qmp_usbc_parse_vls_clamp(struct qmp_usbc *qmp) +static int qmp_usbc_parse_usb_vls_clamp(struct qmp_usbc *qmp) { struct of_phandle_args tcsr_args; struct device *dev = qmp->dev; + struct qmp_phy_usb_layout *layout = to_usb_layout(qmp); int ret; /* for backwards compatibility ignore if there is no property */ @@ -1027,22 +1753,280 @@ static int qmp_usbc_parse_vls_clamp(struct qmp_usbc *qmp) else if (ret < 0) return dev_err_probe(dev, ret, "Failed to parse qcom,tcsr-reg\n"); - qmp->tcsr_map = syscon_node_to_regmap(tcsr_args.np); + layout->tcsr_map = syscon_node_to_regmap(tcsr_args.np); of_node_put(tcsr_args.np); - if (IS_ERR(qmp->tcsr_map)) - return PTR_ERR(qmp->tcsr_map); + if (IS_ERR(layout->tcsr_map)) + return PTR_ERR(layout->tcsr_map); - qmp->vls_clamp_reg = tcsr_args.args[0]; + layout->vls_clamp_reg = tcsr_args.args[0]; return 0; } +static int qmp_usbc_parse_dp_phy_mode(struct qmp_usbc *qmp) +{ + struct of_phandle_args tcsr_args; + struct device *dev = qmp->dev; + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); + int ret; + + /* for backwards compatibility ignore if there is no property */ + ret = of_parse_phandle_with_fixed_args(dev->of_node, "qcom,tcsr-reg", 1, 0, + &tcsr_args); + if (ret < 0) + return dev_err_probe(dev, ret, "Failed to parse qcom,tcsr-reg\n"); + + layout->tcsr_map = syscon_node_to_regmap(tcsr_args.np); + of_node_put(tcsr_args.np); + if (IS_ERR(layout->tcsr_map)) + return PTR_ERR(layout->tcsr_map); + + layout->dp_phy_mode = tcsr_args.args[0]; + + return 0; +} + +static int qmp_usbc_parse_dp_dt(struct qmp_usbc *qmp) +{ + struct platform_device *pdev = to_platform_device(qmp->dev); + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); + struct qmp_phy_dp_cfg *cfg = to_dp_cfg(qmp); + const struct qmp_usbc_dp_offsets *offs = cfg->offsets; + struct device *dev = qmp->dev; + void __iomem *base; + int ret; + + base = devm_platform_ioremap_resource(pdev, 0); + if (IS_ERR(base)) { + dev_err(dev, "get resource fail, ret:%d\n", ret); + return PTR_ERR(base); + } + + layout->dp_serdes = base + offs->dp_serdes; + layout->dp_tx = base + offs->dp_txa; + layout->dp_tx2 = base + offs->dp_txb; + layout->dp_phy = base + offs->dp_phy; + + ret = qmp_usbc_clk_init(qmp); + if (ret) { + dev_err(dev, "clk init fail, ret:%d\n", ret); + return ret; + } + + ret = qmp_usbc_reset_init(qmp, dp_usb3phy_reset_l, + ARRAY_SIZE(dp_usb3phy_reset_l)); + if (ret) + return ret; + + return 0; +} + +/* + * Display Port PLL driver block diagram for branch clocks + * + * +------------------------------+ + * | DP_VCO_CLK | + * | | + * | +-------------------+ | + * | | (DP PLL/VCO) | | + * | +---------+---------+ | + * | v | + * | +----------+-----------+ | + * | | hsclk_divsel_clk_src | | + * | +----------+-----------+ | + * +------------------------------+ + * | + * +---------<---------v------------>----------+ + * | | + * +--------v----------------+ | + * | dp_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 + * | + * +----------+-----------------+ + * | dp_phy_pll_vco_div_clk | + * +---------+------------------+ + * | + * v + * Input to DISPCC block + * for DP pixel clock + * + */ +static int qmp_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 qmp_dp_pixel_clk_recalc_rate(struct clk_hw *hw, unsigned long parent_rate) +{ + // const struct qmp_usbc *qmp; + struct qmp_phy_dp_layout *layout; + const struct phy_configure_opts_dp *dp_opts; + + layout = container_of(hw, struct qmp_phy_dp_layout, dp_pixel_hw); + + dp_opts = &layout->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 qmp_dp_pixel_clk_ops = { + .determine_rate = qmp_dp_pixel_clk_determine_rate, + .recalc_rate = qmp_dp_pixel_clk_recalc_rate, +}; + +static int qmp_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 qmp_dp_link_clk_recalc_rate(struct clk_hw *hw, unsigned long parent_rate) +{ + // const struct qmp_combo *qmp; + struct qmp_phy_dp_layout *layout; + const struct phy_configure_opts_dp *dp_opts; + + layout = container_of(hw, struct qmp_phy_dp_layout, dp_link_hw); + dp_opts = &layout->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 qmp_dp_link_clk_ops = { + .determine_rate = qmp_dp_link_clk_determine_rate, + .recalc_rate = qmp_dp_link_clk_recalc_rate, +}; + +static int phy_dp_clks_register(struct qmp_usbc *qmp, struct device_node *np) +{ + struct clk_init_data init = { }; + int ret = 0; + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); + + ret = of_property_read_string_index(np, "clock-output-names", 0, &init.name); + if (ret < 0) { + dev_err(qmp->dev, "%pOFn: No link clock-output-names\n", np); + return ret; + } + + init.ops = &qmp_dp_link_clk_ops; + layout->dp_link_hw.init = &init; + ret = devm_clk_hw_register(qmp->dev, &layout->dp_link_hw); + if (ret < 0) { + dev_err(qmp->dev, "link clk reg fail ret=%d\n", ret); + return ret; + } + + ret = of_property_read_string_index(np, "clock-output-names", 1, &init.name); + if (ret) { + dev_err(qmp->dev, "%pOFn: No div clock-output-names\n", np); + return ret; + } + + init.ops = &qmp_dp_pixel_clk_ops; + layout->dp_pixel_hw.init = &init; + ret = devm_clk_hw_register(qmp->dev, &layout->dp_pixel_hw); + if (ret) { + dev_err(qmp->dev, "pxl clk reg fail ret=%d\n", ret); + return ret; + } + + return 0; +} + +static struct clk_hw *qmp_dp_clks_hw_get(struct of_phandle_args *clkspec, void *data) +{ + struct qmp_usbc *qmp = data; + struct qmp_phy_dp_layout *layout = to_dp_layout(qmp); + + switch (clkspec->args[0]) { + case QMP_USB43DP_DP_LINK_CLK: + return &layout->dp_link_hw; + case QMP_USB43DP_DP_VCO_DIV_CLK: + return &layout->dp_pixel_hw; + } + + return ERR_PTR(-EINVAL); +} + +static int qmp_dp_register_clocks(struct qmp_usbc *qmp, struct device_node *dp_np) +{ + int ret; + + ret = phy_dp_clks_register(qmp, dp_np); + if (ret) { + dev_err(qmp->dev, "dp clk reg fail ret:%d\n", ret); + return ret; + } + + ret = of_clk_add_hw_provider(dp_np, qmp_dp_clks_hw_get, qmp); + if (ret) { + dev_err(qmp->dev, "add provider fail ret:%d\n", ret); + return ret; + } + + return devm_add_action_or_reset(qmp->dev, phy_clk_release_provider, dp_np); +} + static int qmp_usbc_probe(struct platform_device *pdev) { struct device *dev = &pdev->dev; struct phy_provider *phy_provider; struct device_node *np; struct qmp_usbc *qmp; + const struct dev_cfg *data_cfg; int ret; qmp = devm_kzalloc(dev, sizeof(*qmp), GFP_KERNEL); @@ -1050,38 +2034,74 @@ static int qmp_usbc_probe(struct platform_device *pdev) return -ENOMEM; qmp->dev = dev; - dev_set_drvdata(dev, qmp); qmp->orientation = TYPEC_ORIENTATION_NORMAL; - qmp->cfg = of_device_get_match_data(dev); - if (!qmp->cfg) + qmp->init_count = 0; + + data_cfg = of_device_get_match_data(dev); + if (!data_cfg) { + dev_err(qmp->dev, "get data fail\n"); return -EINVAL; + } mutex_init(&qmp->phy_mutex); - ret = qmp_usbc_vreg_init(qmp); - if (ret) - return ret; + qmp->type = data_cfg->type; + qmp->cfg = data_cfg->cfg; - ret = qmp_usbc_typec_switch_register(qmp); - if (ret) + ret = qmp_usbc_vreg_init(qmp); + if (ret) { + dev_err(qmp->dev, "qmp_type(%d) vreg init fail\n", qmp->type); return ret; + } - ret = qmp_usbc_parse_vls_clamp(qmp); - if (ret) - return ret; + if (qmp->type == QMP_PHY_USBC_USB) { + qmp->layout = devm_kzalloc(dev, sizeof(struct qmp_phy_usb_layout), GFP_KERNEL); + if (!qmp->layout) + return -ENOMEM; + + ret = qmp_usbc_typec_switch_register(qmp); + if (ret) + return ret; + + ret = qmp_usbc_parse_usb_vls_clamp(qmp); + if (ret) + return ret; + + /* Check for legacy binding with child node. */ + np = of_get_child_by_name(dev->of_node, "phy"); + if (np) { + ret = qmp_usbc_parse_usb_dt_legacy(qmp, np); + } else { + np = of_node_get(dev->of_node); + ret = qmp_usbc_parse_usb_dt(qmp); + } + if (ret) + goto err_node_put; + } else if (qmp->type == QMP_PHY_USBC_DP) { + qmp->layout = devm_kzalloc(dev, sizeof(struct qmp_phy_dp_layout), GFP_KERNEL); + if (!qmp->layout) + return -ENOMEM; - /* Check for legacy binding with child node. */ - np = of_get_child_by_name(dev->of_node, "phy"); - if (np) { - ret = qmp_usbc_parse_dt_legacy(qmp, np); - } else { np = of_node_get(dev->of_node); - ret = qmp_usbc_parse_dt(qmp); - } - if (ret) + ret = qmp_usbc_parse_dp_phy_mode(qmp); + if (ret) + goto err_node_put; + + ret = qmp_usbc_parse_dp_dt(qmp); + if (ret) + goto err_node_put; + + ret = drm_aux_bridge_register(dev); + if (ret) { + dev_err(qmp->dev, "aux bridge reg fail ret=%d\n", ret); + goto err_node_put; + } + } else { + dev_err(dev, "invalid phy type: %d\n", qmp->type); goto err_node_put; + } pm_runtime_set_active(dev); ret = devm_pm_runtime_enable(dev); @@ -1093,19 +2113,33 @@ static int qmp_usbc_probe(struct platform_device *pdev) */ pm_runtime_forbid(dev); - ret = phy_pipe_clk_register(qmp, np); - if (ret) - goto err_node_put; - - qmp->phy = devm_phy_create(dev, np, &qmp_usbc_phy_ops); - if (IS_ERR(qmp->phy)) { - ret = PTR_ERR(qmp->phy); - dev_err(dev, "failed to create PHY: %d\n", ret); - goto err_node_put; + if (qmp->type == QMP_PHY_USBC_USB) { + // pipe clk process + ret = phy_pipe_clk_register(qmp, np); + if (ret) + goto err_node_put; + + qmp->phy = devm_phy_create(dev, np, &qmp_usbc_usb_phy_ops); + if (IS_ERR(qmp->phy)) { + ret = PTR_ERR(qmp->phy); + dev_err(dev, "failed to create PHY: %d\n", ret); + goto err_node_put; + } + } else { + ret = qmp_dp_register_clocks(qmp, np); + if (ret) + goto err_node_put; + + qmp->phy = devm_phy_create(dev, np, &qmp_usbc_dp_phy_ops); + if (IS_ERR(qmp->phy)) { + ret = PTR_ERR(qmp->phy); + dev_err(dev, "failed to create PHY: %d\n", ret); + goto err_node_put; + } } phy_set_drvdata(qmp->phy, qmp); - + dev_set_drvdata(dev, qmp); of_node_put(np); phy_provider = devm_of_phy_provider_register(dev, of_phy_simple_xlate); @@ -1120,19 +2154,38 @@ static int qmp_usbc_probe(struct platform_device *pdev) static const struct of_device_id qmp_usbc_of_match_table[] = { { .compatible = "qcom,msm8998-qmp-usb3-phy", - .data = &msm8998_usb3phy_cfg, + .data = &(struct dev_cfg) { + .type = QMP_PHY_USBC_USB, + .cfg = &msm8998_usb3phy_cfg, + }, }, { .compatible = "qcom,qcm2290-qmp-usb3-phy", - .data = &qcm2290_usb3phy_cfg, + .data = &(struct dev_cfg) { + .type = QMP_PHY_USBC_USB, + .cfg = &qcm2290_usb3phy_cfg, + }, + }, { + .compatible = "qcom,qcs615-qmp-dp-phy", + .data = &(struct dev_cfg) { + .type = QMP_PHY_USBC_DP, + .cfg = &qcs615_dpphy_cfg, + }, }, { .compatible = "qcom,sdm660-qmp-usb3-phy", - .data = &sdm660_usb3phy_cfg, + .data = &(struct dev_cfg) { + .type = QMP_PHY_USBC_USB, + .cfg = &sdm660_usb3phy_cfg, + }, }, { .compatible = "qcom,sm6115-qmp-usb3-phy", - .data = &qcm2290_usb3phy_cfg, + .data = &(struct dev_cfg) { + .type = QMP_PHY_USBC_USB, + .cfg = &qcm2290_usb3phy_cfg, + }, }, { }, }; + MODULE_DEVICE_TABLE(of, qmp_usbc_of_match_table); static struct platform_driver qmp_usbc_driver = {
Extended DP support for QCS615 USB or DP phy. Differentiated between USBC and DP PHY using the match table’s type, dynamically generating different types of cfg and layout attributes during initialization based on this type. Static variables are stored in cfg, while parsed values are organized into the layout structure. Signed-off-by: Xiangxu Yin <quic_xiangxuy@quicinc.com> --- drivers/phy/qualcomm/phy-qcom-qmp-dp-phy.h | 1 + drivers/phy/qualcomm/phy-qcom-qmp-usbc.c | 1453 ++++++++++++++++++++++++---- 2 files changed, 1254 insertions(+), 200 deletions(-)