| Message ID | 20211228052116.1748443-3-bjorn.andersson@linaro.org (mailing list archive) |
|---|---|
| State | Not Applicable |
| Headers | show |
| Series | typec: mux: Introduce support for multiple TypeC muxes | expand |
On 28/12/2021 08:21, Bjorn Andersson wrote: > The QMP PHY handles muxing of USB vs DisplayPort, as well as orientation > switching of the SuperSpeed lanes. So register typec handlers for the > two types. > > The TypeC mux allows switching between four lanes of DisplayPort and a > mixed USB+DP combination. This makes it possible to reach resolutions > that requires 4 lanes. > > The TypeC switch allows switching the SuperSpeed pins and have been > tested with both 2 and 4 lane DisplayPort. > > It's possible that in the USB mode the DP_MODE should be disabled, but > this is left untouched. > > Signed-off-by: Bjorn Andersson <bjorn.andersson@linaro.org> Reviewed-by: Dmitry Baryshkov <dmitry.baryshkov@linaro.org> > --- > > My suggestion is that if/once this patch is deemed acceptable the PHY > maintainers could create a immutable branch/tag which can be merged into the > PHY tree as well as the USB tree. > > drivers/phy/qualcomm/phy-qcom-qmp.c | 176 +++++++++++++++++++++++++--- > 1 file changed, 158 insertions(+), 18 deletions(-) > > diff --git a/drivers/phy/qualcomm/phy-qcom-qmp.c b/drivers/phy/qualcomm/phy-qcom-qmp.c > index 7bea6a60dc54..8d8139df9d8e 100644 > --- a/drivers/phy/qualcomm/phy-qcom-qmp.c > +++ b/drivers/phy/qualcomm/phy-qcom-qmp.c > @@ -19,6 +19,8 @@ > #include <linux/regulator/consumer.h> > #include <linux/reset.h> > #include <linux/slab.h> > +#include <linux/usb/typec_dp.h> > +#include <linux/usb/typec_mux.h> > > #include <dt-bindings/phy/phy.h> > > @@ -3017,6 +3019,9 @@ struct qmp_phy_dp_clks { > * @phy_mutex: mutex lock for PHY common block initialization > * @init_count: phy common block initialization count > * @ufs_reset: optional UFS PHY reset handle > + * @sw: typec switch for receiving orientation changes > + * @mux: typec mux for DP muxing > + * @orientation: carries current CC orientation > */ > struct qcom_qmp { > struct device *dev; > @@ -3032,6 +3037,10 @@ struct qcom_qmp { > int init_count; > > struct reset_control *ufs_reset; > + > + struct typec_switch *sw; > + struct typec_mux *mux; > + enum typec_orientation orientation; > }; > > static void qcom_qmp_v3_phy_dp_aux_init(struct qmp_phy *qphy); > @@ -4378,30 +4387,23 @@ static void qcom_qmp_v3_phy_configure_dp_tx(struct qmp_phy *qphy) > > static bool qcom_qmp_phy_configure_dp_mode(struct qmp_phy *qphy) > { > + const struct phy_configure_opts_dp *dp_opts = &qphy->dp_opts; > + bool reverse = qphy->qmp->orientation == TYPEC_ORIENTATION_REVERSE; > u32 val; > - bool reverse = false; > > val = DP_PHY_PD_CTL_PWRDN | DP_PHY_PD_CTL_AUX_PWRDN | > DP_PHY_PD_CTL_PLL_PWRDN | DP_PHY_PD_CTL_DP_CLAMP_EN; > > - /* > - * TODO: Assume orientation is CC1 for now and two lanes, need to > - * use type-c connector to understand orientation and lanes. > - * > - * Otherwise val changes to be like below if this code understood > - * the orientation of the type-c cable. > - * > - * if (lane_cnt == 4 || orientation == ORIENTATION_CC2) > - * val |= DP_PHY_PD_CTL_LANE_0_1_PWRDN; > - * if (lane_cnt == 4 || orientation == ORIENTATION_CC1) > - * val |= DP_PHY_PD_CTL_LANE_2_3_PWRDN; > - * if (orientation == ORIENTATION_CC2) > - * writel(0x4c, qphy->pcs + QSERDES_V3_DP_PHY_MODE); > - */ > - val |= DP_PHY_PD_CTL_LANE_2_3_PWRDN; > + if (dp_opts->lanes == 4 || reverse) > + val |= DP_PHY_PD_CTL_LANE_0_1_PWRDN; > + if (dp_opts->lanes == 4 || !reverse) > + val |= DP_PHY_PD_CTL_LANE_2_3_PWRDN; > writel(val, qphy->pcs + QSERDES_DP_PHY_PD_CTL); > > - writel(0x5c, qphy->pcs + QSERDES_DP_PHY_MODE); > + if (reverse) > + writel(0x4c, qphy->pcs + QSERDES_DP_PHY_MODE); > + else > + writel(0x5c, qphy->pcs + QSERDES_DP_PHY_MODE); > > return reverse; > } > @@ -5809,6 +5811,123 @@ static const struct dev_pm_ops qcom_qmp_phy_pm_ops = { > qcom_qmp_phy_runtime_resume, NULL) > }; > > +#if IS_ENABLED(CONFIG_TYPEC) > +static int qcom_qmp_phy_typec_switch_set(struct typec_switch *sw, > + enum typec_orientation orientation) > +{ > + struct qcom_qmp *qmp = typec_switch_get_drvdata(sw); > + void __iomem *dp_com = qmp->dp_com; > + > + qmp->orientation = orientation; > + > + if (orientation == TYPEC_ORIENTATION_REVERSE) > + qphy_setbits(dp_com, QPHY_V3_DP_COM_TYPEC_CTRL, 0x01); > + else > + qphy_clrbits(dp_com, QPHY_V3_DP_COM_TYPEC_CTRL, 0x01); > + > + return 0; > +} > + > +static int qcom_qmp_phy_typec_mux_set(struct typec_mux *mux, > + struct typec_mux_state *state) > +{ > + struct qcom_qmp *qmp = typec_mux_get_drvdata(mux); > + void __iomem *dp_com = qmp->dp_com; > + bool dp_mode; > + bool usb_mode; > + > + switch (state->mode) { > + case TYPEC_STATE_SAFE: > + case TYPEC_STATE_USB: > + /* > + * TODO: Figure out if we should clear DP_MODE when we enter a > + * USB-only state. > + */ > + dp_mode = true; > + usb_mode = true; > + break; > + case TYPEC_DP_STATE_A: > + case TYPEC_DP_STATE_C: > + case TYPEC_DP_STATE_E: > + dp_mode = true; > + usb_mode = false; > + break; > + case TYPEC_DP_STATE_B: > + case TYPEC_DP_STATE_D: > + case TYPEC_DP_STATE_F: > + dp_mode = true; > + usb_mode = true; > + break; > + } > + > + qphy_setbits(dp_com, QPHY_V3_DP_COM_RESET_OVRD_CTRL, > + SW_DPPHY_RESET_MUX | SW_USB3PHY_RESET_MUX); > + if (dp_mode) > + qphy_setbits(dp_com, QPHY_V3_DP_COM_PHY_MODE_CTRL, DP_MODE); > + else > + qphy_clrbits(dp_com, QPHY_V3_DP_COM_PHY_MODE_CTRL, DP_MODE); > + > + if (usb_mode) > + qphy_setbits(dp_com, QPHY_V3_DP_COM_PHY_MODE_CTRL, USB3_MODE); > + else > + qphy_clrbits(dp_com, QPHY_V3_DP_COM_PHY_MODE_CTRL, USB3_MODE); > + > + qphy_setbits(dp_com, QPHY_V3_DP_COM_SW_RESET, SW_RESET); > + qphy_clrbits(dp_com, QPHY_V3_DP_COM_SWI_CTRL, 0x03); > + qphy_clrbits(dp_com, QPHY_V3_DP_COM_SW_RESET, SW_RESET); > + > + return 0; > +} > + > +static int qcom_qmp_phy_typec_register(struct qcom_qmp *qmp, > + const struct qmp_phy_cfg *cfg) > +{ > + struct typec_switch_desc sw_desc = {}; > + struct typec_mux_desc mux_desc = {}; > + struct device *dev = qmp->dev; > + > + if (!cfg->has_phy_dp_com_ctrl) > + return 0; > + > + sw_desc.drvdata = qmp; > + sw_desc.fwnode = dev->fwnode; > + sw_desc.set = qcom_qmp_phy_typec_switch_set; > + qmp->sw = typec_switch_register(dev, &sw_desc); > + if (IS_ERR(qmp->sw)) { > + dev_err(dev, "Error registering typec switch: %pe\n", qmp->sw); > + return PTR_ERR(qmp->sw); > + } > + > + mux_desc.drvdata = qmp; > + mux_desc.fwnode = dev->fwnode; > + mux_desc.set = qcom_qmp_phy_typec_mux_set; > + qmp->mux = typec_mux_register(dev, &mux_desc); > + if (IS_ERR(qmp->mux)) { > + dev_err(dev, "Error registering typec mux: %pe\n", qmp->mux); > + typec_switch_unregister(qmp->sw); > + return PTR_ERR(qmp->mux); > + } > + > + return 0; > +} > + > +static void qcom_qmp_phy_typec_unregister(struct qcom_qmp *qmp) > +{ > + typec_mux_unregister(qmp->mux); > + typec_switch_unregister(qmp->sw); > +} > +#else > +static int qcom_qmp_phy_typec_register(struct qcom_qmp *qmp, > + const struct qmp_phy_cfg *cfg) > +{ > + return 0; > +} > + > +static void qcom_qmp_phy_typec_unregister(struct qcom_qmp *qmp) > +{ > +} > +#endif > + > static int qcom_qmp_phy_probe(struct platform_device *pdev) > { > struct qcom_qmp *qmp; > @@ -5891,7 +6010,15 @@ static int qcom_qmp_phy_probe(struct platform_device *pdev) > return ret; > } > > - num = of_get_available_child_count(dev->of_node); > + ret = qcom_qmp_phy_typec_register(qmp, cfg); > + if (ret) > + return ret; > + > + num = 0; > + for_each_available_child_of_node(dev->of_node, child) { > + if (!of_node_name_eq(child, "port")) > + num++; > + } > /* do we have a rogue child node ? */ > if (num > expected_phys) > return -EINVAL; > @@ -5918,6 +6045,9 @@ static int qcom_qmp_phy_probe(struct platform_device *pdev) > serdes = usb_serdes; > } > > + if (of_node_name_eq(child, "port")) > + continue; > + > /* Create per-lane phy */ > ret = qcom_qmp_phy_create(dev, child, id, serdes, cfg); > if (ret) { > @@ -5962,8 +6092,18 @@ static int qcom_qmp_phy_probe(struct platform_device *pdev) > return ret; > } > > +static int qcom_qmp_phy_remove(struct platform_device *pdev) > +{ > + struct qcom_qmp *qmp = platform_get_drvdata(pdev); > + > + qcom_qmp_phy_typec_unregister(qmp); > + > + return 0; > +} > + > static struct platform_driver qcom_qmp_phy_driver = { > .probe = qcom_qmp_phy_probe, > + .remove = qcom_qmp_phy_remove, > .driver = { > .name = "qcom-qmp-phy", > .pm = &qcom_qmp_phy_pm_ops,
Hi Bjorn,
I love your patch! Yet something to improve:
[auto build test ERROR on usb/usb-testing]
[also build test ERROR on robh/for-next driver-core/driver-core-testing linus/master v5.16-rc7 next-20211224]
[If your patch is applied to the wrong git tree, kindly drop us a note.
And when submitting patch, we suggest to use '--base' as documented in
https://git-scm.com/docs/git-format-patch]
url: https://github.com/0day-ci/linux/commits/Bjorn-Andersson/typec-mux-Introduce-support-for-multiple-TypeC-muxes/20211228-132045
base: https://git.kernel.org/pub/scm/linux/kernel/git/gregkh/usb.git usb-testing
config: arc-randconfig-r043-20211228 (https://download.01.org/0day-ci/archive/20211228/202112282120.JleedcIB-lkp@intel.com/config)
compiler: arceb-elf-gcc (GCC) 11.2.0
reproduce (this is a W=1 build):
wget https://raw.githubusercontent.com/intel/lkp-tests/master/sbin/make.cross -O ~/bin/make.cross
chmod +x ~/bin/make.cross
# https://github.com/0day-ci/linux/commit/db0b002b5b2e1055b2df7b430438335a75dc1557
git remote add linux-review https://github.com/0day-ci/linux
git fetch --no-tags linux-review Bjorn-Andersson/typec-mux-Introduce-support-for-multiple-TypeC-muxes/20211228-132045
git checkout db0b002b5b2e1055b2df7b430438335a75dc1557
# save the config file to linux build tree
mkdir build_dir
COMPILER_INSTALL_PATH=$HOME/0day COMPILER=gcc-11.2.0 make.cross O=build_dir ARCH=arc SHELL=/bin/bash
If you fix the issue, kindly add following tag as appropriate
Reported-by: kernel test robot <lkp@intel.com>
All errors (new ones prefixed by >>):
arceb-elf-ld: drivers/phy/qualcomm/phy-qcom-qmp.o: in function `qcom_qmp_phy_remove':
>> phy-qcom-qmp.c:(.text+0x37e): undefined reference to `typec_mux_unregister'
>> arceb-elf-ld: phy-qcom-qmp.c:(.text+0x37e): undefined reference to `typec_mux_unregister'
>> arceb-elf-ld: phy-qcom-qmp.c:(.text+0x384): undefined reference to `typec_switch_unregister'
>> arceb-elf-ld: phy-qcom-qmp.c:(.text+0x384): undefined reference to `typec_switch_unregister'
arceb-elf-ld: drivers/phy/qualcomm/phy-qcom-qmp.o: in function `qcom_qmp_phy_probe':
>> phy-qcom-qmp.c:(.text+0x14bc): undefined reference to `typec_switch_register'
>> arceb-elf-ld: phy-qcom-qmp.c:(.text+0x14bc): undefined reference to `typec_switch_register'
>> arceb-elf-ld: phy-qcom-qmp.c:(.text+0x14e2): undefined reference to `typec_mux_register'
>> arceb-elf-ld: phy-qcom-qmp.c:(.text+0x14e2): undefined reference to `typec_mux_register'
arceb-elf-ld: phy-qcom-qmp.c:(.text+0x14f6): undefined reference to `typec_switch_unregister'
arceb-elf-ld: phy-qcom-qmp.c:(.text+0x14f6): undefined reference to `typec_switch_unregister'
arceb-elf-ld: drivers/phy/qualcomm/phy-qcom-qmp.o: in function `qcom_qmp_phy_typec_switch_set':
>> phy-qcom-qmp.c:(.text+0x18f0): undefined reference to `typec_switch_get_drvdata'
>> arceb-elf-ld: phy-qcom-qmp.c:(.text+0x18f0): undefined reference to `typec_switch_get_drvdata'
arceb-elf-ld: drivers/phy/qualcomm/phy-qcom-qmp.o: in function `qcom_qmp_phy_typec_mux_set':
>> phy-qcom-qmp.c:(.text+0x1962): undefined reference to `typec_mux_get_drvdata'
>> arceb-elf-ld: phy-qcom-qmp.c:(.text+0x1962): undefined reference to `typec_mux_get_drvdata'
---
0-DAY CI Kernel Test Service, Intel Corporation
https://lists.01.org/hyperkitty/list/kbuild-all@lists.01.org
On Tue 28 Dec 05:59 PST 2021, kernel test robot wrote: > Hi Bjorn, > > I love your patch! Yet something to improve: > > [auto build test ERROR on usb/usb-testing] > [also build test ERROR on robh/for-next driver-core/driver-core-testing linus/master v5.16-rc7 next-20211224] > [If your patch is applied to the wrong git tree, kindly drop us a note. > And when submitting patch, we suggest to use '--base' as documented in > https://git-scm.com/docs/git-format-patch] > > url: https://github.com/0day-ci/linux/commits/Bjorn-Andersson/typec-mux-Introduce-support-for-multiple-TypeC-muxes/20211228-132045 > base: https://git.kernel.org/pub/scm/linux/kernel/git/gregkh/usb.git usb-testing > config: arc-randconfig-r043-20211228 (https://download.01.org/0day-ci/archive/20211228/202112282120.JleedcIB-lkp@intel.com/config) > compiler: arceb-elf-gcc (GCC) 11.2.0 > reproduce (this is a W=1 build): > wget https://raw.githubusercontent.com/intel/lkp-tests/master/sbin/make.cross -O ~/bin/make.cross > chmod +x ~/bin/make.cross > # https://github.com/0day-ci/linux/commit/db0b002b5b2e1055b2df7b430438335a75dc1557 > git remote add linux-review https://github.com/0day-ci/linux > git fetch --no-tags linux-review Bjorn-Andersson/typec-mux-Introduce-support-for-multiple-TypeC-muxes/20211228-132045 > git checkout db0b002b5b2e1055b2df7b430438335a75dc1557 > # save the config file to linux build tree > mkdir build_dir > COMPILER_INSTALL_PATH=$HOME/0day COMPILER=gcc-11.2.0 make.cross O=build_dir ARCH=arc SHELL=/bin/bash > > If you fix the issue, kindly add following tag as appropriate > Reported-by: kernel test robot <lkp@intel.com> > > All errors (new ones prefixed by >>): > > arceb-elf-ld: drivers/phy/qualcomm/phy-qcom-qmp.o: in function `qcom_qmp_phy_remove': > >> phy-qcom-qmp.c:(.text+0x37e): undefined reference to `typec_mux_unregister' > >> arceb-elf-ld: phy-qcom-qmp.c:(.text+0x37e): undefined reference to `typec_mux_unregister' > >> arceb-elf-ld: phy-qcom-qmp.c:(.text+0x384): undefined reference to `typec_switch_unregister' > >> arceb-elf-ld: phy-qcom-qmp.c:(.text+0x384): undefined reference to `typec_switch_unregister' > arceb-elf-ld: drivers/phy/qualcomm/phy-qcom-qmp.o: in function `qcom_qmp_phy_probe': > >> phy-qcom-qmp.c:(.text+0x14bc): undefined reference to `typec_switch_register' > >> arceb-elf-ld: phy-qcom-qmp.c:(.text+0x14bc): undefined reference to `typec_switch_register' > >> arceb-elf-ld: phy-qcom-qmp.c:(.text+0x14e2): undefined reference to `typec_mux_register' > >> arceb-elf-ld: phy-qcom-qmp.c:(.text+0x14e2): undefined reference to `typec_mux_register' > arceb-elf-ld: phy-qcom-qmp.c:(.text+0x14f6): undefined reference to `typec_switch_unregister' > arceb-elf-ld: phy-qcom-qmp.c:(.text+0x14f6): undefined reference to `typec_switch_unregister' > arceb-elf-ld: drivers/phy/qualcomm/phy-qcom-qmp.o: in function `qcom_qmp_phy_typec_switch_set': > >> phy-qcom-qmp.c:(.text+0x18f0): undefined reference to `typec_switch_get_drvdata' > >> arceb-elf-ld: phy-qcom-qmp.c:(.text+0x18f0): undefined reference to `typec_switch_get_drvdata' > arceb-elf-ld: drivers/phy/qualcomm/phy-qcom-qmp.o: in function `qcom_qmp_phy_typec_mux_set': > >> phy-qcom-qmp.c:(.text+0x1962): undefined reference to `typec_mux_get_drvdata' > >> arceb-elf-ld: phy-qcom-qmp.c:(.text+0x1962): undefined reference to `typec_mux_get_drvdata' I missed the fact that CONFIG_TYPEC is tristate. As such the QMP driver now need to be made "depend on TYPEC || TYPEC=n". I will update accordingly in v2. Regards, Bjorn > > --- > 0-DAY CI Kernel Test Service, Intel Corporation > https://lists.01.org/hyperkitty/list/kbuild-all@lists.01.org
On 27-12-21, 21:21, Bjorn Andersson wrote: > The QMP PHY handles muxing of USB vs DisplayPort, as well as orientation > switching of the SuperSpeed lanes. So register typec handlers for the > two types. > > The TypeC mux allows switching between four lanes of DisplayPort and a > mixed USB+DP combination. This makes it possible to reach resolutions > that requires 4 lanes. > > The TypeC switch allows switching the SuperSpeed pins and have been > tested with both 2 and 4 lane DisplayPort. > > It's possible that in the USB mode the DP_MODE should be disabled, but > this is left untouched. > > Signed-off-by: Bjorn Andersson <bjorn.andersson@linaro.org> > --- > > My suggestion is that if/once this patch is deemed acceptable the PHY > maintainers could create a immutable branch/tag which can be merged into the > PHY tree as well as the USB tree. > > drivers/phy/qualcomm/phy-qcom-qmp.c | 176 +++++++++++++++++++++++++--- > 1 file changed, 158 insertions(+), 18 deletions(-) > > diff --git a/drivers/phy/qualcomm/phy-qcom-qmp.c b/drivers/phy/qualcomm/phy-qcom-qmp.c > index 7bea6a60dc54..8d8139df9d8e 100644 > --- a/drivers/phy/qualcomm/phy-qcom-qmp.c > +++ b/drivers/phy/qualcomm/phy-qcom-qmp.c > @@ -19,6 +19,8 @@ > #include <linux/regulator/consumer.h> > #include <linux/reset.h> > #include <linux/slab.h> > +#include <linux/usb/typec_dp.h> > +#include <linux/usb/typec_mux.h> > > #include <dt-bindings/phy/phy.h> > > @@ -3017,6 +3019,9 @@ struct qmp_phy_dp_clks { > * @phy_mutex: mutex lock for PHY common block initialization > * @init_count: phy common block initialization count > * @ufs_reset: optional UFS PHY reset handle > + * @sw: typec switch for receiving orientation changes > + * @mux: typec mux for DP muxing > + * @orientation: carries current CC orientation > */ > struct qcom_qmp { > struct device *dev; > @@ -3032,6 +3037,10 @@ struct qcom_qmp { > int init_count; > > struct reset_control *ufs_reset; > + > + struct typec_switch *sw; > + struct typec_mux *mux; > + enum typec_orientation orientation; > }; > > static void qcom_qmp_v3_phy_dp_aux_init(struct qmp_phy *qphy); > @@ -4378,30 +4387,23 @@ static void qcom_qmp_v3_phy_configure_dp_tx(struct qmp_phy *qphy) > > static bool qcom_qmp_phy_configure_dp_mode(struct qmp_phy *qphy) > { > + const struct phy_configure_opts_dp *dp_opts = &qphy->dp_opts; > + bool reverse = qphy->qmp->orientation == TYPEC_ORIENTATION_REVERSE; > u32 val; > - bool reverse = false; > > val = DP_PHY_PD_CTL_PWRDN | DP_PHY_PD_CTL_AUX_PWRDN | > DP_PHY_PD_CTL_PLL_PWRDN | DP_PHY_PD_CTL_DP_CLAMP_EN; > > - /* > - * TODO: Assume orientation is CC1 for now and two lanes, need to > - * use type-c connector to understand orientation and lanes. > - * > - * Otherwise val changes to be like below if this code understood > - * the orientation of the type-c cable. > - * > - * if (lane_cnt == 4 || orientation == ORIENTATION_CC2) > - * val |= DP_PHY_PD_CTL_LANE_0_1_PWRDN; > - * if (lane_cnt == 4 || orientation == ORIENTATION_CC1) > - * val |= DP_PHY_PD_CTL_LANE_2_3_PWRDN; > - * if (orientation == ORIENTATION_CC2) > - * writel(0x4c, qphy->pcs + QSERDES_V3_DP_PHY_MODE); > - */ > - val |= DP_PHY_PD_CTL_LANE_2_3_PWRDN; > + if (dp_opts->lanes == 4 || reverse) > + val |= DP_PHY_PD_CTL_LANE_0_1_PWRDN; > + if (dp_opts->lanes == 4 || !reverse) > + val |= DP_PHY_PD_CTL_LANE_2_3_PWRDN; > writel(val, qphy->pcs + QSERDES_DP_PHY_PD_CTL); > > - writel(0x5c, qphy->pcs + QSERDES_DP_PHY_MODE); > + if (reverse) > + writel(0x4c, qphy->pcs + QSERDES_DP_PHY_MODE); > + else > + writel(0x5c, qphy->pcs + QSERDES_DP_PHY_MODE); > > return reverse; > } > @@ -5809,6 +5811,123 @@ static const struct dev_pm_ops qcom_qmp_phy_pm_ops = { > qcom_qmp_phy_runtime_resume, NULL) > }; > > +#if IS_ENABLED(CONFIG_TYPEC) > +static int qcom_qmp_phy_typec_switch_set(struct typec_switch *sw, > + enum typec_orientation orientation) pls align to preceding open brace (here and other places) > +{ > + struct qcom_qmp *qmp = typec_switch_get_drvdata(sw); > + void __iomem *dp_com = qmp->dp_com; > + > + qmp->orientation = orientation; > + > + if (orientation == TYPEC_ORIENTATION_REVERSE) > + qphy_setbits(dp_com, QPHY_V3_DP_COM_TYPEC_CTRL, 0x01); > + else > + qphy_clrbits(dp_com, QPHY_V3_DP_COM_TYPEC_CTRL, 0x01); > + > + return 0; > +} > + > +static int qcom_qmp_phy_typec_mux_set(struct typec_mux *mux, > + struct typec_mux_state *state) > +{ > + struct qcom_qmp *qmp = typec_mux_get_drvdata(mux); > + void __iomem *dp_com = qmp->dp_com; > + bool dp_mode; > + bool usb_mode; > + > + switch (state->mode) { > + case TYPEC_STATE_SAFE: > + case TYPEC_STATE_USB: > + /* > + * TODO: Figure out if we should clear DP_MODE when we enter a > + * USB-only state. > + */ > + dp_mode = true; should this be false for these states? > + usb_mode = true; > + break; > + case TYPEC_DP_STATE_A: > + case TYPEC_DP_STATE_C: > + case TYPEC_DP_STATE_E: > + dp_mode = true; > + usb_mode = false; > + break; > + case TYPEC_DP_STATE_B: > + case TYPEC_DP_STATE_D: > + case TYPEC_DP_STATE_F: > + dp_mode = true; > + usb_mode = true; > + break; > + } looks like dp_mode is true always. And only for DP state A C E, usb_mode is false... > + > + qphy_setbits(dp_com, QPHY_V3_DP_COM_RESET_OVRD_CTRL, > + SW_DPPHY_RESET_MUX | SW_USB3PHY_RESET_MUX); > + if (dp_mode) > + qphy_setbits(dp_com, QPHY_V3_DP_COM_PHY_MODE_CTRL, DP_MODE); > + else > + qphy_clrbits(dp_com, QPHY_V3_DP_COM_PHY_MODE_CTRL, DP_MODE); > + > + if (usb_mode) > + qphy_setbits(dp_com, QPHY_V3_DP_COM_PHY_MODE_CTRL, USB3_MODE); > + else > + qphy_clrbits(dp_com, QPHY_V3_DP_COM_PHY_MODE_CTRL, USB3_MODE); > + > + qphy_setbits(dp_com, QPHY_V3_DP_COM_SW_RESET, SW_RESET); > + qphy_clrbits(dp_com, QPHY_V3_DP_COM_SWI_CTRL, 0x03); > + qphy_clrbits(dp_com, QPHY_V3_DP_COM_SW_RESET, SW_RESET); > + > + return 0; > +} > + > +static int qcom_qmp_phy_typec_register(struct qcom_qmp *qmp, > + const struct qmp_phy_cfg *cfg) > +{ > + struct typec_switch_desc sw_desc = {}; > + struct typec_mux_desc mux_desc = {}; > + struct device *dev = qmp->dev; > + > + if (!cfg->has_phy_dp_com_ctrl) > + return 0; > + > + sw_desc.drvdata = qmp; > + sw_desc.fwnode = dev->fwnode; > + sw_desc.set = qcom_qmp_phy_typec_switch_set; > + qmp->sw = typec_switch_register(dev, &sw_desc); > + if (IS_ERR(qmp->sw)) { > + dev_err(dev, "Error registering typec switch: %pe\n", qmp->sw); > + return PTR_ERR(qmp->sw); > + } > + > + mux_desc.drvdata = qmp; > + mux_desc.fwnode = dev->fwnode; > + mux_desc.set = qcom_qmp_phy_typec_mux_set; > + qmp->mux = typec_mux_register(dev, &mux_desc); > + if (IS_ERR(qmp->mux)) { > + dev_err(dev, "Error registering typec mux: %pe\n", qmp->mux); > + typec_switch_unregister(qmp->sw); > + return PTR_ERR(qmp->mux); > + } > + > + return 0; > +} > + > +static void qcom_qmp_phy_typec_unregister(struct qcom_qmp *qmp) > +{ > + typec_mux_unregister(qmp->mux); > + typec_switch_unregister(qmp->sw); > +} > +#else empty line here pls > +static int qcom_qmp_phy_typec_register(struct qcom_qmp *qmp, > + const struct qmp_phy_cfg *cfg) > +{ > + return 0; > +} > + > +static void qcom_qmp_phy_typec_unregister(struct qcom_qmp *qmp) > +{ > +} > +#endif > + > static int qcom_qmp_phy_probe(struct platform_device *pdev) > { > struct qcom_qmp *qmp; > @@ -5891,7 +6010,15 @@ static int qcom_qmp_phy_probe(struct platform_device *pdev) > return ret; > } > > - num = of_get_available_child_count(dev->of_node); > + ret = qcom_qmp_phy_typec_register(qmp, cfg); > + if (ret) > + return ret; > + > + num = 0; > + for_each_available_child_of_node(dev->of_node, child) { > + if (!of_node_name_eq(child, "port")) > + num++; > + } > /* do we have a rogue child node ? */ > if (num > expected_phys) > return -EINVAL; > @@ -5918,6 +6045,9 @@ static int qcom_qmp_phy_probe(struct platform_device *pdev) > serdes = usb_serdes; > } > > + if (of_node_name_eq(child, "port")) > + continue; > + > /* Create per-lane phy */ > ret = qcom_qmp_phy_create(dev, child, id, serdes, cfg); > if (ret) { > @@ -5962,8 +6092,18 @@ static int qcom_qmp_phy_probe(struct platform_device *pdev) > return ret; > } > > +static int qcom_qmp_phy_remove(struct platform_device *pdev) > +{ > + struct qcom_qmp *qmp = platform_get_drvdata(pdev); > + > + qcom_qmp_phy_typec_unregister(qmp); > + > + return 0; > +} > + > static struct platform_driver qcom_qmp_phy_driver = { > .probe = qcom_qmp_phy_probe, > + .remove = qcom_qmp_phy_remove, > .driver = { > .name = "qcom-qmp-phy", > .pm = &qcom_qmp_phy_pm_ops, > -- > 2.33.1
On Tue 28 Dec 21:27 PST 2021, Vinod Koul wrote: > On 27-12-21, 21:21, Bjorn Andersson wrote: > > The QMP PHY handles muxing of USB vs DisplayPort, as well as orientation > > switching of the SuperSpeed lanes. So register typec handlers for the > > two types. > > > > The TypeC mux allows switching between four lanes of DisplayPort and a > > mixed USB+DP combination. This makes it possible to reach resolutions > > that requires 4 lanes. > > > > The TypeC switch allows switching the SuperSpeed pins and have been > > tested with both 2 and 4 lane DisplayPort. > > > > It's possible that in the USB mode the DP_MODE should be disabled, but > > this is left untouched. > > > > Signed-off-by: Bjorn Andersson <bjorn.andersson@linaro.org> > > --- > > > > My suggestion is that if/once this patch is deemed acceptable the PHY > > maintainers could create a immutable branch/tag which can be merged into the > > PHY tree as well as the USB tree. > > > > drivers/phy/qualcomm/phy-qcom-qmp.c | 176 +++++++++++++++++++++++++--- > > 1 file changed, 158 insertions(+), 18 deletions(-) > > > > diff --git a/drivers/phy/qualcomm/phy-qcom-qmp.c b/drivers/phy/qualcomm/phy-qcom-qmp.c > > index 7bea6a60dc54..8d8139df9d8e 100644 > > --- a/drivers/phy/qualcomm/phy-qcom-qmp.c > > +++ b/drivers/phy/qualcomm/phy-qcom-qmp.c > > @@ -19,6 +19,8 @@ > > #include <linux/regulator/consumer.h> > > #include <linux/reset.h> > > #include <linux/slab.h> > > +#include <linux/usb/typec_dp.h> > > +#include <linux/usb/typec_mux.h> > > > > #include <dt-bindings/phy/phy.h> > > > > @@ -3017,6 +3019,9 @@ struct qmp_phy_dp_clks { > > * @phy_mutex: mutex lock for PHY common block initialization > > * @init_count: phy common block initialization count > > * @ufs_reset: optional UFS PHY reset handle > > + * @sw: typec switch for receiving orientation changes > > + * @mux: typec mux for DP muxing > > + * @orientation: carries current CC orientation > > */ > > struct qcom_qmp { > > struct device *dev; > > @@ -3032,6 +3037,10 @@ struct qcom_qmp { > > int init_count; > > > > struct reset_control *ufs_reset; > > + > > + struct typec_switch *sw; > > + struct typec_mux *mux; > > + enum typec_orientation orientation; > > }; > > > > static void qcom_qmp_v3_phy_dp_aux_init(struct qmp_phy *qphy); > > @@ -4378,30 +4387,23 @@ static void qcom_qmp_v3_phy_configure_dp_tx(struct qmp_phy *qphy) > > > > static bool qcom_qmp_phy_configure_dp_mode(struct qmp_phy *qphy) > > { > > + const struct phy_configure_opts_dp *dp_opts = &qphy->dp_opts; > > + bool reverse = qphy->qmp->orientation == TYPEC_ORIENTATION_REVERSE; > > u32 val; > > - bool reverse = false; > > > > val = DP_PHY_PD_CTL_PWRDN | DP_PHY_PD_CTL_AUX_PWRDN | > > DP_PHY_PD_CTL_PLL_PWRDN | DP_PHY_PD_CTL_DP_CLAMP_EN; > > > > - /* > > - * TODO: Assume orientation is CC1 for now and two lanes, need to > > - * use type-c connector to understand orientation and lanes. > > - * > > - * Otherwise val changes to be like below if this code understood > > - * the orientation of the type-c cable. > > - * > > - * if (lane_cnt == 4 || orientation == ORIENTATION_CC2) > > - * val |= DP_PHY_PD_CTL_LANE_0_1_PWRDN; > > - * if (lane_cnt == 4 || orientation == ORIENTATION_CC1) > > - * val |= DP_PHY_PD_CTL_LANE_2_3_PWRDN; > > - * if (orientation == ORIENTATION_CC2) > > - * writel(0x4c, qphy->pcs + QSERDES_V3_DP_PHY_MODE); > > - */ > > - val |= DP_PHY_PD_CTL_LANE_2_3_PWRDN; > > + if (dp_opts->lanes == 4 || reverse) > > + val |= DP_PHY_PD_CTL_LANE_0_1_PWRDN; > > + if (dp_opts->lanes == 4 || !reverse) > > + val |= DP_PHY_PD_CTL_LANE_2_3_PWRDN; > > writel(val, qphy->pcs + QSERDES_DP_PHY_PD_CTL); > > > > - writel(0x5c, qphy->pcs + QSERDES_DP_PHY_MODE); > > + if (reverse) > > + writel(0x4c, qphy->pcs + QSERDES_DP_PHY_MODE); > > + else > > + writel(0x5c, qphy->pcs + QSERDES_DP_PHY_MODE); > > > > return reverse; > > } > > @@ -5809,6 +5811,123 @@ static const struct dev_pm_ops qcom_qmp_phy_pm_ops = { > > qcom_qmp_phy_runtime_resume, NULL) > > }; > > > > +#if IS_ENABLED(CONFIG_TYPEC) > > +static int qcom_qmp_phy_typec_switch_set(struct typec_switch *sw, > > + enum typec_orientation orientation) > > pls align to preceding open brace (here and other places) > Sure thing. > > +{ > > + struct qcom_qmp *qmp = typec_switch_get_drvdata(sw); > > + void __iomem *dp_com = qmp->dp_com; > > + > > + qmp->orientation = orientation; > > + > > + if (orientation == TYPEC_ORIENTATION_REVERSE) > > + qphy_setbits(dp_com, QPHY_V3_DP_COM_TYPEC_CTRL, 0x01); > > + else > > + qphy_clrbits(dp_com, QPHY_V3_DP_COM_TYPEC_CTRL, 0x01); > > + > > + return 0; > > +} > > + > > +static int qcom_qmp_phy_typec_mux_set(struct typec_mux *mux, > > + struct typec_mux_state *state) > > +{ > > + struct qcom_qmp *qmp = typec_mux_get_drvdata(mux); > > + void __iomem *dp_com = qmp->dp_com; > > + bool dp_mode; > > + bool usb_mode; > > + > > + switch (state->mode) { > > + case TYPEC_STATE_SAFE: > > + case TYPEC_STATE_USB: > > + /* > > + * TODO: Figure out if we should clear DP_MODE when we enter a > > + * USB-only state. > > + */ > > + dp_mode = true; > > should this be false for these states? > I think it should, but figured that I better change the behavior in a separate follow-up commit. Might also be that SAFE should be false/false - or in some other way turning off the output. Hence the TODO. > > + usb_mode = true; > > + break; > > + case TYPEC_DP_STATE_A: > > + case TYPEC_DP_STATE_C: > > + case TYPEC_DP_STATE_E: > > + dp_mode = true; > > + usb_mode = false; > > + break; > > + case TYPEC_DP_STATE_B: > > + case TYPEC_DP_STATE_D: > > + case TYPEC_DP_STATE_F: > > + dp_mode = true; > > + usb_mode = true; > > + break; > > + } > > looks like dp_mode is true always. And only for DP state A C E, usb_mode > is false... > A, C and E are 4-lanes DP, while B, D, F are 2-lane DP and 2-lane USB. > > + > > + qphy_setbits(dp_com, QPHY_V3_DP_COM_RESET_OVRD_CTRL, > > + SW_DPPHY_RESET_MUX | SW_USB3PHY_RESET_MUX); > > + if (dp_mode) > > + qphy_setbits(dp_com, QPHY_V3_DP_COM_PHY_MODE_CTRL, DP_MODE); > > + else > > + qphy_clrbits(dp_com, QPHY_V3_DP_COM_PHY_MODE_CTRL, DP_MODE); > > + > > + if (usb_mode) > > + qphy_setbits(dp_com, QPHY_V3_DP_COM_PHY_MODE_CTRL, USB3_MODE); > > + else > > + qphy_clrbits(dp_com, QPHY_V3_DP_COM_PHY_MODE_CTRL, USB3_MODE); > > + > > + qphy_setbits(dp_com, QPHY_V3_DP_COM_SW_RESET, SW_RESET); > > + qphy_clrbits(dp_com, QPHY_V3_DP_COM_SWI_CTRL, 0x03); > > + qphy_clrbits(dp_com, QPHY_V3_DP_COM_SW_RESET, SW_RESET); > > + > > + return 0; > > +} > > + > > +static int qcom_qmp_phy_typec_register(struct qcom_qmp *qmp, > > + const struct qmp_phy_cfg *cfg) > > +{ > > + struct typec_switch_desc sw_desc = {}; > > + struct typec_mux_desc mux_desc = {}; > > + struct device *dev = qmp->dev; > > + > > + if (!cfg->has_phy_dp_com_ctrl) > > + return 0; > > + > > + sw_desc.drvdata = qmp; > > + sw_desc.fwnode = dev->fwnode; > > + sw_desc.set = qcom_qmp_phy_typec_switch_set; > > + qmp->sw = typec_switch_register(dev, &sw_desc); > > + if (IS_ERR(qmp->sw)) { > > + dev_err(dev, "Error registering typec switch: %pe\n", qmp->sw); > > + return PTR_ERR(qmp->sw); > > + } > > + > > + mux_desc.drvdata = qmp; > > + mux_desc.fwnode = dev->fwnode; > > + mux_desc.set = qcom_qmp_phy_typec_mux_set; > > + qmp->mux = typec_mux_register(dev, &mux_desc); > > + if (IS_ERR(qmp->mux)) { > > + dev_err(dev, "Error registering typec mux: %pe\n", qmp->mux); > > + typec_switch_unregister(qmp->sw); > > + return PTR_ERR(qmp->mux); > > + } > > + > > + return 0; > > +} > > + > > +static void qcom_qmp_phy_typec_unregister(struct qcom_qmp *qmp) > > +{ > > + typec_mux_unregister(qmp->mux); > > + typec_switch_unregister(qmp->sw); > > +} > > +#else > > empty line here pls > Okay. Thanks, Bjorn > > +static int qcom_qmp_phy_typec_register(struct qcom_qmp *qmp, > > + const struct qmp_phy_cfg *cfg) > > +{ > > + return 0; > > +} > > + > > +static void qcom_qmp_phy_typec_unregister(struct qcom_qmp *qmp) > > +{ > > +} > > +#endif > > + > > static int qcom_qmp_phy_probe(struct platform_device *pdev) > > { > > struct qcom_qmp *qmp; > > @@ -5891,7 +6010,15 @@ static int qcom_qmp_phy_probe(struct platform_device *pdev) > > return ret; > > } > > > > - num = of_get_available_child_count(dev->of_node); > > + ret = qcom_qmp_phy_typec_register(qmp, cfg); > > + if (ret) > > + return ret; > > + > > + num = 0; > > + for_each_available_child_of_node(dev->of_node, child) { > > + if (!of_node_name_eq(child, "port")) > > + num++; > > + } > > /* do we have a rogue child node ? */ > > if (num > expected_phys) > > return -EINVAL; > > @@ -5918,6 +6045,9 @@ static int qcom_qmp_phy_probe(struct platform_device *pdev) > > serdes = usb_serdes; > > } > > > > + if (of_node_name_eq(child, "port")) > > + continue; > > + > > /* Create per-lane phy */ > > ret = qcom_qmp_phy_create(dev, child, id, serdes, cfg); > > if (ret) { > > @@ -5962,8 +6092,18 @@ static int qcom_qmp_phy_probe(struct platform_device *pdev) > > return ret; > > } > > > > +static int qcom_qmp_phy_remove(struct platform_device *pdev) > > +{ > > + struct qcom_qmp *qmp = platform_get_drvdata(pdev); > > + > > + qcom_qmp_phy_typec_unregister(qmp); > > + > > + return 0; > > +} > > + > > static struct platform_driver qcom_qmp_phy_driver = { > > .probe = qcom_qmp_phy_probe, > > + .remove = qcom_qmp_phy_remove, > > .driver = { > > .name = "qcom-qmp-phy", > > .pm = &qcom_qmp_phy_pm_ops, > > -- > > 2.33.1 > > -- > ~Vinod
diff --git a/drivers/phy/qualcomm/phy-qcom-qmp.c b/drivers/phy/qualcomm/phy-qcom-qmp.c index 7bea6a60dc54..8d8139df9d8e 100644 --- a/drivers/phy/qualcomm/phy-qcom-qmp.c +++ b/drivers/phy/qualcomm/phy-qcom-qmp.c @@ -19,6 +19,8 @@ #include <linux/regulator/consumer.h> #include <linux/reset.h> #include <linux/slab.h> +#include <linux/usb/typec_dp.h> +#include <linux/usb/typec_mux.h> #include <dt-bindings/phy/phy.h> @@ -3017,6 +3019,9 @@ struct qmp_phy_dp_clks { * @phy_mutex: mutex lock for PHY common block initialization * @init_count: phy common block initialization count * @ufs_reset: optional UFS PHY reset handle + * @sw: typec switch for receiving orientation changes + * @mux: typec mux for DP muxing + * @orientation: carries current CC orientation */ struct qcom_qmp { struct device *dev; @@ -3032,6 +3037,10 @@ struct qcom_qmp { int init_count; struct reset_control *ufs_reset; + + struct typec_switch *sw; + struct typec_mux *mux; + enum typec_orientation orientation; }; static void qcom_qmp_v3_phy_dp_aux_init(struct qmp_phy *qphy); @@ -4378,30 +4387,23 @@ static void qcom_qmp_v3_phy_configure_dp_tx(struct qmp_phy *qphy) static bool qcom_qmp_phy_configure_dp_mode(struct qmp_phy *qphy) { + const struct phy_configure_opts_dp *dp_opts = &qphy->dp_opts; + bool reverse = qphy->qmp->orientation == TYPEC_ORIENTATION_REVERSE; u32 val; - bool reverse = false; val = DP_PHY_PD_CTL_PWRDN | DP_PHY_PD_CTL_AUX_PWRDN | DP_PHY_PD_CTL_PLL_PWRDN | DP_PHY_PD_CTL_DP_CLAMP_EN; - /* - * TODO: Assume orientation is CC1 for now and two lanes, need to - * use type-c connector to understand orientation and lanes. - * - * Otherwise val changes to be like below if this code understood - * the orientation of the type-c cable. - * - * if (lane_cnt == 4 || orientation == ORIENTATION_CC2) - * val |= DP_PHY_PD_CTL_LANE_0_1_PWRDN; - * if (lane_cnt == 4 || orientation == ORIENTATION_CC1) - * val |= DP_PHY_PD_CTL_LANE_2_3_PWRDN; - * if (orientation == ORIENTATION_CC2) - * writel(0x4c, qphy->pcs + QSERDES_V3_DP_PHY_MODE); - */ - val |= DP_PHY_PD_CTL_LANE_2_3_PWRDN; + if (dp_opts->lanes == 4 || reverse) + val |= DP_PHY_PD_CTL_LANE_0_1_PWRDN; + if (dp_opts->lanes == 4 || !reverse) + val |= DP_PHY_PD_CTL_LANE_2_3_PWRDN; writel(val, qphy->pcs + QSERDES_DP_PHY_PD_CTL); - writel(0x5c, qphy->pcs + QSERDES_DP_PHY_MODE); + if (reverse) + writel(0x4c, qphy->pcs + QSERDES_DP_PHY_MODE); + else + writel(0x5c, qphy->pcs + QSERDES_DP_PHY_MODE); return reverse; } @@ -5809,6 +5811,123 @@ static const struct dev_pm_ops qcom_qmp_phy_pm_ops = { qcom_qmp_phy_runtime_resume, NULL) }; +#if IS_ENABLED(CONFIG_TYPEC) +static int qcom_qmp_phy_typec_switch_set(struct typec_switch *sw, + enum typec_orientation orientation) +{ + struct qcom_qmp *qmp = typec_switch_get_drvdata(sw); + void __iomem *dp_com = qmp->dp_com; + + qmp->orientation = orientation; + + if (orientation == TYPEC_ORIENTATION_REVERSE) + qphy_setbits(dp_com, QPHY_V3_DP_COM_TYPEC_CTRL, 0x01); + else + qphy_clrbits(dp_com, QPHY_V3_DP_COM_TYPEC_CTRL, 0x01); + + return 0; +} + +static int qcom_qmp_phy_typec_mux_set(struct typec_mux *mux, + struct typec_mux_state *state) +{ + struct qcom_qmp *qmp = typec_mux_get_drvdata(mux); + void __iomem *dp_com = qmp->dp_com; + bool dp_mode; + bool usb_mode; + + switch (state->mode) { + case TYPEC_STATE_SAFE: + case TYPEC_STATE_USB: + /* + * TODO: Figure out if we should clear DP_MODE when we enter a + * USB-only state. + */ + dp_mode = true; + usb_mode = true; + break; + case TYPEC_DP_STATE_A: + case TYPEC_DP_STATE_C: + case TYPEC_DP_STATE_E: + dp_mode = true; + usb_mode = false; + break; + case TYPEC_DP_STATE_B: + case TYPEC_DP_STATE_D: + case TYPEC_DP_STATE_F: + dp_mode = true; + usb_mode = true; + break; + } + + qphy_setbits(dp_com, QPHY_V3_DP_COM_RESET_OVRD_CTRL, + SW_DPPHY_RESET_MUX | SW_USB3PHY_RESET_MUX); + if (dp_mode) + qphy_setbits(dp_com, QPHY_V3_DP_COM_PHY_MODE_CTRL, DP_MODE); + else + qphy_clrbits(dp_com, QPHY_V3_DP_COM_PHY_MODE_CTRL, DP_MODE); + + if (usb_mode) + qphy_setbits(dp_com, QPHY_V3_DP_COM_PHY_MODE_CTRL, USB3_MODE); + else + qphy_clrbits(dp_com, QPHY_V3_DP_COM_PHY_MODE_CTRL, USB3_MODE); + + qphy_setbits(dp_com, QPHY_V3_DP_COM_SW_RESET, SW_RESET); + qphy_clrbits(dp_com, QPHY_V3_DP_COM_SWI_CTRL, 0x03); + qphy_clrbits(dp_com, QPHY_V3_DP_COM_SW_RESET, SW_RESET); + + return 0; +} + +static int qcom_qmp_phy_typec_register(struct qcom_qmp *qmp, + const struct qmp_phy_cfg *cfg) +{ + struct typec_switch_desc sw_desc = {}; + struct typec_mux_desc mux_desc = {}; + struct device *dev = qmp->dev; + + if (!cfg->has_phy_dp_com_ctrl) + return 0; + + sw_desc.drvdata = qmp; + sw_desc.fwnode = dev->fwnode; + sw_desc.set = qcom_qmp_phy_typec_switch_set; + qmp->sw = typec_switch_register(dev, &sw_desc); + if (IS_ERR(qmp->sw)) { + dev_err(dev, "Error registering typec switch: %pe\n", qmp->sw); + return PTR_ERR(qmp->sw); + } + + mux_desc.drvdata = qmp; + mux_desc.fwnode = dev->fwnode; + mux_desc.set = qcom_qmp_phy_typec_mux_set; + qmp->mux = typec_mux_register(dev, &mux_desc); + if (IS_ERR(qmp->mux)) { + dev_err(dev, "Error registering typec mux: %pe\n", qmp->mux); + typec_switch_unregister(qmp->sw); + return PTR_ERR(qmp->mux); + } + + return 0; +} + +static void qcom_qmp_phy_typec_unregister(struct qcom_qmp *qmp) +{ + typec_mux_unregister(qmp->mux); + typec_switch_unregister(qmp->sw); +} +#else +static int qcom_qmp_phy_typec_register(struct qcom_qmp *qmp, + const struct qmp_phy_cfg *cfg) +{ + return 0; +} + +static void qcom_qmp_phy_typec_unregister(struct qcom_qmp *qmp) +{ +} +#endif + static int qcom_qmp_phy_probe(struct platform_device *pdev) { struct qcom_qmp *qmp; @@ -5891,7 +6010,15 @@ static int qcom_qmp_phy_probe(struct platform_device *pdev) return ret; } - num = of_get_available_child_count(dev->of_node); + ret = qcom_qmp_phy_typec_register(qmp, cfg); + if (ret) + return ret; + + num = 0; + for_each_available_child_of_node(dev->of_node, child) { + if (!of_node_name_eq(child, "port")) + num++; + } /* do we have a rogue child node ? */ if (num > expected_phys) return -EINVAL; @@ -5918,6 +6045,9 @@ static int qcom_qmp_phy_probe(struct platform_device *pdev) serdes = usb_serdes; } + if (of_node_name_eq(child, "port")) + continue; + /* Create per-lane phy */ ret = qcom_qmp_phy_create(dev, child, id, serdes, cfg); if (ret) { @@ -5962,8 +6092,18 @@ static int qcom_qmp_phy_probe(struct platform_device *pdev) return ret; } +static int qcom_qmp_phy_remove(struct platform_device *pdev) +{ + struct qcom_qmp *qmp = platform_get_drvdata(pdev); + + qcom_qmp_phy_typec_unregister(qmp); + + return 0; +} + static struct platform_driver qcom_qmp_phy_driver = { .probe = qcom_qmp_phy_probe, + .remove = qcom_qmp_phy_remove, .driver = { .name = "qcom-qmp-phy", .pm = &qcom_qmp_phy_pm_ops,
The QMP PHY handles muxing of USB vs DisplayPort, as well as orientation switching of the SuperSpeed lanes. So register typec handlers for the two types. The TypeC mux allows switching between four lanes of DisplayPort and a mixed USB+DP combination. This makes it possible to reach resolutions that requires 4 lanes. The TypeC switch allows switching the SuperSpeed pins and have been tested with both 2 and 4 lane DisplayPort. It's possible that in the USB mode the DP_MODE should be disabled, but this is left untouched. Signed-off-by: Bjorn Andersson <bjorn.andersson@linaro.org> --- My suggestion is that if/once this patch is deemed acceptable the PHY maintainers could create a immutable branch/tag which can be merged into the PHY tree as well as the USB tree. drivers/phy/qualcomm/phy-qcom-qmp.c | 176 +++++++++++++++++++++++++--- 1 file changed, 158 insertions(+), 18 deletions(-)