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