162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only 262306a36Sopenharmony_ci 362306a36Sopenharmony_ci#include <linux/clk.h> 462306a36Sopenharmony_ci#include <linux/err.h> 562306a36Sopenharmony_ci#include <linux/io.h> 662306a36Sopenharmony_ci#include <linux/module.h> 762306a36Sopenharmony_ci#include <linux/of.h> 862306a36Sopenharmony_ci#include <linux/phy/phy.h> 962306a36Sopenharmony_ci#include <linux/platform_device.h> 1062306a36Sopenharmony_ci#include <linux/delay.h> 1162306a36Sopenharmony_ci#include <linux/regmap.h> 1262306a36Sopenharmony_ci#include <linux/mfd/syscon.h> 1362306a36Sopenharmony_ci#include <linux/bitfield.h> 1462306a36Sopenharmony_ci 1562306a36Sopenharmony_ci/* USB QSCRATCH Hardware registers */ 1662306a36Sopenharmony_ci#define QSCRATCH_GENERAL_CFG (0x08) 1762306a36Sopenharmony_ci#define HSUSB_PHY_CTRL_REG (0x10) 1862306a36Sopenharmony_ci 1962306a36Sopenharmony_ci/* PHY_CTRL_REG */ 2062306a36Sopenharmony_ci#define HSUSB_CTRL_DMSEHV_CLAMP BIT(24) 2162306a36Sopenharmony_ci#define HSUSB_CTRL_USB2_SUSPEND BIT(23) 2262306a36Sopenharmony_ci#define HSUSB_CTRL_UTMI_CLK_EN BIT(21) 2362306a36Sopenharmony_ci#define HSUSB_CTRL_UTMI_OTG_VBUS_VALID BIT(20) 2462306a36Sopenharmony_ci#define HSUSB_CTRL_USE_CLKCORE BIT(18) 2562306a36Sopenharmony_ci#define HSUSB_CTRL_DPSEHV_CLAMP BIT(17) 2662306a36Sopenharmony_ci#define HSUSB_CTRL_COMMONONN BIT(11) 2762306a36Sopenharmony_ci#define HSUSB_CTRL_ID_HV_CLAMP BIT(9) 2862306a36Sopenharmony_ci#define HSUSB_CTRL_OTGSESSVLD_CLAMP BIT(8) 2962306a36Sopenharmony_ci#define HSUSB_CTRL_CLAMP_EN BIT(7) 3062306a36Sopenharmony_ci#define HSUSB_CTRL_RETENABLEN BIT(1) 3162306a36Sopenharmony_ci#define HSUSB_CTRL_POR BIT(0) 3262306a36Sopenharmony_ci 3362306a36Sopenharmony_ci/* QSCRATCH_GENERAL_CFG */ 3462306a36Sopenharmony_ci#define HSUSB_GCFG_XHCI_REV BIT(2) 3562306a36Sopenharmony_ci 3662306a36Sopenharmony_ci/* USB QSCRATCH Hardware registers */ 3762306a36Sopenharmony_ci#define SSUSB_PHY_CTRL_REG (0x00) 3862306a36Sopenharmony_ci#define SSUSB_PHY_PARAM_CTRL_1 (0x04) 3962306a36Sopenharmony_ci#define SSUSB_PHY_PARAM_CTRL_2 (0x08) 4062306a36Sopenharmony_ci#define CR_PROTOCOL_DATA_IN_REG (0x0c) 4162306a36Sopenharmony_ci#define CR_PROTOCOL_DATA_OUT_REG (0x10) 4262306a36Sopenharmony_ci#define CR_PROTOCOL_CAP_ADDR_REG (0x14) 4362306a36Sopenharmony_ci#define CR_PROTOCOL_CAP_DATA_REG (0x18) 4462306a36Sopenharmony_ci#define CR_PROTOCOL_READ_REG (0x1c) 4562306a36Sopenharmony_ci#define CR_PROTOCOL_WRITE_REG (0x20) 4662306a36Sopenharmony_ci 4762306a36Sopenharmony_ci/* PHY_CTRL_REG */ 4862306a36Sopenharmony_ci#define SSUSB_CTRL_REF_USE_PAD BIT(28) 4962306a36Sopenharmony_ci#define SSUSB_CTRL_TEST_POWERDOWN BIT(27) 5062306a36Sopenharmony_ci#define SSUSB_CTRL_LANE0_PWR_PRESENT BIT(24) 5162306a36Sopenharmony_ci#define SSUSB_CTRL_SS_PHY_EN BIT(8) 5262306a36Sopenharmony_ci#define SSUSB_CTRL_SS_PHY_RESET BIT(7) 5362306a36Sopenharmony_ci 5462306a36Sopenharmony_ci/* SSPHY control registers - Does this need 0x30? */ 5562306a36Sopenharmony_ci#define SSPHY_CTRL_RX_OVRD_IN_HI(lane) (0x1006 + 0x100 * (lane)) 5662306a36Sopenharmony_ci#define SSPHY_CTRL_TX_OVRD_DRV_LO(lane) (0x1002 + 0x100 * (lane)) 5762306a36Sopenharmony_ci 5862306a36Sopenharmony_ci/* SSPHY SoC version specific values */ 5962306a36Sopenharmony_ci#define SSPHY_RX_EQ_VALUE 4 /* Override value for rx_eq */ 6062306a36Sopenharmony_ci/* Override value for transmit preemphasis */ 6162306a36Sopenharmony_ci#define SSPHY_TX_DEEMPH_3_5DB 23 6262306a36Sopenharmony_ci/* Override value for mpll */ 6362306a36Sopenharmony_ci#define SSPHY_MPLL_VALUE 0 6462306a36Sopenharmony_ci 6562306a36Sopenharmony_ci/* QSCRATCH PHY_PARAM_CTRL1 fields */ 6662306a36Sopenharmony_ci#define PHY_PARAM_CTRL1_TX_FULL_SWING_MASK GENMASK(26, 19) 6762306a36Sopenharmony_ci#define PHY_PARAM_CTRL1_TX_DEEMPH_6DB_MASK GENMASK(19, 13) 6862306a36Sopenharmony_ci#define PHY_PARAM_CTRL1_TX_DEEMPH_3_5DB_MASK GENMASK(13, 7) 6962306a36Sopenharmony_ci#define PHY_PARAM_CTRL1_LOS_BIAS_MASK GENMASK(7, 2) 7062306a36Sopenharmony_ci 7162306a36Sopenharmony_ci#define PHY_PARAM_CTRL1_MASK \ 7262306a36Sopenharmony_ci (PHY_PARAM_CTRL1_TX_FULL_SWING_MASK | \ 7362306a36Sopenharmony_ci PHY_PARAM_CTRL1_TX_DEEMPH_6DB_MASK | \ 7462306a36Sopenharmony_ci PHY_PARAM_CTRL1_TX_DEEMPH_3_5DB_MASK | \ 7562306a36Sopenharmony_ci PHY_PARAM_CTRL1_LOS_BIAS_MASK) 7662306a36Sopenharmony_ci 7762306a36Sopenharmony_ci#define PHY_PARAM_CTRL1_TX_FULL_SWING(x) \ 7862306a36Sopenharmony_ci FIELD_PREP(PHY_PARAM_CTRL1_TX_FULL_SWING_MASK, (x)) 7962306a36Sopenharmony_ci#define PHY_PARAM_CTRL1_TX_DEEMPH_6DB(x) \ 8062306a36Sopenharmony_ci FIELD_PREP(PHY_PARAM_CTRL1_TX_DEEMPH_6DB_MASK, (x)) 8162306a36Sopenharmony_ci#define PHY_PARAM_CTRL1_TX_DEEMPH_3_5DB(x) \ 8262306a36Sopenharmony_ci FIELD_PREP(PHY_PARAM_CTRL1_TX_DEEMPH_3_5DB_MASK, x) 8362306a36Sopenharmony_ci#define PHY_PARAM_CTRL1_LOS_BIAS(x) \ 8462306a36Sopenharmony_ci FIELD_PREP(PHY_PARAM_CTRL1_LOS_BIAS_MASK, (x)) 8562306a36Sopenharmony_ci 8662306a36Sopenharmony_ci/* RX OVRD IN HI bits */ 8762306a36Sopenharmony_ci#define RX_OVRD_IN_HI_RX_RESET_OVRD BIT(13) 8862306a36Sopenharmony_ci#define RX_OVRD_IN_HI_RX_RX_RESET BIT(12) 8962306a36Sopenharmony_ci#define RX_OVRD_IN_HI_RX_EQ_OVRD BIT(11) 9062306a36Sopenharmony_ci#define RX_OVRD_IN_HI_RX_EQ_MASK GENMASK(10, 7) 9162306a36Sopenharmony_ci#define RX_OVRD_IN_HI_RX_EQ(x) FIELD_PREP(RX_OVRD_IN_HI_RX_EQ_MASK, (x)) 9262306a36Sopenharmony_ci#define RX_OVRD_IN_HI_RX_EQ_EN_OVRD BIT(7) 9362306a36Sopenharmony_ci#define RX_OVRD_IN_HI_RX_EQ_EN BIT(6) 9462306a36Sopenharmony_ci#define RX_OVRD_IN_HI_RX_LOS_FILTER_OVRD BIT(5) 9562306a36Sopenharmony_ci#define RX_OVRD_IN_HI_RX_LOS_FILTER_MASK GENMASK(4, 2) 9662306a36Sopenharmony_ci#define RX_OVRD_IN_HI_RX_RATE_OVRD BIT(2) 9762306a36Sopenharmony_ci#define RX_OVRD_IN_HI_RX_RATE_MASK GENMASK(2, 0) 9862306a36Sopenharmony_ci 9962306a36Sopenharmony_ci/* TX OVRD DRV LO register bits */ 10062306a36Sopenharmony_ci#define TX_OVRD_DRV_LO_AMPLITUDE_MASK GENMASK(6, 0) 10162306a36Sopenharmony_ci#define TX_OVRD_DRV_LO_PREEMPH_MASK GENMASK(13, 6) 10262306a36Sopenharmony_ci#define TX_OVRD_DRV_LO_PREEMPH(x) ((x) << 7) 10362306a36Sopenharmony_ci#define TX_OVRD_DRV_LO_EN BIT(14) 10462306a36Sopenharmony_ci 10562306a36Sopenharmony_ci/* MPLL bits */ 10662306a36Sopenharmony_ci#define SSPHY_MPLL_MASK GENMASK(8, 5) 10762306a36Sopenharmony_ci#define SSPHY_MPLL(x) ((x) << 5) 10862306a36Sopenharmony_ci 10962306a36Sopenharmony_ci/* SS CAP register bits */ 11062306a36Sopenharmony_ci#define SS_CR_CAP_ADDR_REG BIT(0) 11162306a36Sopenharmony_ci#define SS_CR_CAP_DATA_REG BIT(0) 11262306a36Sopenharmony_ci#define SS_CR_READ_REG BIT(0) 11362306a36Sopenharmony_ci#define SS_CR_WRITE_REG BIT(0) 11462306a36Sopenharmony_ci 11562306a36Sopenharmony_ci#define LATCH_SLEEP 40 11662306a36Sopenharmony_ci#define LATCH_TIMEOUT 100 11762306a36Sopenharmony_ci 11862306a36Sopenharmony_cistruct usb_phy { 11962306a36Sopenharmony_ci void __iomem *base; 12062306a36Sopenharmony_ci struct device *dev; 12162306a36Sopenharmony_ci struct clk *xo_clk; 12262306a36Sopenharmony_ci struct clk *ref_clk; 12362306a36Sopenharmony_ci u32 rx_eq; 12462306a36Sopenharmony_ci u32 tx_deamp_3_5db; 12562306a36Sopenharmony_ci u32 mpll; 12662306a36Sopenharmony_ci}; 12762306a36Sopenharmony_ci 12862306a36Sopenharmony_cistruct phy_drvdata { 12962306a36Sopenharmony_ci struct phy_ops ops; 13062306a36Sopenharmony_ci u32 clk_rate; 13162306a36Sopenharmony_ci}; 13262306a36Sopenharmony_ci 13362306a36Sopenharmony_ci/** 13462306a36Sopenharmony_ci * usb_phy_write_readback() - Write register and read back masked value to 13562306a36Sopenharmony_ci * confirm it is written 13662306a36Sopenharmony_ci * 13762306a36Sopenharmony_ci * @phy_dwc3: QCOM DWC3 phy context 13862306a36Sopenharmony_ci * @offset: register offset. 13962306a36Sopenharmony_ci * @mask: register bitmask specifying what should be updated 14062306a36Sopenharmony_ci * @val: value to write. 14162306a36Sopenharmony_ci */ 14262306a36Sopenharmony_cistatic inline void usb_phy_write_readback(struct usb_phy *phy_dwc3, 14362306a36Sopenharmony_ci u32 offset, 14462306a36Sopenharmony_ci const u32 mask, u32 val) 14562306a36Sopenharmony_ci{ 14662306a36Sopenharmony_ci u32 write_val, tmp = readl(phy_dwc3->base + offset); 14762306a36Sopenharmony_ci 14862306a36Sopenharmony_ci tmp &= ~mask; /* retain other bits */ 14962306a36Sopenharmony_ci write_val = tmp | val; 15062306a36Sopenharmony_ci 15162306a36Sopenharmony_ci writel(write_val, phy_dwc3->base + offset); 15262306a36Sopenharmony_ci 15362306a36Sopenharmony_ci /* Read back to see if val was written */ 15462306a36Sopenharmony_ci tmp = readl(phy_dwc3->base + offset); 15562306a36Sopenharmony_ci tmp &= mask; /* clear other bits */ 15662306a36Sopenharmony_ci 15762306a36Sopenharmony_ci if (tmp != val) 15862306a36Sopenharmony_ci dev_err(phy_dwc3->dev, "write: %x to QSCRATCH: %x FAILED\n", val, offset); 15962306a36Sopenharmony_ci} 16062306a36Sopenharmony_ci 16162306a36Sopenharmony_cistatic int wait_for_latch(void __iomem *addr) 16262306a36Sopenharmony_ci{ 16362306a36Sopenharmony_ci u32 val; 16462306a36Sopenharmony_ci 16562306a36Sopenharmony_ci return readl_poll_timeout(addr, val, !val, LATCH_SLEEP, LATCH_TIMEOUT); 16662306a36Sopenharmony_ci} 16762306a36Sopenharmony_ci 16862306a36Sopenharmony_ci/** 16962306a36Sopenharmony_ci * usb_ss_write_phycreg() - Write SSPHY register 17062306a36Sopenharmony_ci * 17162306a36Sopenharmony_ci * @phy_dwc3: QCOM DWC3 phy context 17262306a36Sopenharmony_ci * @addr: SSPHY address to write. 17362306a36Sopenharmony_ci * @val: value to write. 17462306a36Sopenharmony_ci */ 17562306a36Sopenharmony_cistatic int usb_ss_write_phycreg(struct usb_phy *phy_dwc3, 17662306a36Sopenharmony_ci u32 addr, u32 val) 17762306a36Sopenharmony_ci{ 17862306a36Sopenharmony_ci int ret; 17962306a36Sopenharmony_ci 18062306a36Sopenharmony_ci writel(addr, phy_dwc3->base + CR_PROTOCOL_DATA_IN_REG); 18162306a36Sopenharmony_ci writel(SS_CR_CAP_ADDR_REG, 18262306a36Sopenharmony_ci phy_dwc3->base + CR_PROTOCOL_CAP_ADDR_REG); 18362306a36Sopenharmony_ci 18462306a36Sopenharmony_ci ret = wait_for_latch(phy_dwc3->base + CR_PROTOCOL_CAP_ADDR_REG); 18562306a36Sopenharmony_ci if (ret) 18662306a36Sopenharmony_ci goto err_wait; 18762306a36Sopenharmony_ci 18862306a36Sopenharmony_ci writel(val, phy_dwc3->base + CR_PROTOCOL_DATA_IN_REG); 18962306a36Sopenharmony_ci writel(SS_CR_CAP_DATA_REG, 19062306a36Sopenharmony_ci phy_dwc3->base + CR_PROTOCOL_CAP_DATA_REG); 19162306a36Sopenharmony_ci 19262306a36Sopenharmony_ci ret = wait_for_latch(phy_dwc3->base + CR_PROTOCOL_CAP_DATA_REG); 19362306a36Sopenharmony_ci if (ret) 19462306a36Sopenharmony_ci goto err_wait; 19562306a36Sopenharmony_ci 19662306a36Sopenharmony_ci writel(SS_CR_WRITE_REG, phy_dwc3->base + CR_PROTOCOL_WRITE_REG); 19762306a36Sopenharmony_ci 19862306a36Sopenharmony_ci ret = wait_for_latch(phy_dwc3->base + CR_PROTOCOL_WRITE_REG); 19962306a36Sopenharmony_ci 20062306a36Sopenharmony_cierr_wait: 20162306a36Sopenharmony_ci if (ret) 20262306a36Sopenharmony_ci dev_err(phy_dwc3->dev, "timeout waiting for latch\n"); 20362306a36Sopenharmony_ci return ret; 20462306a36Sopenharmony_ci} 20562306a36Sopenharmony_ci 20662306a36Sopenharmony_ci/** 20762306a36Sopenharmony_ci * usb_ss_read_phycreg() - Read SSPHY register. 20862306a36Sopenharmony_ci * 20962306a36Sopenharmony_ci * @phy_dwc3: QCOM DWC3 phy context 21062306a36Sopenharmony_ci * @addr: SSPHY address to read. 21162306a36Sopenharmony_ci * @val: pointer in which read is store. 21262306a36Sopenharmony_ci */ 21362306a36Sopenharmony_cistatic int usb_ss_read_phycreg(struct usb_phy *phy_dwc3, 21462306a36Sopenharmony_ci u32 addr, u32 *val) 21562306a36Sopenharmony_ci{ 21662306a36Sopenharmony_ci int ret; 21762306a36Sopenharmony_ci 21862306a36Sopenharmony_ci writel(addr, phy_dwc3->base + CR_PROTOCOL_DATA_IN_REG); 21962306a36Sopenharmony_ci writel(SS_CR_CAP_ADDR_REG, 22062306a36Sopenharmony_ci phy_dwc3->base + CR_PROTOCOL_CAP_ADDR_REG); 22162306a36Sopenharmony_ci 22262306a36Sopenharmony_ci ret = wait_for_latch(phy_dwc3->base + CR_PROTOCOL_CAP_ADDR_REG); 22362306a36Sopenharmony_ci if (ret) 22462306a36Sopenharmony_ci goto err_wait; 22562306a36Sopenharmony_ci 22662306a36Sopenharmony_ci /* 22762306a36Sopenharmony_ci * Due to hardware bug, first read of SSPHY register might be 22862306a36Sopenharmony_ci * incorrect. Hence as workaround, SW should perform SSPHY register 22962306a36Sopenharmony_ci * read twice, but use only second read and ignore first read. 23062306a36Sopenharmony_ci */ 23162306a36Sopenharmony_ci writel(SS_CR_READ_REG, phy_dwc3->base + CR_PROTOCOL_READ_REG); 23262306a36Sopenharmony_ci 23362306a36Sopenharmony_ci ret = wait_for_latch(phy_dwc3->base + CR_PROTOCOL_READ_REG); 23462306a36Sopenharmony_ci if (ret) 23562306a36Sopenharmony_ci goto err_wait; 23662306a36Sopenharmony_ci 23762306a36Sopenharmony_ci /* throwaway read */ 23862306a36Sopenharmony_ci readl(phy_dwc3->base + CR_PROTOCOL_DATA_OUT_REG); 23962306a36Sopenharmony_ci 24062306a36Sopenharmony_ci writel(SS_CR_READ_REG, phy_dwc3->base + CR_PROTOCOL_READ_REG); 24162306a36Sopenharmony_ci 24262306a36Sopenharmony_ci ret = wait_for_latch(phy_dwc3->base + CR_PROTOCOL_READ_REG); 24362306a36Sopenharmony_ci if (ret) 24462306a36Sopenharmony_ci goto err_wait; 24562306a36Sopenharmony_ci 24662306a36Sopenharmony_ci *val = readl(phy_dwc3->base + CR_PROTOCOL_DATA_OUT_REG); 24762306a36Sopenharmony_ci 24862306a36Sopenharmony_cierr_wait: 24962306a36Sopenharmony_ci return ret; 25062306a36Sopenharmony_ci} 25162306a36Sopenharmony_ci 25262306a36Sopenharmony_cistatic int qcom_ipq806x_usb_hs_phy_init(struct phy *phy) 25362306a36Sopenharmony_ci{ 25462306a36Sopenharmony_ci struct usb_phy *phy_dwc3 = phy_get_drvdata(phy); 25562306a36Sopenharmony_ci int ret; 25662306a36Sopenharmony_ci u32 val; 25762306a36Sopenharmony_ci 25862306a36Sopenharmony_ci ret = clk_prepare_enable(phy_dwc3->xo_clk); 25962306a36Sopenharmony_ci if (ret) 26062306a36Sopenharmony_ci return ret; 26162306a36Sopenharmony_ci 26262306a36Sopenharmony_ci ret = clk_prepare_enable(phy_dwc3->ref_clk); 26362306a36Sopenharmony_ci if (ret) { 26462306a36Sopenharmony_ci clk_disable_unprepare(phy_dwc3->xo_clk); 26562306a36Sopenharmony_ci return ret; 26662306a36Sopenharmony_ci } 26762306a36Sopenharmony_ci 26862306a36Sopenharmony_ci /* 26962306a36Sopenharmony_ci * HSPHY Initialization: Enable UTMI clock, select 19.2MHz fsel 27062306a36Sopenharmony_ci * enable clamping, and disable RETENTION (power-on default is ENABLED) 27162306a36Sopenharmony_ci */ 27262306a36Sopenharmony_ci val = HSUSB_CTRL_DPSEHV_CLAMP | HSUSB_CTRL_DMSEHV_CLAMP | 27362306a36Sopenharmony_ci HSUSB_CTRL_RETENABLEN | HSUSB_CTRL_COMMONONN | 27462306a36Sopenharmony_ci HSUSB_CTRL_OTGSESSVLD_CLAMP | HSUSB_CTRL_ID_HV_CLAMP | 27562306a36Sopenharmony_ci HSUSB_CTRL_UTMI_OTG_VBUS_VALID | HSUSB_CTRL_UTMI_CLK_EN | 27662306a36Sopenharmony_ci HSUSB_CTRL_CLAMP_EN | 0x70; 27762306a36Sopenharmony_ci 27862306a36Sopenharmony_ci /* use core clock if external reference is not present */ 27962306a36Sopenharmony_ci if (!phy_dwc3->xo_clk) 28062306a36Sopenharmony_ci val |= HSUSB_CTRL_USE_CLKCORE; 28162306a36Sopenharmony_ci 28262306a36Sopenharmony_ci writel(val, phy_dwc3->base + HSUSB_PHY_CTRL_REG); 28362306a36Sopenharmony_ci usleep_range(2000, 2200); 28462306a36Sopenharmony_ci 28562306a36Sopenharmony_ci /* Disable (bypass) VBUS and ID filters */ 28662306a36Sopenharmony_ci writel(HSUSB_GCFG_XHCI_REV, phy_dwc3->base + QSCRATCH_GENERAL_CFG); 28762306a36Sopenharmony_ci 28862306a36Sopenharmony_ci return 0; 28962306a36Sopenharmony_ci} 29062306a36Sopenharmony_ci 29162306a36Sopenharmony_cistatic int qcom_ipq806x_usb_hs_phy_exit(struct phy *phy) 29262306a36Sopenharmony_ci{ 29362306a36Sopenharmony_ci struct usb_phy *phy_dwc3 = phy_get_drvdata(phy); 29462306a36Sopenharmony_ci 29562306a36Sopenharmony_ci clk_disable_unprepare(phy_dwc3->ref_clk); 29662306a36Sopenharmony_ci clk_disable_unprepare(phy_dwc3->xo_clk); 29762306a36Sopenharmony_ci 29862306a36Sopenharmony_ci return 0; 29962306a36Sopenharmony_ci} 30062306a36Sopenharmony_ci 30162306a36Sopenharmony_cistatic int qcom_ipq806x_usb_ss_phy_init(struct phy *phy) 30262306a36Sopenharmony_ci{ 30362306a36Sopenharmony_ci struct usb_phy *phy_dwc3 = phy_get_drvdata(phy); 30462306a36Sopenharmony_ci int ret; 30562306a36Sopenharmony_ci u32 data; 30662306a36Sopenharmony_ci 30762306a36Sopenharmony_ci ret = clk_prepare_enable(phy_dwc3->xo_clk); 30862306a36Sopenharmony_ci if (ret) 30962306a36Sopenharmony_ci return ret; 31062306a36Sopenharmony_ci 31162306a36Sopenharmony_ci ret = clk_prepare_enable(phy_dwc3->ref_clk); 31262306a36Sopenharmony_ci if (ret) { 31362306a36Sopenharmony_ci clk_disable_unprepare(phy_dwc3->xo_clk); 31462306a36Sopenharmony_ci return ret; 31562306a36Sopenharmony_ci } 31662306a36Sopenharmony_ci 31762306a36Sopenharmony_ci /* reset phy */ 31862306a36Sopenharmony_ci data = readl(phy_dwc3->base + SSUSB_PHY_CTRL_REG); 31962306a36Sopenharmony_ci writel(data | SSUSB_CTRL_SS_PHY_RESET, 32062306a36Sopenharmony_ci phy_dwc3->base + SSUSB_PHY_CTRL_REG); 32162306a36Sopenharmony_ci usleep_range(2000, 2200); 32262306a36Sopenharmony_ci writel(data, phy_dwc3->base + SSUSB_PHY_CTRL_REG); 32362306a36Sopenharmony_ci 32462306a36Sopenharmony_ci /* clear REF_PAD if we don't have XO clk */ 32562306a36Sopenharmony_ci if (!phy_dwc3->xo_clk) 32662306a36Sopenharmony_ci data &= ~SSUSB_CTRL_REF_USE_PAD; 32762306a36Sopenharmony_ci else 32862306a36Sopenharmony_ci data |= SSUSB_CTRL_REF_USE_PAD; 32962306a36Sopenharmony_ci 33062306a36Sopenharmony_ci writel(data, phy_dwc3->base + SSUSB_PHY_CTRL_REG); 33162306a36Sopenharmony_ci 33262306a36Sopenharmony_ci /* wait for ref clk to become stable, this can take up to 30ms */ 33362306a36Sopenharmony_ci msleep(30); 33462306a36Sopenharmony_ci 33562306a36Sopenharmony_ci data |= SSUSB_CTRL_SS_PHY_EN | SSUSB_CTRL_LANE0_PWR_PRESENT; 33662306a36Sopenharmony_ci writel(data, phy_dwc3->base + SSUSB_PHY_CTRL_REG); 33762306a36Sopenharmony_ci 33862306a36Sopenharmony_ci /* 33962306a36Sopenharmony_ci * WORKAROUND: There is SSPHY suspend bug due to which USB enumerates 34062306a36Sopenharmony_ci * in HS mode instead of SS mode. Workaround it by asserting 34162306a36Sopenharmony_ci * LANE0.TX_ALT_BLOCK.EN_ALT_BUS to enable TX to use alt bus mode 34262306a36Sopenharmony_ci */ 34362306a36Sopenharmony_ci ret = usb_ss_read_phycreg(phy_dwc3, 0x102D, &data); 34462306a36Sopenharmony_ci if (ret) 34562306a36Sopenharmony_ci goto err_phy_trans; 34662306a36Sopenharmony_ci 34762306a36Sopenharmony_ci data |= (1 << 7); 34862306a36Sopenharmony_ci ret = usb_ss_write_phycreg(phy_dwc3, 0x102D, data); 34962306a36Sopenharmony_ci if (ret) 35062306a36Sopenharmony_ci goto err_phy_trans; 35162306a36Sopenharmony_ci 35262306a36Sopenharmony_ci ret = usb_ss_read_phycreg(phy_dwc3, 0x1010, &data); 35362306a36Sopenharmony_ci if (ret) 35462306a36Sopenharmony_ci goto err_phy_trans; 35562306a36Sopenharmony_ci 35662306a36Sopenharmony_ci data &= ~0xff0; 35762306a36Sopenharmony_ci data |= 0x20; 35862306a36Sopenharmony_ci ret = usb_ss_write_phycreg(phy_dwc3, 0x1010, data); 35962306a36Sopenharmony_ci if (ret) 36062306a36Sopenharmony_ci goto err_phy_trans; 36162306a36Sopenharmony_ci 36262306a36Sopenharmony_ci /* 36362306a36Sopenharmony_ci * Fix RX Equalization setting as follows 36462306a36Sopenharmony_ci * LANE0.RX_OVRD_IN_HI. RX_EQ_EN set to 0 36562306a36Sopenharmony_ci * LANE0.RX_OVRD_IN_HI.RX_EQ_EN_OVRD set to 1 36662306a36Sopenharmony_ci * LANE0.RX_OVRD_IN_HI.RX_EQ set based on SoC version 36762306a36Sopenharmony_ci * LANE0.RX_OVRD_IN_HI.RX_EQ_OVRD set to 1 36862306a36Sopenharmony_ci */ 36962306a36Sopenharmony_ci ret = usb_ss_read_phycreg(phy_dwc3, SSPHY_CTRL_RX_OVRD_IN_HI(0), &data); 37062306a36Sopenharmony_ci if (ret) 37162306a36Sopenharmony_ci goto err_phy_trans; 37262306a36Sopenharmony_ci 37362306a36Sopenharmony_ci data &= ~RX_OVRD_IN_HI_RX_EQ_EN; 37462306a36Sopenharmony_ci data |= RX_OVRD_IN_HI_RX_EQ_EN_OVRD; 37562306a36Sopenharmony_ci data &= ~RX_OVRD_IN_HI_RX_EQ_MASK; 37662306a36Sopenharmony_ci data |= RX_OVRD_IN_HI_RX_EQ(phy_dwc3->rx_eq); 37762306a36Sopenharmony_ci data |= RX_OVRD_IN_HI_RX_EQ_OVRD; 37862306a36Sopenharmony_ci ret = usb_ss_write_phycreg(phy_dwc3, 37962306a36Sopenharmony_ci SSPHY_CTRL_RX_OVRD_IN_HI(0), data); 38062306a36Sopenharmony_ci if (ret) 38162306a36Sopenharmony_ci goto err_phy_trans; 38262306a36Sopenharmony_ci 38362306a36Sopenharmony_ci /* 38462306a36Sopenharmony_ci * Set EQ and TX launch amplitudes as follows 38562306a36Sopenharmony_ci * LANE0.TX_OVRD_DRV_LO.PREEMPH set based on SoC version 38662306a36Sopenharmony_ci * LANE0.TX_OVRD_DRV_LO.AMPLITUDE set to 110 38762306a36Sopenharmony_ci * LANE0.TX_OVRD_DRV_LO.EN set to 1. 38862306a36Sopenharmony_ci */ 38962306a36Sopenharmony_ci ret = usb_ss_read_phycreg(phy_dwc3, 39062306a36Sopenharmony_ci SSPHY_CTRL_TX_OVRD_DRV_LO(0), &data); 39162306a36Sopenharmony_ci if (ret) 39262306a36Sopenharmony_ci goto err_phy_trans; 39362306a36Sopenharmony_ci 39462306a36Sopenharmony_ci data &= ~TX_OVRD_DRV_LO_PREEMPH_MASK; 39562306a36Sopenharmony_ci data |= TX_OVRD_DRV_LO_PREEMPH(phy_dwc3->tx_deamp_3_5db); 39662306a36Sopenharmony_ci data &= ~TX_OVRD_DRV_LO_AMPLITUDE_MASK; 39762306a36Sopenharmony_ci data |= 0x6E; 39862306a36Sopenharmony_ci data |= TX_OVRD_DRV_LO_EN; 39962306a36Sopenharmony_ci ret = usb_ss_write_phycreg(phy_dwc3, 40062306a36Sopenharmony_ci SSPHY_CTRL_TX_OVRD_DRV_LO(0), data); 40162306a36Sopenharmony_ci if (ret) 40262306a36Sopenharmony_ci goto err_phy_trans; 40362306a36Sopenharmony_ci 40462306a36Sopenharmony_ci data = 0; 40562306a36Sopenharmony_ci data &= ~SSPHY_MPLL_MASK; 40662306a36Sopenharmony_ci data |= SSPHY_MPLL(phy_dwc3->mpll); 40762306a36Sopenharmony_ci usb_ss_write_phycreg(phy_dwc3, 0x30, data); 40862306a36Sopenharmony_ci 40962306a36Sopenharmony_ci /* 41062306a36Sopenharmony_ci * Set the QSCRATCH PHY_PARAM_CTRL1 parameters as follows 41162306a36Sopenharmony_ci * TX_FULL_SWING [26:20] amplitude to 110 41262306a36Sopenharmony_ci * TX_DEEMPH_6DB [19:14] to 32 41362306a36Sopenharmony_ci * TX_DEEMPH_3_5DB [13:8] set based on SoC version 41462306a36Sopenharmony_ci * LOS_BIAS [7:3] to 9 41562306a36Sopenharmony_ci */ 41662306a36Sopenharmony_ci data = readl(phy_dwc3->base + SSUSB_PHY_PARAM_CTRL_1); 41762306a36Sopenharmony_ci 41862306a36Sopenharmony_ci data &= ~PHY_PARAM_CTRL1_MASK; 41962306a36Sopenharmony_ci 42062306a36Sopenharmony_ci data |= PHY_PARAM_CTRL1_TX_FULL_SWING(0x6e) | 42162306a36Sopenharmony_ci PHY_PARAM_CTRL1_TX_DEEMPH_6DB(0x20) | 42262306a36Sopenharmony_ci PHY_PARAM_CTRL1_TX_DEEMPH_3_5DB(phy_dwc3->tx_deamp_3_5db) | 42362306a36Sopenharmony_ci PHY_PARAM_CTRL1_LOS_BIAS(0x9); 42462306a36Sopenharmony_ci 42562306a36Sopenharmony_ci usb_phy_write_readback(phy_dwc3, SSUSB_PHY_PARAM_CTRL_1, 42662306a36Sopenharmony_ci PHY_PARAM_CTRL1_MASK, data); 42762306a36Sopenharmony_ci 42862306a36Sopenharmony_cierr_phy_trans: 42962306a36Sopenharmony_ci return ret; 43062306a36Sopenharmony_ci} 43162306a36Sopenharmony_ci 43262306a36Sopenharmony_cistatic int qcom_ipq806x_usb_ss_phy_exit(struct phy *phy) 43362306a36Sopenharmony_ci{ 43462306a36Sopenharmony_ci struct usb_phy *phy_dwc3 = phy_get_drvdata(phy); 43562306a36Sopenharmony_ci 43662306a36Sopenharmony_ci /* Sequence to put SSPHY in low power state: 43762306a36Sopenharmony_ci * 1. Clear REF_PHY_EN in PHY_CTRL_REG 43862306a36Sopenharmony_ci * 2. Clear REF_USE_PAD in PHY_CTRL_REG 43962306a36Sopenharmony_ci * 3. Set TEST_POWERED_DOWN in PHY_CTRL_REG to enable PHY retention 44062306a36Sopenharmony_ci */ 44162306a36Sopenharmony_ci usb_phy_write_readback(phy_dwc3, SSUSB_PHY_CTRL_REG, 44262306a36Sopenharmony_ci SSUSB_CTRL_SS_PHY_EN, 0x0); 44362306a36Sopenharmony_ci usb_phy_write_readback(phy_dwc3, SSUSB_PHY_CTRL_REG, 44462306a36Sopenharmony_ci SSUSB_CTRL_REF_USE_PAD, 0x0); 44562306a36Sopenharmony_ci usb_phy_write_readback(phy_dwc3, SSUSB_PHY_CTRL_REG, 44662306a36Sopenharmony_ci SSUSB_CTRL_TEST_POWERDOWN, 0x0); 44762306a36Sopenharmony_ci 44862306a36Sopenharmony_ci clk_disable_unprepare(phy_dwc3->ref_clk); 44962306a36Sopenharmony_ci clk_disable_unprepare(phy_dwc3->xo_clk); 45062306a36Sopenharmony_ci 45162306a36Sopenharmony_ci return 0; 45262306a36Sopenharmony_ci} 45362306a36Sopenharmony_ci 45462306a36Sopenharmony_cistatic const struct phy_drvdata qcom_ipq806x_usb_hs_drvdata = { 45562306a36Sopenharmony_ci .ops = { 45662306a36Sopenharmony_ci .init = qcom_ipq806x_usb_hs_phy_init, 45762306a36Sopenharmony_ci .exit = qcom_ipq806x_usb_hs_phy_exit, 45862306a36Sopenharmony_ci .owner = THIS_MODULE, 45962306a36Sopenharmony_ci }, 46062306a36Sopenharmony_ci .clk_rate = 60000000, 46162306a36Sopenharmony_ci}; 46262306a36Sopenharmony_ci 46362306a36Sopenharmony_cistatic const struct phy_drvdata qcom_ipq806x_usb_ss_drvdata = { 46462306a36Sopenharmony_ci .ops = { 46562306a36Sopenharmony_ci .init = qcom_ipq806x_usb_ss_phy_init, 46662306a36Sopenharmony_ci .exit = qcom_ipq806x_usb_ss_phy_exit, 46762306a36Sopenharmony_ci .owner = THIS_MODULE, 46862306a36Sopenharmony_ci }, 46962306a36Sopenharmony_ci .clk_rate = 125000000, 47062306a36Sopenharmony_ci}; 47162306a36Sopenharmony_ci 47262306a36Sopenharmony_cistatic const struct of_device_id qcom_ipq806x_usb_phy_table[] = { 47362306a36Sopenharmony_ci { .compatible = "qcom,ipq806x-usb-phy-hs", 47462306a36Sopenharmony_ci .data = &qcom_ipq806x_usb_hs_drvdata }, 47562306a36Sopenharmony_ci { .compatible = "qcom,ipq806x-usb-phy-ss", 47662306a36Sopenharmony_ci .data = &qcom_ipq806x_usb_ss_drvdata }, 47762306a36Sopenharmony_ci { /* Sentinel */ } 47862306a36Sopenharmony_ci}; 47962306a36Sopenharmony_ciMODULE_DEVICE_TABLE(of, qcom_ipq806x_usb_phy_table); 48062306a36Sopenharmony_ci 48162306a36Sopenharmony_cistatic int qcom_ipq806x_usb_phy_probe(struct platform_device *pdev) 48262306a36Sopenharmony_ci{ 48362306a36Sopenharmony_ci struct resource *res; 48462306a36Sopenharmony_ci resource_size_t size; 48562306a36Sopenharmony_ci struct phy *generic_phy; 48662306a36Sopenharmony_ci struct usb_phy *phy_dwc3; 48762306a36Sopenharmony_ci const struct phy_drvdata *data; 48862306a36Sopenharmony_ci struct phy_provider *phy_provider; 48962306a36Sopenharmony_ci 49062306a36Sopenharmony_ci phy_dwc3 = devm_kzalloc(&pdev->dev, sizeof(*phy_dwc3), GFP_KERNEL); 49162306a36Sopenharmony_ci if (!phy_dwc3) 49262306a36Sopenharmony_ci return -ENOMEM; 49362306a36Sopenharmony_ci 49462306a36Sopenharmony_ci data = of_device_get_match_data(&pdev->dev); 49562306a36Sopenharmony_ci 49662306a36Sopenharmony_ci phy_dwc3->dev = &pdev->dev; 49762306a36Sopenharmony_ci 49862306a36Sopenharmony_ci res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 49962306a36Sopenharmony_ci if (!res) 50062306a36Sopenharmony_ci return -EINVAL; 50162306a36Sopenharmony_ci size = resource_size(res); 50262306a36Sopenharmony_ci phy_dwc3->base = devm_ioremap(phy_dwc3->dev, res->start, size); 50362306a36Sopenharmony_ci 50462306a36Sopenharmony_ci if (!phy_dwc3->base) { 50562306a36Sopenharmony_ci dev_err(phy_dwc3->dev, "failed to map reg\n"); 50662306a36Sopenharmony_ci return -ENOMEM; 50762306a36Sopenharmony_ci } 50862306a36Sopenharmony_ci 50962306a36Sopenharmony_ci phy_dwc3->ref_clk = devm_clk_get(phy_dwc3->dev, "ref"); 51062306a36Sopenharmony_ci if (IS_ERR(phy_dwc3->ref_clk)) { 51162306a36Sopenharmony_ci dev_dbg(phy_dwc3->dev, "cannot get reference clock\n"); 51262306a36Sopenharmony_ci return PTR_ERR(phy_dwc3->ref_clk); 51362306a36Sopenharmony_ci } 51462306a36Sopenharmony_ci 51562306a36Sopenharmony_ci clk_set_rate(phy_dwc3->ref_clk, data->clk_rate); 51662306a36Sopenharmony_ci 51762306a36Sopenharmony_ci phy_dwc3->xo_clk = devm_clk_get(phy_dwc3->dev, "xo"); 51862306a36Sopenharmony_ci if (IS_ERR(phy_dwc3->xo_clk)) { 51962306a36Sopenharmony_ci dev_dbg(phy_dwc3->dev, "cannot get TCXO clock\n"); 52062306a36Sopenharmony_ci phy_dwc3->xo_clk = NULL; 52162306a36Sopenharmony_ci } 52262306a36Sopenharmony_ci 52362306a36Sopenharmony_ci /* Parse device node to probe HSIO settings */ 52462306a36Sopenharmony_ci if (device_property_read_u32(&pdev->dev, "qcom,rx-eq", 52562306a36Sopenharmony_ci &phy_dwc3->rx_eq)) 52662306a36Sopenharmony_ci phy_dwc3->rx_eq = SSPHY_RX_EQ_VALUE; 52762306a36Sopenharmony_ci 52862306a36Sopenharmony_ci if (device_property_read_u32(&pdev->dev, "qcom,tx-deamp_3_5db", 52962306a36Sopenharmony_ci &phy_dwc3->tx_deamp_3_5db)) 53062306a36Sopenharmony_ci phy_dwc3->tx_deamp_3_5db = SSPHY_TX_DEEMPH_3_5DB; 53162306a36Sopenharmony_ci 53262306a36Sopenharmony_ci if (device_property_read_u32(&pdev->dev, "qcom,mpll", &phy_dwc3->mpll)) 53362306a36Sopenharmony_ci phy_dwc3->mpll = SSPHY_MPLL_VALUE; 53462306a36Sopenharmony_ci 53562306a36Sopenharmony_ci generic_phy = devm_phy_create(phy_dwc3->dev, pdev->dev.of_node, &data->ops); 53662306a36Sopenharmony_ci 53762306a36Sopenharmony_ci if (IS_ERR(generic_phy)) 53862306a36Sopenharmony_ci return PTR_ERR(generic_phy); 53962306a36Sopenharmony_ci 54062306a36Sopenharmony_ci phy_set_drvdata(generic_phy, phy_dwc3); 54162306a36Sopenharmony_ci platform_set_drvdata(pdev, phy_dwc3); 54262306a36Sopenharmony_ci 54362306a36Sopenharmony_ci phy_provider = devm_of_phy_provider_register(phy_dwc3->dev, 54462306a36Sopenharmony_ci of_phy_simple_xlate); 54562306a36Sopenharmony_ci 54662306a36Sopenharmony_ci if (IS_ERR(phy_provider)) 54762306a36Sopenharmony_ci return PTR_ERR(phy_provider); 54862306a36Sopenharmony_ci 54962306a36Sopenharmony_ci return 0; 55062306a36Sopenharmony_ci} 55162306a36Sopenharmony_ci 55262306a36Sopenharmony_cistatic struct platform_driver qcom_ipq806x_usb_phy_driver = { 55362306a36Sopenharmony_ci .probe = qcom_ipq806x_usb_phy_probe, 55462306a36Sopenharmony_ci .driver = { 55562306a36Sopenharmony_ci .name = "qcom-ipq806x-usb-phy", 55662306a36Sopenharmony_ci .of_match_table = qcom_ipq806x_usb_phy_table, 55762306a36Sopenharmony_ci }, 55862306a36Sopenharmony_ci}; 55962306a36Sopenharmony_ci 56062306a36Sopenharmony_cimodule_platform_driver(qcom_ipq806x_usb_phy_driver); 56162306a36Sopenharmony_ci 56262306a36Sopenharmony_ciMODULE_ALIAS("platform:phy-qcom-ipq806x-usb"); 56362306a36Sopenharmony_ciMODULE_LICENSE("GPL v2"); 56462306a36Sopenharmony_ciMODULE_AUTHOR("Andy Gross <agross@codeaurora.org>"); 56562306a36Sopenharmony_ciMODULE_AUTHOR("Ivan T. Ivanov <iivanov@mm-sol.com>"); 56662306a36Sopenharmony_ciMODULE_DESCRIPTION("DesignWare USB3 QCOM PHY driver"); 567