// SPDX-License-Identifier: GPL-2.0 /* * Copyright (c) 2017, 2019, The Linux Foundation. All rights reserved. */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #define QUSB2PHY_PLL_TEST 0x04 #define CLK_REF_SEL BIT(7) #define QUSB2PHY_PLL_TUNE 0x08 #define QUSB2PHY_PLL_USER_CTL1 0x0c #define QUSB2PHY_PLL_USER_CTL2 0x10 #define QUSB2PHY_PLL_AUTOPGM_CTL1 0x1c #define QUSB2PHY_PLL_PWR_CTRL 0x18 /* QUSB2PHY_PLL_STATUS register bits */ #define PLL_LOCKED BIT(5) /* QUSB2PHY_PLL_COMMON_STATUS_ONE register bits */ #define CORE_READY_STATUS BIT(0) /* QUSB2PHY_PORT_POWERDOWN register bits */ #define CLAMP_N_EN BIT(5) #define FREEZIO_N BIT(1) #define POWER_DOWN BIT(0) /* QUSB2PHY_PWR_CTRL1 register bits */ #define PWR_CTRL1_VREF_SUPPLY_TRIM BIT(5) #define PWR_CTRL1_CLAMP_N_EN BIT(1) #define QUSB2PHY_REFCLK_ENABLE BIT(0) #define PHY_CLK_SCHEME_SEL BIT(0) /* QUSB2PHY_INTR_CTRL register bits */ #define DMSE_INTR_HIGH_SEL BIT(4) #define DPSE_INTR_HIGH_SEL BIT(3) #define CHG_DET_INTR_EN BIT(2) #define DMSE_INTR_EN BIT(1) #define DPSE_INTR_EN BIT(0) /* QUSB2PHY_PLL_CORE_INPUT_OVERRIDE register bits */ #define CORE_PLL_EN_FROM_RESET BIT(4) #define CORE_RESET BIT(5) #define CORE_RESET_MUX BIT(6) /* QUSB2PHY_IMP_CTRL1 register bits */ #define IMP_RES_OFFSET_MASK GENMASK(5, 0) #define IMP_RES_OFFSET_SHIFT 0x0 /* QUSB2PHY_PORT_TUNE1 register bits */ #define HSTX_TRIM_MASK GENMASK(7, 4) #define HSTX_TRIM_SHIFT 0x4 #define PREEMPH_WIDTH_HALF_BIT BIT(2) #define PREEMPHASIS_EN_MASK GENMASK(1, 0) #define PREEMPHASIS_EN_SHIFT 0x0 #define QUSB2PHY_PLL_ANALOG_CONTROLS_TWO 0x04 #define QUSB2PHY_PLL_CLOCK_INVERTERS 0x18c #define QUSB2PHY_PLL_CMODE 0x2c #define QUSB2PHY_PLL_LOCK_DELAY 0x184 #define QUSB2PHY_PLL_DIGITAL_TIMERS_TWO 0xb4 #define QUSB2PHY_PLL_BIAS_CONTROL_1 0x194 #define QUSB2PHY_PLL_BIAS_CONTROL_2 0x198 #define QUSB2PHY_PWR_CTRL2 0x214 #define QUSB2PHY_IMP_CTRL1 0x220 #define QUSB2PHY_IMP_CTRL2 0x224 #define QUSB2PHY_CHG_CTRL2 0x23c struct qusb2_phy_init_tbl { unsigned int offset; unsigned int val; /* * register part of layout ? * if yes, then offset gives index in the reg-layout */ int in_layout; }; #define QUSB2_PHY_INIT_CFG(o, v) \ { \ .offset = o, \ .val = v, \ } #define QUSB2_PHY_INIT_CFG_L(o, v) \ { \ .offset = o, \ .val = v, \ .in_layout = 1, \ } /* set of registers with offsets different per-PHY */ enum qusb2phy_reg_layout { QUSB2PHY_PLL_CORE_INPUT_OVERRIDE, QUSB2PHY_PLL_STATUS, QUSB2PHY_PORT_TUNE1, QUSB2PHY_PORT_TUNE2, QUSB2PHY_PORT_TUNE3, QUSB2PHY_PORT_TUNE4, QUSB2PHY_PORT_TUNE5, QUSB2PHY_PORT_TEST1, QUSB2PHY_PORT_TEST2, QUSB2PHY_PORT_POWERDOWN, QUSB2PHY_INTR_CTRL, }; static const unsigned int msm8996_regs_layout[] = { [QUSB2PHY_PLL_STATUS] = 0x38, [QUSB2PHY_PORT_TUNE1] = 0x80, [QUSB2PHY_PORT_TUNE2] = 0x84, [QUSB2PHY_PORT_TUNE3] = 0x88, [QUSB2PHY_PORT_TUNE4] = 0x8c, [QUSB2PHY_PORT_TUNE5] = 0x90, [QUSB2PHY_PORT_TEST1] = 0xb8, [QUSB2PHY_PORT_TEST2] = 0x9c, [QUSB2PHY_PORT_POWERDOWN] = 0xb4, [QUSB2PHY_INTR_CTRL] = 0xbc, }; static const struct qusb2_phy_init_tbl msm8996_init_tbl[] = { QUSB2_PHY_INIT_CFG_L(QUSB2PHY_PORT_TUNE1, 0xf8), QUSB2_PHY_INIT_CFG_L(QUSB2PHY_PORT_TUNE2, 0xb3), QUSB2_PHY_INIT_CFG_L(QUSB2PHY_PORT_TUNE3, 0x83), QUSB2_PHY_INIT_CFG_L(QUSB2PHY_PORT_TUNE4, 0xc0), QUSB2_PHY_INIT_CFG(QUSB2PHY_PLL_TUNE, 0x30), QUSB2_PHY_INIT_CFG(QUSB2PHY_PLL_USER_CTL1, 0x79), QUSB2_PHY_INIT_CFG(QUSB2PHY_PLL_USER_CTL2, 0x21), QUSB2_PHY_INIT_CFG_L(QUSB2PHY_PORT_TEST2, 0x14), QUSB2_PHY_INIT_CFG(QUSB2PHY_PLL_AUTOPGM_CTL1, 0x9f), QUSB2_PHY_INIT_CFG(QUSB2PHY_PLL_PWR_CTRL, 0x00), }; static const unsigned int msm8998_regs_layout[] = { [QUSB2PHY_PLL_CORE_INPUT_OVERRIDE] = 0xa8, [QUSB2PHY_PLL_STATUS] = 0x1a0, [QUSB2PHY_PORT_TUNE1] = 0x23c, [QUSB2PHY_PORT_TUNE2] = 0x240, [QUSB2PHY_PORT_TUNE3] = 0x244, [QUSB2PHY_PORT_TUNE4] = 0x248, [QUSB2PHY_PORT_TEST1] = 0x24c, [QUSB2PHY_PORT_TEST2] = 0x250, [QUSB2PHY_PORT_POWERDOWN] = 0x210, [QUSB2PHY_INTR_CTRL] = 0x22c, }; static const struct qusb2_phy_init_tbl msm8998_init_tbl[] = { QUSB2_PHY_INIT_CFG(QUSB2PHY_PLL_ANALOG_CONTROLS_TWO, 0x13), QUSB2_PHY_INIT_CFG(QUSB2PHY_PLL_CLOCK_INVERTERS, 0x7c), QUSB2_PHY_INIT_CFG(QUSB2PHY_PLL_CMODE, 0x80), QUSB2_PHY_INIT_CFG(QUSB2PHY_PLL_LOCK_DELAY, 0x0a), QUSB2_PHY_INIT_CFG_L(QUSB2PHY_PORT_TUNE1, 0xa5), QUSB2_PHY_INIT_CFG_L(QUSB2PHY_PORT_TUNE2, 0x09), QUSB2_PHY_INIT_CFG(QUSB2PHY_PLL_DIGITAL_TIMERS_TWO, 0x19), }; static const unsigned int qusb2_v2_regs_layout[] = { [QUSB2PHY_PLL_CORE_INPUT_OVERRIDE] = 0xa8, [QUSB2PHY_PLL_STATUS] = 0x1a0, [QUSB2PHY_PORT_TUNE1] = 0x240, [QUSB2PHY_PORT_TUNE2] = 0x244, [QUSB2PHY_PORT_TUNE3] = 0x248, [QUSB2PHY_PORT_TUNE4] = 0x24c, [QUSB2PHY_PORT_TUNE5] = 0x250, [QUSB2PHY_PORT_TEST1] = 0x254, [QUSB2PHY_PORT_TEST2] = 0x258, [QUSB2PHY_PORT_POWERDOWN] = 0x210, [QUSB2PHY_INTR_CTRL] = 0x230, }; static const struct qusb2_phy_init_tbl qusb2_v2_init_tbl[] = { QUSB2_PHY_INIT_CFG(QUSB2PHY_PLL_ANALOG_CONTROLS_TWO, 0x03), QUSB2_PHY_INIT_CFG(QUSB2PHY_PLL_CLOCK_INVERTERS, 0x7c), QUSB2_PHY_INIT_CFG(QUSB2PHY_PLL_CMODE, 0x80), QUSB2_PHY_INIT_CFG(QUSB2PHY_PLL_LOCK_DELAY, 0x0a), QUSB2_PHY_INIT_CFG(QUSB2PHY_PLL_DIGITAL_TIMERS_TWO, 0x19), QUSB2_PHY_INIT_CFG(QUSB2PHY_PLL_BIAS_CONTROL_1, 0x40), QUSB2_PHY_INIT_CFG(QUSB2PHY_PLL_BIAS_CONTROL_2, 0x20), QUSB2_PHY_INIT_CFG(QUSB2PHY_PWR_CTRL2, 0x21), QUSB2_PHY_INIT_CFG(QUSB2PHY_IMP_CTRL1, 0x0), QUSB2_PHY_INIT_CFG(QUSB2PHY_IMP_CTRL2, 0x58), QUSB2_PHY_INIT_CFG_L(QUSB2PHY_PORT_TUNE1, 0x30), QUSB2_PHY_INIT_CFG_L(QUSB2PHY_PORT_TUNE2, 0x29), QUSB2_PHY_INIT_CFG_L(QUSB2PHY_PORT_TUNE3, 0xca), QUSB2_PHY_INIT_CFG_L(QUSB2PHY_PORT_TUNE4, 0x04), QUSB2_PHY_INIT_CFG_L(QUSB2PHY_PORT_TUNE5, 0x03), QUSB2_PHY_INIT_CFG(QUSB2PHY_CHG_CTRL2, 0x0), }; struct qusb2_phy_cfg { const struct qusb2_phy_init_tbl *tbl; /* number of entries in the table */ unsigned int tbl_num; /* offset to PHY_CLK_SCHEME register in TCSR map */ unsigned int clk_scheme_offset; /* array of registers with different offsets */ const unsigned int *regs; unsigned int mask_core_ready; unsigned int disable_ctrl; unsigned int autoresume_en; /* true if PHY has PLL_TEST register to select clk_scheme */ bool has_pll_test; /* true if TUNE1 register must be updated by fused value, else TUNE2 */ bool update_tune1_with_efuse; /* true if PHY has PLL_CORE_INPUT_OVERRIDE register to reset PLL */ bool has_pll_override; }; static const struct qusb2_phy_cfg msm8996_phy_cfg = { .tbl = msm8996_init_tbl, .tbl_num = ARRAY_SIZE(msm8996_init_tbl), .regs = msm8996_regs_layout, .has_pll_test = true, .disable_ctrl = (CLAMP_N_EN | FREEZIO_N | POWER_DOWN), .mask_core_ready = PLL_LOCKED, .autoresume_en = BIT(3), }; static const struct qusb2_phy_cfg msm8998_phy_cfg = { .tbl = msm8998_init_tbl, .tbl_num = ARRAY_SIZE(msm8998_init_tbl), .regs = msm8998_regs_layout, .disable_ctrl = POWER_DOWN, .mask_core_ready = CORE_READY_STATUS, .has_pll_override = true, .autoresume_en = BIT(0), .update_tune1_with_efuse = true, }; static const struct qusb2_phy_cfg qusb2_v2_phy_cfg = { .tbl = qusb2_v2_init_tbl, .tbl_num = ARRAY_SIZE(qusb2_v2_init_tbl), .regs = qusb2_v2_regs_layout, .disable_ctrl = (PWR_CTRL1_VREF_SUPPLY_TRIM | PWR_CTRL1_CLAMP_N_EN | POWER_DOWN), .mask_core_ready = CORE_READY_STATUS, .has_pll_override = true, .autoresume_en = BIT(0), .update_tune1_with_efuse = true, }; static const char * const qusb2_phy_vreg_names[] = { "vdda-pll", "vdda-phy-dpdm", }; #define QUSB2_NUM_VREGS ARRAY_SIZE(qusb2_phy_vreg_names) /** * struct qusb2_phy - structure holding qusb2 phy attributes * * @phy: generic phy * @base: iomapped memory space for qubs2 phy * * @cfg_ahb_clk: AHB2PHY interface clock * @ref_clk: phy reference clock * @iface_clk: phy interface clock * @phy_reset: phy reset control * @vregs: regulator supplies bulk data * * @tcsr: TCSR syscon register map * @cell: nvmem cell containing phy tuning value * * @override_imp_res_offset: PHY should use different rescode offset * @imp_res_offset_value: rescode offset to be updated in IMP_CTRL1 register * @override_hstx_trim: PHY should use different HSTX o/p current value * @hstx_trim_value: HSTX_TRIM value to be updated in TUNE1 register * @override_preemphasis: PHY should use different pre-amphasis amplitude * @preemphasis_level: Amplitude Pre-Emphasis to be updated in TUNE1 register * @override_preemphasis_width: PHY should use different pre-emphasis duration * @preemphasis_width: half/full-width Pre-Emphasis updated via TUNE1 * * @cfg: phy config data * @has_se_clk_scheme: indicate if PHY has single-ended ref clock scheme * @phy_initialized: indicate if PHY has been initialized * @mode: current PHY mode */ struct qusb2_phy { struct phy *phy; void __iomem *base; struct clk *cfg_ahb_clk; struct clk *ref_clk; struct clk *iface_clk; struct reset_control *phy_reset; struct regulator_bulk_data vregs[QUSB2_NUM_VREGS]; struct regmap *tcsr; struct nvmem_cell *cell; bool override_imp_res_offset; u8 imp_res_offset_value; bool override_hstx_trim; u8 hstx_trim_value; bool override_preemphasis; u8 preemphasis_level; bool override_preemphasis_width; u8 preemphasis_width; const struct qusb2_phy_cfg *cfg; bool has_se_clk_scheme; bool phy_initialized; enum phy_mode mode; }; static inline void qusb2_write_mask(void __iomem *base, u32 offset, u32 val, u32 mask) { u32 reg; reg = readl(base + offset); reg &= ~mask; reg |= val & mask; writel(reg, base + offset); /* Ensure above write is completed */ readl(base + offset); } static inline void qusb2_setbits(void __iomem *base, u32 offset, u32 val) { u32 reg; reg = readl(base + offset); reg |= val; writel(reg, base + offset); /* Ensure above write is completed */ readl(base + offset); } static inline void qusb2_clrbits(void __iomem *base, u32 offset, u32 val) { u32 reg; reg = readl(base + offset); reg &= ~val; writel(reg, base + offset); /* Ensure above write is completed */ readl(base + offset); } static inline void qcom_qusb2_phy_configure(void __iomem *base, const unsigned int *regs, const struct qusb2_phy_init_tbl tbl[], int num) { int i; for (i = 0; i < num; i++) { if (tbl[i].in_layout) writel(tbl[i].val, base + regs[tbl[i].offset]); else writel(tbl[i].val, base + tbl[i].offset); } } /* * Update board specific PHY tuning override values if specified from * device tree. */ static void qusb2_phy_override_phy_params(struct qusb2_phy *qphy) { const struct qusb2_phy_cfg *cfg = qphy->cfg; if (qphy->override_imp_res_offset) qusb2_write_mask(qphy->base, QUSB2PHY_IMP_CTRL1, qphy->imp_res_offset_value << IMP_RES_OFFSET_SHIFT, IMP_RES_OFFSET_MASK); if (qphy->override_hstx_trim) qusb2_write_mask(qphy->base, cfg->regs[QUSB2PHY_PORT_TUNE1], qphy->hstx_trim_value << HSTX_TRIM_SHIFT, HSTX_TRIM_MASK); if (qphy->override_preemphasis) qusb2_write_mask(qphy->base, cfg->regs[QUSB2PHY_PORT_TUNE1], qphy->preemphasis_level << PREEMPHASIS_EN_SHIFT, PREEMPHASIS_EN_MASK); if (qphy->override_preemphasis_width) { if (qphy->preemphasis_width == QUSB2_V2_PREEMPHASIS_WIDTH_HALF_BIT) qusb2_setbits(qphy->base, cfg->regs[QUSB2PHY_PORT_TUNE1], PREEMPH_WIDTH_HALF_BIT); else qusb2_clrbits(qphy->base, cfg->regs[QUSB2PHY_PORT_TUNE1], PREEMPH_WIDTH_HALF_BIT); } } /* * Fetches HS Tx tuning value from nvmem and sets the * QUSB2PHY_PORT_TUNE1/2 register. * For error case, skip setting the value and use the default value. */ static void qusb2_phy_set_tune2_param(struct qusb2_phy *qphy) { struct device *dev = &qphy->phy->dev; const struct qusb2_phy_cfg *cfg = qphy->cfg; u8 *val; /* efuse register is optional */ if (!qphy->cell) return; /* * Read efuse register having TUNE2/1 parameter's high nibble. * If efuse register shows value as 0x0 (indicating value is not * fused), or if we fail to find a valid efuse register setting, * then use default value for high nibble that we have already * set while configuring the phy. */ val = nvmem_cell_read(qphy->cell, NULL); if (IS_ERR(val) || !val[0]) { dev_dbg(dev, "failed to read a valid hs-tx trim value\n"); return; } /* Fused TUNE1/2 value is the higher nibble only */ if (cfg->update_tune1_with_efuse) qusb2_write_mask(qphy->base, cfg->regs[QUSB2PHY_PORT_TUNE1], val[0] << HSTX_TRIM_SHIFT, HSTX_TRIM_MASK); else qusb2_write_mask(qphy->base, cfg->regs[QUSB2PHY_PORT_TUNE2], val[0] << HSTX_TRIM_SHIFT, HSTX_TRIM_MASK); } static int qusb2_phy_set_mode(struct phy *phy, enum phy_mode mode, int submode) { struct qusb2_phy *qphy = phy_get_drvdata(phy); qphy->mode = mode; return 0; } static int __maybe_unused qusb2_phy_runtime_suspend(struct device *dev) { struct qusb2_phy *qphy = dev_get_drvdata(dev); const struct qusb2_phy_cfg *cfg = qphy->cfg; u32 intr_mask; dev_vdbg(dev, "Suspending QUSB2 Phy, mode:%d\n", qphy->mode); if (!qphy->phy_initialized) { dev_vdbg(dev, "PHY not initialized, bailing out\n"); return 0; } /* * Enable DP/DM interrupts to detect line state changes based on current * speed. In other words, enable the triggers _opposite_ of what the * current D+/D- levels are e.g. if currently D+ high, D- low * (HS 'J'/Suspend), configure the mask to trigger on D+ low OR D- high */ intr_mask = DPSE_INTR_EN | DMSE_INTR_EN; switch (qphy->mode) { case PHY_MODE_USB_HOST_HS: case PHY_MODE_USB_HOST_FS: case PHY_MODE_USB_DEVICE_HS: case PHY_MODE_USB_DEVICE_FS: intr_mask |= DMSE_INTR_HIGH_SEL; break; case PHY_MODE_USB_HOST_LS: case PHY_MODE_USB_DEVICE_LS: intr_mask |= DPSE_INTR_HIGH_SEL; break; default: /* No device connected, enable both DP/DM high interrupt */ intr_mask |= DMSE_INTR_HIGH_SEL; intr_mask |= DPSE_INTR_HIGH_SEL; break; } writel(intr_mask, qphy->base + cfg->regs[QUSB2PHY_INTR_CTRL]); /* hold core PLL into reset */ if (cfg->has_pll_override) { qusb2_setbits(qphy->base, cfg->regs[QUSB2PHY_PLL_CORE_INPUT_OVERRIDE], CORE_PLL_EN_FROM_RESET | CORE_RESET | CORE_RESET_MUX); } /* enable phy auto-resume only if device is connected on bus */ if (qphy->mode != PHY_MODE_INVALID) { qusb2_setbits(qphy->base, cfg->regs[QUSB2PHY_PORT_TEST1], cfg->autoresume_en); /* Autoresume bit has to be toggled in order to enable it */ qusb2_clrbits(qphy->base, cfg->regs[QUSB2PHY_PORT_TEST1], cfg->autoresume_en); } if (!qphy->has_se_clk_scheme) clk_disable_unprepare(qphy->ref_clk); clk_disable_unprepare(qphy->cfg_ahb_clk); clk_disable_unprepare(qphy->iface_clk); return 0; } static int __maybe_unused qusb2_phy_runtime_resume(struct device *dev) { struct qusb2_phy *qphy = dev_get_drvdata(dev); const struct qusb2_phy_cfg *cfg = qphy->cfg; int ret; dev_vdbg(dev, "Resuming QUSB2 phy, mode:%d\n", qphy->mode); if (!qphy->phy_initialized) { dev_vdbg(dev, "PHY not initialized, bailing out\n"); return 0; } ret = clk_prepare_enable(qphy->iface_clk); if (ret) { dev_err(dev, "failed to enable iface_clk, %d\n", ret); return ret; } ret = clk_prepare_enable(qphy->cfg_ahb_clk); if (ret) { dev_err(dev, "failed to enable cfg ahb clock, %d\n", ret); goto disable_iface_clk; } if (!qphy->has_se_clk_scheme) { ret = clk_prepare_enable(qphy->ref_clk); if (ret) { dev_err(dev, "failed to enable ref clk, %d\n", ret); goto disable_ahb_clk; } } writel(0x0, qphy->base + cfg->regs[QUSB2PHY_INTR_CTRL]); /* bring core PLL out of reset */ if (cfg->has_pll_override) { qusb2_clrbits(qphy->base, cfg->regs[QUSB2PHY_PLL_CORE_INPUT_OVERRIDE], CORE_RESET | CORE_RESET_MUX); } return 0; disable_ahb_clk: clk_disable_unprepare(qphy->cfg_ahb_clk); disable_iface_clk: clk_disable_unprepare(qphy->iface_clk); return ret; } static int qusb2_phy_init(struct phy *phy) { struct qusb2_phy *qphy = phy_get_drvdata(phy); const struct qusb2_phy_cfg *cfg = qphy->cfg; unsigned int val = 0; unsigned int clk_scheme; int ret; dev_vdbg(&phy->dev, "%s(): Initializing QUSB2 phy\n", __func__); /* turn on regulator supplies */ ret = regulator_bulk_enable(ARRAY_SIZE(qphy->vregs), qphy->vregs); if (ret) return ret; ret = clk_prepare_enable(qphy->iface_clk); if (ret) { dev_err(&phy->dev, "failed to enable iface_clk, %d\n", ret); goto poweroff_phy; } /* enable ahb interface clock to program phy */ ret = clk_prepare_enable(qphy->cfg_ahb_clk); if (ret) { dev_err(&phy->dev, "failed to enable cfg ahb clock, %d\n", ret); goto disable_iface_clk; } /* Perform phy reset */ ret = reset_control_assert(qphy->phy_reset); if (ret) { dev_err(&phy->dev, "failed to assert phy_reset, %d\n", ret); goto disable_ahb_clk; } /* 100 us delay to keep PHY in reset mode */ usleep_range(100, 150); ret = reset_control_deassert(qphy->phy_reset); if (ret) { dev_err(&phy->dev, "failed to de-assert phy_reset, %d\n", ret); goto disable_ahb_clk; } /* Disable the PHY */ qusb2_setbits(qphy->base, cfg->regs[QUSB2PHY_PORT_POWERDOWN], qphy->cfg->disable_ctrl); if (cfg->has_pll_test) { /* save reset value to override reference clock scheme later */ val = readl(qphy->base + QUSB2PHY_PLL_TEST); } qcom_qusb2_phy_configure(qphy->base, cfg->regs, cfg->tbl, cfg->tbl_num); /* Override board specific PHY tuning values */ qusb2_phy_override_phy_params(qphy); /* Set efuse value for tuning the PHY */ qusb2_phy_set_tune2_param(qphy); /* Enable the PHY */ qusb2_clrbits(qphy->base, cfg->regs[QUSB2PHY_PORT_POWERDOWN], POWER_DOWN); /* Required to get phy pll lock successfully */ usleep_range(150, 160); /* Default is single-ended clock on msm8996 */ qphy->has_se_clk_scheme = true; /* * read TCSR_PHY_CLK_SCHEME register to check if single-ended * clock scheme is selected. If yes, then disable differential * ref_clk and use single-ended clock, otherwise use differential * ref_clk only. */ if (qphy->tcsr) { ret = regmap_read(qphy->tcsr, qphy->cfg->clk_scheme_offset, &clk_scheme); if (ret) { dev_err(&phy->dev, "failed to read clk scheme reg\n"); goto assert_phy_reset; } /* is it a differential clock scheme ? */ if (!(clk_scheme & PHY_CLK_SCHEME_SEL)) { dev_vdbg(&phy->dev, "%s(): select differential clk\n", __func__); qphy->has_se_clk_scheme = false; } else { dev_vdbg(&phy->dev, "%s(): select single-ended clk\n", __func__); } } if (!qphy->has_se_clk_scheme) { ret = clk_prepare_enable(qphy->ref_clk); if (ret) { dev_err(&phy->dev, "failed to enable ref clk, %d\n", ret); goto assert_phy_reset; } } if (cfg->has_pll_test) { if (!qphy->has_se_clk_scheme) val &= ~CLK_REF_SEL; else val |= CLK_REF_SEL; writel(val, qphy->base + QUSB2PHY_PLL_TEST); /* ensure above write is through */ readl(qphy->base + QUSB2PHY_PLL_TEST); } /* Required to get phy pll lock successfully */ usleep_range(100, 110); val = readb(qphy->base + cfg->regs[QUSB2PHY_PLL_STATUS]); if (!(val & cfg->mask_core_ready)) { dev_err(&phy->dev, "QUSB2PHY pll lock failed: status reg = %x\n", val); ret = -EBUSY; goto disable_ref_clk; } qphy->phy_initialized = true; return 0; disable_ref_clk: if (!qphy->has_se_clk_scheme) clk_disable_unprepare(qphy->ref_clk); assert_phy_reset: reset_control_assert(qphy->phy_reset); disable_ahb_clk: clk_disable_unprepare(qphy->cfg_ahb_clk); disable_iface_clk: clk_disable_unprepare(qphy->iface_clk); poweroff_phy: regulator_bulk_disable(ARRAY_SIZE(qphy->vregs), qphy->vregs); return ret; } static int qusb2_phy_exit(struct phy *phy) { struct qusb2_phy *qphy = phy_get_drvdata(phy); /* Disable the PHY */ qusb2_setbits(qphy->base, qphy->cfg->regs[QUSB2PHY_PORT_POWERDOWN], qphy->cfg->disable_ctrl); if (!qphy->has_se_clk_scheme) clk_disable_unprepare(qphy->ref_clk); reset_control_assert(qphy->phy_reset); clk_disable_unprepare(qphy->cfg_ahb_clk); clk_disable_unprepare(qphy->iface_clk); regulator_bulk_disable(ARRAY_SIZE(qphy->vregs), qphy->vregs); qphy->phy_initialized = false; return 0; } static const struct phy_ops qusb2_phy_gen_ops = { .init = qusb2_phy_init, .exit = qusb2_phy_exit, .set_mode = qusb2_phy_set_mode, .owner = THIS_MODULE, }; static const struct of_device_id qusb2_phy_of_match_table[] = { { .compatible = "qcom,msm8996-qusb2-phy", .data = &msm8996_phy_cfg, }, { .compatible = "qcom,msm8998-qusb2-phy", .data = &msm8998_phy_cfg, }, { .compatible = "qcom,qusb2-v2-phy", .data = &qusb2_v2_phy_cfg, }, { }, }; MODULE_DEVICE_TABLE(of, qusb2_phy_of_match_table); static const struct dev_pm_ops qusb2_phy_pm_ops = { SET_RUNTIME_PM_OPS(qusb2_phy_runtime_suspend, qusb2_phy_runtime_resume, NULL) }; static int qusb2_phy_probe(struct platform_device *pdev) { struct device *dev = &pdev->dev; struct qusb2_phy *qphy; struct phy_provider *phy_provider; struct phy *generic_phy; struct resource *res; int ret, i; int num; u32 value; qphy = devm_kzalloc(dev, sizeof(*qphy), GFP_KERNEL); if (!qphy) return -ENOMEM; res = platform_get_resource(pdev, IORESOURCE_MEM, 0); qphy->base = devm_ioremap_resource(dev, res); if (IS_ERR(qphy->base)) return PTR_ERR(qphy->base); qphy->cfg_ahb_clk = devm_clk_get(dev, "cfg_ahb"); if (IS_ERR(qphy->cfg_ahb_clk)) { ret = PTR_ERR(qphy->cfg_ahb_clk); if (ret != -EPROBE_DEFER) dev_err(dev, "failed to get cfg ahb clk, %d\n", ret); return ret; } qphy->ref_clk = devm_clk_get(dev, "ref"); if (IS_ERR(qphy->ref_clk)) { ret = PTR_ERR(qphy->ref_clk); if (ret != -EPROBE_DEFER) dev_err(dev, "failed to get ref clk, %d\n", ret); return ret; } qphy->iface_clk = devm_clk_get_optional(dev, "iface"); if (IS_ERR(qphy->iface_clk)) return PTR_ERR(qphy->iface_clk); qphy->phy_reset = devm_reset_control_get_by_index(&pdev->dev, 0); if (IS_ERR(qphy->phy_reset)) { dev_err(dev, "failed to get phy core reset\n"); return PTR_ERR(qphy->phy_reset); } num = ARRAY_SIZE(qphy->vregs); for (i = 0; i < num; i++) qphy->vregs[i].supply = qusb2_phy_vreg_names[i]; ret = devm_regulator_bulk_get(dev, num, qphy->vregs); if (ret) { if (ret != -EPROBE_DEFER) dev_err(dev, "failed to get regulator supplies: %d\n", ret); return ret; } /* Get the specific init parameters of QMP phy */ qphy->cfg = of_device_get_match_data(dev); qphy->tcsr = syscon_regmap_lookup_by_phandle(dev->of_node, "qcom,tcsr-syscon"); if (IS_ERR(qphy->tcsr)) { dev_dbg(dev, "failed to lookup TCSR regmap\n"); qphy->tcsr = NULL; } qphy->cell = devm_nvmem_cell_get(dev, NULL); if (IS_ERR(qphy->cell)) { if (PTR_ERR(qphy->cell) == -EPROBE_DEFER) return -EPROBE_DEFER; qphy->cell = NULL; dev_dbg(dev, "failed to lookup tune2 hstx trim value\n"); } if (!of_property_read_u32(dev->of_node, "qcom,imp-res-offset-value", &value)) { qphy->imp_res_offset_value = (u8)value; qphy->override_imp_res_offset = true; } if (!of_property_read_u32(dev->of_node, "qcom,hstx-trim-value", &value)) { qphy->hstx_trim_value = (u8)value; qphy->override_hstx_trim = true; } if (!of_property_read_u32(dev->of_node, "qcom,preemphasis-level", &value)) { qphy->preemphasis_level = (u8)value; qphy->override_preemphasis = true; } if (!of_property_read_u32(dev->of_node, "qcom,preemphasis-width", &value)) { qphy->preemphasis_width = (u8)value; qphy->override_preemphasis_width = true; } pm_runtime_set_active(dev); pm_runtime_enable(dev); /* * Prevent runtime pm from being ON by default. Users can enable * it using power/control in sysfs. */ pm_runtime_forbid(dev); generic_phy = devm_phy_create(dev, NULL, &qusb2_phy_gen_ops); if (IS_ERR(generic_phy)) { ret = PTR_ERR(generic_phy); dev_err(dev, "failed to create phy, %d\n", ret); pm_runtime_disable(dev); return ret; } qphy->phy = generic_phy; dev_set_drvdata(dev, qphy); phy_set_drvdata(generic_phy, qphy); phy_provider = devm_of_phy_provider_register(dev, of_phy_simple_xlate); if (!IS_ERR(phy_provider)) dev_info(dev, "Registered Qcom-QUSB2 phy\n"); else pm_runtime_disable(dev); return PTR_ERR_OR_ZERO(phy_provider); } static struct platform_driver qusb2_phy_driver = { .probe = qusb2_phy_probe, .driver = { .name = "qcom-qusb2-phy", .pm = &qusb2_phy_pm_ops, .of_match_table = qusb2_phy_of_match_table, }, }; module_platform_driver(qusb2_phy_driver); MODULE_AUTHOR("Vivek Gautam "); MODULE_DESCRIPTION("Qualcomm QUSB2 PHY driver"); MODULE_LICENSE("GPL v2");