// SPDX-License-Identifier: GPL-2.0 /* * Copyright (c) 2017, The Linux Foundation. All rights reserved. #include <linux/clk.h>#include <linux/clk-provider.h>#include <linux/delay.h>#include <linux/err.h>#include <linux/io.h>#include <linux/iopoll.h>#include <linux/kernel.h>#include <linux/mfd/syscon.h>#include <linux/module.h>#include <linux/of.h>#include <linux/of_address.h>#include <linux/phy/phy.h>#include <linux/platform_device.h>#include <linux/regmap.h>#include <linux/regulator/consumer.h>#include <linux/reset.h>#include <linux/slab.h>#include <linux/usb/typec.h>#include <linux/usb/typec_mux.h>#include "phy-qcom-qmp-common.h" #include "phy-qcom-qmp.h" #include "phy-qcom-qmp-pcs-misc-v3.h" #define PHY_INIT_COMPLETE_TIMEOUT 10000/* set of registers with offsets different per-PHY */ enum qphy_reg_layout {/* PCS registers */ /* Keep last to ensure regs_layout arrays are properly initialized */ static const unsigned int qmp_v3_usb3phy_regs_layout[QPHY_LAYOUT_SIZE] = {static const unsigned int qmp_v3_usb3phy_regs_layout_qcm2290[QPHY_LAYOUT_SIZE] = {static const struct qmp_phy_init_tbl msm8998_usb3_serdes_tbl[] = {static const struct qmp_phy_init_tbl msm8998_usb3_tx_tbl[] = {static const struct qmp_phy_init_tbl msm8998_usb3_rx_tbl[] = {static const struct qmp_phy_init_tbl msm8998_usb3_pcs_tbl[] = {static const struct qmp_phy_init_tbl qcm2290_usb3_serdes_tbl[] = {static const struct qmp_phy_init_tbl qcm2290_usb3_tx_tbl[] = {static const struct qmp_phy_init_tbl qcm2290_usb3_rx_tbl[] = {/* the only difference is QSERDES_V3_RX_UCDR_PI_CONTROLS */ static const struct qmp_phy_init_tbl sdm660_usb3_rx_tbl[] = {static const struct qmp_phy_init_tbl qcm2290_usb3_pcs_tbl[] = {struct qmp_usbc_offsets {/* for PHYs with >= 2 lanes */ /* struct qmp_phy_cfg - per-PHY initialization config */ struct qmp_phy_cfg {const struct qmp_usbc_offsets *offsets;/* Init sequence for PHY blocks - serdes, tx, rx, pcs */ const struct qmp_phy_init_tbl *serdes_tbl;int serdes_tbl_num;const struct qmp_phy_init_tbl *tx_tbl;int tx_tbl_num;const struct qmp_phy_init_tbl *rx_tbl;int rx_tbl_num;const struct qmp_phy_init_tbl *pcs_tbl;int pcs_tbl_num;/* regulators to be requested */ const char * const *vreg_list;int num_vregs;/* array of registers with different offsets */ const unsigned int *regs;struct qmp_usbc {struct device *dev;const struct qmp_phy_cfg *cfg;void __iomem *serdes;void __iomem *pcs;void __iomem *pcs_misc;void __iomem *tx;void __iomem *rx;void __iomem *tx2;void __iomem *rx2;struct regmap *tcsr_map;struct clk *pipe_clk;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;static inline void qphy_setbits(void __iomem *base, u32 offset, u32 val)/* ensure that above write is through */ static inline void qphy_clrbits(void __iomem *base, u32 offset, u32 val)/* ensure that above write is through */ /* list of clocks required by phy */ static const char * const qmp_usbc_phy_clk_l[] = {"aux" , "cfg_ahb" , "ref" , "com_aux" ,/* list of resets */ static const char * const usb3phy_legacy_reset_l[] = {"phy" , "common" ,static const char * const usb3phy_reset_l[] = {"phy_phy" , "phy" ,/* list of regulators */ static const char * const qmp_phy_vreg_l[] = {"vdda-phy" , "vdda-pll" ,static const struct qmp_usbc_offsets qmp_usbc_offsets_v3_qcm2290 = {static const struct qmp_phy_cfg msm8998_usb3phy_cfg = {static const struct qmp_phy_cfg qcm2290_usb3phy_cfg = {static const struct qmp_phy_cfg sdm660_usb3phy_cfg = {static int qmp_usbc_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 ret;if (ret) {"failed to enable regulators, err=%d\n" , ret);return ret;if (ret) {"reset assert failed\n" );goto err_disable_regulators;if (ret) {"reset deassert failed\n" );goto err_disable_regulators;if (ret)goto err_assert_reset;#define SW_PORTSELECT_VAL BIT(0)#define SW_PORTSELECT_MUX BIT(1)/* Use software based port select and switch on typec orientation */ if (qmp->orientation == TYPEC_ORIENTATION_REVERSE)return 0;return ret;static int qmp_usbc_exit(struct phy *phy)struct qmp_usbc *qmp = phy_get_drvdata(phy);const struct qmp_phy_cfg *cfg = qmp->cfg;return 0;static int qmp_usbc_power_on(struct phy *phy)struct qmp_usbc *qmp = phy_get_drvdata(phy);const struct qmp_phy_cfg *cfg = qmp->cfg;void __iomem *status;unsigned int val;int ret;if (ret) {"pipe_clk enable failed err=%d\n" , ret);return ret;/* Tx, Rx, and PCS configurations */ /* Pull PHY out of reset state */ /* start SerDes and Phy-Coding-Sublayer */ if (ret) {"phy initialization timed-out\n" );goto err_disable_pipe_clk;return 0;return ret;static int qmp_usbc_power_off(struct phy *phy)struct qmp_usbc *qmp = phy_get_drvdata(phy);const struct qmp_phy_cfg *cfg = qmp->cfg;/* PHY reset */ /* stop SerDes and Phy-Coding-Sublayer */ /* Put PHY into POWER DOWN state: active low */ return 0;static int qmp_usbc_enable(struct phy *phy)struct qmp_usbc *qmp = phy_get_drvdata(phy);int ret;if (ret)goto out_unlock;if (ret) {goto out_unlock;return ret;static int qmp_usbc_disable(struct phy *phy)struct qmp_usbc *qmp = phy_get_drvdata(phy);int ret;if (ret)return ret;return qmp_usbc_exit(phy);static int qmp_usbc_set_mode(struct phy *phy, enum phy_mode mode, int submode)struct qmp_usbc *qmp = phy_get_drvdata(phy);return 0;static const struct phy_ops qmp_usbc_phy_ops = {exit = qmp_usbc_disable,static void qmp_usbc_enable_autonomous_mode(struct qmp_usbc *qmp)const struct qmp_phy_cfg *cfg = qmp->cfg;void __iomem *pcs = qmp->pcs;if (qmp->mode == PHY_MODE_USB_HOST_SS ||else /* Clear any pending interrupts status */ /* Writing 1 followed by 0 clears the interrupt */ /* Enable required PHY autonomous mode interrupts */ /* Enable i/o clamp_n for autonomous mode */ if (qmp->tcsr_map && qmp->vls_clamp_reg)static void qmp_usbc_disable_autonomous_mode(struct qmp_usbc *qmp)const struct qmp_phy_cfg *cfg = qmp->cfg;void __iomem *pcs = qmp->pcs;/* Disable i/o clamp_n on resume for normal mode */ if (qmp->tcsr_map && qmp->vls_clamp_reg)/* Writing 1 followed by 0 clears the interrupt */ static int __maybe_unused qmp_usbc_runtime_suspend(struct device *dev)struct qmp_usbc *qmp = dev_get_drvdata(dev);"Suspending QMP phy, mode:%d\n" , qmp->mode);if (!qmp->phy->init_count) {"PHY not initialized, bailing out\n" );return 0;return 0;static int __maybe_unused qmp_usbc_runtime_resume(struct device *dev)struct qmp_usbc *qmp = dev_get_drvdata(dev);int ret = 0;"Resuming QMP phy, mode:%d\n" , qmp->mode);if (!qmp->phy->init_count) {"PHY not initialized, bailing out\n" );return 0;if (ret)return ret;if (ret) {"pipe_clk enable failed, err=%d\n" , ret);return ret;return 0;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;sizeof (*qmp->vregs), GFP_KERNEL);if (!qmp->vregs)return -ENOMEM;for (i = 0; i < num; i++)return devm_regulator_bulk_get(dev, num, qmp->vregs);static int qmp_usbc_reset_init(struct qmp_usbc *qmp,const char *const *reset_list,int num_resets)struct device *dev = qmp->dev;int i;int ret;sizeof (*qmp->resets), GFP_KERNEL);if (!qmp->resets)return -ENOMEM;for (i = 0; i < num_resets; i++)if (ret)return dev_err_probe(dev, ret, "failed to get resets\n" );return 0;static int qmp_usbc_clk_init(struct qmp_usbc *qmp)struct device *dev = qmp->dev;int num = ARRAY_SIZE(qmp_usbc_phy_clk_l);int i;sizeof (*qmp->clks), GFP_KERNEL);if (!qmp->clks)return -ENOMEM;for (i = 0; i < num; i++)return devm_clk_bulk_get_optional(dev, num, qmp->clks);static void phy_clk_release_provider(void *res)/* * Register a fixed rate pipe clock. * * The <s>_pipe_clksrc generated by PHY goes to the GCC that gate * controls it. The <s>_pipe_clk coming out of the GCC is requested * by the PHY driver for its operations. * We register the <s>_pipe_clksrc here. The gcc driver takes care * of assigning this <s>_pipe_clksrc as parent to <s>_pipe_clk. * Below picture shows this relationship. * * +---------------+ * | PHY block |<<---------------------------------------+ * | | | * | +-------+ | +-----+ | * I/P---^-->| PLL |---^--->pipe_clksrc--->| GCC |--->pipe_clk---+ * clk | +-------+ | +-----+ * +---------------+ static int phy_pipe_clk_register(struct qmp_usbc *qmp, struct device_node *np)struct clk_fixed_rate *fixed = &qmp->pipe_clk_fixed;struct clk_init_data init = { };int ret;"clock-output-names" , &init.name);if (ret) {"%pOFn: No clock-output-names\n" , np);return ret;/* controllers using QMP phys use 125MHz pipe clock interface */ if (ret)return ret;if (ret)return ret;/* * Roll a devm action because the clock provider is the child node, but * the child node is not actually a device. return devm_add_action_or_reset(qmp->dev, phy_clk_release_provider, np);#if IS_ENABLED(CONFIG_TYPEC)static int qmp_usbc_typec_switch_set(struct typec_switch_dev *sw,enum typec_orientation orientation)struct qmp_usbc *qmp = typec_switch_get_drvdata(sw);if (orientation == qmp->orientation || orientation == TYPEC_ORIENTATION_NONE)return 0;if (qmp->usb_init_count) {return 0;static void qmp_usbc_typec_unregister(void *data)struct qmp_usbc *qmp = data;static int qmp_usbc_typec_switch_register(struct qmp_usbc *qmp)struct typec_switch_desc sw_desc = {};struct device *dev = qmp->dev;if (IS_ERR(qmp->sw)) {"Unable to register typec switch: %pe\n" , qmp->sw);return PTR_ERR(qmp->sw);return devm_add_action_or_reset(dev, qmp_usbc_typec_unregister, qmp);#else static int qmp_usbc_typec_switch_register(struct qmp_usbc *qmp)return 0;#endif static int qmp_usbc_parse_dt_legacy(struct qmp_usbc *qmp, struct device_node *np)struct platform_device *pdev = to_platform_device(qmp->dev);struct device *dev = qmp->dev;int ret;if (IS_ERR(qmp->serdes))return PTR_ERR(qmp->serdes);/* * Get memory resources for the PHY: * Resources are indexed as: tx -> 0; rx -> 1; pcs -> 2. * For dual lane PHYs: tx2 -> 3, rx2 -> 4, pcs_misc (optional) -> 5 * For single lane PHYs: pcs_misc (optional) -> 3. if (IS_ERR(qmp->tx))return PTR_ERR(qmp->tx);if (IS_ERR(qmp->rx))return PTR_ERR(qmp->rx);if (IS_ERR(qmp->pcs))return PTR_ERR(qmp->pcs);if (IS_ERR(qmp->tx2))return PTR_ERR(qmp->tx2);if (IS_ERR(qmp->rx2))return PTR_ERR(qmp->rx2);if (IS_ERR(qmp->pcs_misc)) {"PHY pcs_misc-reg not used\n" );if (IS_ERR(qmp->pipe_clk)) {return dev_err_probe(dev, PTR_ERR(qmp->pipe_clk),"failed to get pipe clock\n" );if (ret < 0)return ret;if (ret)return ret;return 0;static int qmp_usbc_parse_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;struct device *dev = qmp->dev;void __iomem *base;int ret;if (!offs)return -EINVAL;if (IS_ERR(base))return PTR_ERR(base);if (offs->pcs_misc)if (ret)return ret;"pipe" );if (IS_ERR(qmp->pipe_clk)) {return dev_err_probe(dev, PTR_ERR(qmp->pipe_clk),"failed to get pipe clock\n" );if (ret)return ret;return 0;static int qmp_usbc_parse_vls_clamp(struct qmp_usbc *qmp)struct of_phandle_args tcsr_args;struct device *dev = qmp->dev;int ret;/* for backwards compatibility ignore if there is no property */ "qcom,tcsr-reg" , 1, 0,if (ret == -ENOENT)return 0;else if (ret < 0)return dev_err_probe(dev, ret, "Failed to parse qcom,tcsr-reg\n" );if (IS_ERR(qmp->tcsr_map))return PTR_ERR(qmp->tcsr_map);return 0;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;int ret;sizeof (*qmp), GFP_KERNEL);if (!qmp)return -ENOMEM;if (!qmp->cfg)return -EINVAL;if (ret)return ret;if (ret)return ret;if (ret)return ret;/* Check for legacy binding with child node. */ "phy" );if (np) {else {if (ret)goto err_node_put;if (ret)goto err_node_put;/* * Prevent runtime pm from being ON by default. Users can enable * it using power/control in sysfs. if (ret)goto err_node_put;if (IS_ERR(qmp->phy)) {"failed to create PHY: %d\n" , ret);goto err_node_put;return PTR_ERR_OR_ZERO(phy_provider);return ret;static const struct of_device_id qmp_usbc_of_match_table[] = {"qcom,msm8998-qmp-usb3-phy" ,"qcom,qcm2290-qmp-usb3-phy" ,"qcom,qcs615-qmp-usb3-phy" ,"qcom,sdm660-qmp-usb3-phy" ,"qcom,sm6115-qmp-usb3-phy" ,static struct platform_driver qmp_usbc_driver = {"qcom-qmp-usbc-phy" ,"Vivek Gautam " );"Qualcomm QMP USB-C PHY driver" );"GPL" );
Messung V0.5 C=97 H=95 G=95
¤ Dauer der Verarbeitung: 0.9 Sekunden
¤ *© Formatika GbR, Deutschland
