xref: /rk3399_rockchip-uboot/drivers/phy/phy-rockchip-naneng-combphy.c (revision 84b0fdcd9c7c9073104144b80e5f390f5fdc3197)
1925c5749SYifeng Zhao // SPDX-License-Identifier: GPL-2.0
2925c5749SYifeng Zhao /*
3925c5749SYifeng Zhao  * Rockchip USB3.0/PCIe Gen2/SATA/SGMII combphy driver
4925c5749SYifeng Zhao  *
5925c5749SYifeng Zhao  * Copyright (C) 2021 Rockchip Electronics Co., Ltd.
6925c5749SYifeng Zhao  */
7925c5749SYifeng Zhao 
8925c5749SYifeng Zhao #include <common.h>
9925c5749SYifeng Zhao #include <clk.h>
10925c5749SYifeng Zhao #include <dm.h>
11925c5749SYifeng Zhao #include <dm/lists.h>
129863b7ebSFrank Wang #include <dm/uclass-internal.h>
13925c5749SYifeng Zhao #include <dt-bindings/phy/phy.h>
14925c5749SYifeng Zhao #include <generic-phy.h>
15925c5749SYifeng Zhao #include <syscon.h>
16925c5749SYifeng Zhao #include <asm/io.h>
17925c5749SYifeng Zhao #include <asm/arch/clock.h>
18925c5749SYifeng Zhao #include <regmap.h>
19925c5749SYifeng Zhao #include <reset-uclass.h>
2014d5da7dSwilliam.wu #include <linux/iopoll.h>
21925c5749SYifeng Zhao 
22925c5749SYifeng Zhao #define BIT_WRITEABLE_SHIFT		16
23925c5749SYifeng Zhao 
24925c5749SYifeng Zhao struct rockchip_combphy_priv;
25925c5749SYifeng Zhao 
26925c5749SYifeng Zhao struct combphy_reg {
273452d642SJianwei Zheng 	u32 offset;
28925c5749SYifeng Zhao 	u16 bitend;
29925c5749SYifeng Zhao 	u16 bitstart;
30925c5749SYifeng Zhao 	u16 disable;
31925c5749SYifeng Zhao 	u16 enable;
32925c5749SYifeng Zhao };
33925c5749SYifeng Zhao 
34925c5749SYifeng Zhao struct rockchip_combphy_grfcfg {
35925c5749SYifeng Zhao 	struct combphy_reg pcie_mode_set;
36925c5749SYifeng Zhao 	struct combphy_reg usb_mode_set;
37925c5749SYifeng Zhao 	struct combphy_reg sgmii_mode_set;
38925c5749SYifeng Zhao 	struct combphy_reg qsgmii_mode_set;
39925c5749SYifeng Zhao 	struct combphy_reg pipe_rxterm_set;
40925c5749SYifeng Zhao 	struct combphy_reg pipe_txelec_set;
41925c5749SYifeng Zhao 	struct combphy_reg pipe_txcomp_set;
423452d642SJianwei Zheng 	struct combphy_reg pipe_clk_24m;
43925c5749SYifeng Zhao 	struct combphy_reg pipe_clk_25m;
44925c5749SYifeng Zhao 	struct combphy_reg pipe_clk_100m;
45925c5749SYifeng Zhao 	struct combphy_reg pipe_phymode_sel;
46925c5749SYifeng Zhao 	struct combphy_reg pipe_rate_sel;
47925c5749SYifeng Zhao 	struct combphy_reg pipe_rxterm_sel;
48925c5749SYifeng Zhao 	struct combphy_reg pipe_txelec_sel;
49925c5749SYifeng Zhao 	struct combphy_reg pipe_txcomp_sel;
50925c5749SYifeng Zhao 	struct combphy_reg pipe_clk_ext;
51925c5749SYifeng Zhao 	struct combphy_reg pipe_sel_usb;
52925c5749SYifeng Zhao 	struct combphy_reg pipe_sel_qsgmii;
53925c5749SYifeng Zhao 	struct combphy_reg pipe_phy_status;
54925c5749SYifeng Zhao 	struct combphy_reg con0_for_pcie;
55925c5749SYifeng Zhao 	struct combphy_reg con1_for_pcie;
56925c5749SYifeng Zhao 	struct combphy_reg con2_for_pcie;
57925c5749SYifeng Zhao 	struct combphy_reg con3_for_pcie;
58925c5749SYifeng Zhao 	struct combphy_reg con0_for_sata;
59925c5749SYifeng Zhao 	struct combphy_reg con1_for_sata;
60925c5749SYifeng Zhao 	struct combphy_reg con2_for_sata;
61925c5749SYifeng Zhao 	struct combphy_reg con3_for_sata;
62925c5749SYifeng Zhao 	struct combphy_reg pipe_con0_for_sata;
63cf3c44cbSJon Lin 	struct combphy_reg pipe_con1_for_sata;
64925c5749SYifeng Zhao 	struct combphy_reg pipe_sgmii_mac_sel;
65925c5749SYifeng Zhao 	struct combphy_reg pipe_xpcs_phy_ready;
66*84b0fdcdSFrank Wang 	struct combphy_reg u3otg0_clamp_dis;
67925c5749SYifeng Zhao 	struct combphy_reg u3otg0_port_en;
68925c5749SYifeng Zhao 	struct combphy_reg u3otg1_port_en;
6914d5da7dSwilliam.wu 	struct combphy_reg u3otg0_pipe_clk_sel;
7086b316b4SFrank Wang 	struct combphy_reg pipe_phy_grf_reset;
71925c5749SYifeng Zhao };
72925c5749SYifeng Zhao 
73925c5749SYifeng Zhao struct rockchip_combphy_cfg {
74925c5749SYifeng Zhao 	const struct rockchip_combphy_grfcfg *grfcfg;
75fb632bccSShawn Lin 	bool force_det_out; /* Tx detect Rx errata */
76925c5749SYifeng Zhao 	int (*combphy_cfg)(struct rockchip_combphy_priv *priv);
77925c5749SYifeng Zhao };
78925c5749SYifeng Zhao 
79925c5749SYifeng Zhao struct rockchip_combphy_priv {
80925c5749SYifeng Zhao 	u32 mode;
81925c5749SYifeng Zhao 	void __iomem *mmio;
82925c5749SYifeng Zhao 	struct udevice *dev;
83925c5749SYifeng Zhao 	struct regmap *pipe_grf;
84925c5749SYifeng Zhao 	struct regmap *phy_grf;
85925c5749SYifeng Zhao 	struct phy *phy;
86925c5749SYifeng Zhao 	struct reset_ctl phy_rst;
87925c5749SYifeng Zhao 	struct clk ref_clk;
88925c5749SYifeng Zhao 	const struct rockchip_combphy_cfg *cfg;
89925c5749SYifeng Zhao };
90925c5749SYifeng Zhao 
param_write(struct regmap * base,const struct combphy_reg * reg,bool en)91925c5749SYifeng Zhao static int param_write(struct regmap *base,
92925c5749SYifeng Zhao 		       const struct combphy_reg *reg, bool en)
93925c5749SYifeng Zhao {
94925c5749SYifeng Zhao 	u32 val, mask, tmp;
95925c5749SYifeng Zhao 
96925c5749SYifeng Zhao 	tmp = en ? reg->enable : reg->disable;
97925c5749SYifeng Zhao 	mask = GENMASK(reg->bitend, reg->bitstart);
98925c5749SYifeng Zhao 	val = (tmp << reg->bitstart) | (mask << BIT_WRITEABLE_SHIFT);
99925c5749SYifeng Zhao 
100925c5749SYifeng Zhao 	return regmap_write(base, reg->offset, val);
101925c5749SYifeng Zhao }
102925c5749SYifeng Zhao 
rockchip_combphy_is_ready(struct rockchip_combphy_priv * priv)10314d5da7dSwilliam.wu static u32 rockchip_combphy_is_ready(struct rockchip_combphy_priv *priv)
10414d5da7dSwilliam.wu {
10514d5da7dSwilliam.wu 	const struct rockchip_combphy_grfcfg *cfg = priv->cfg->grfcfg;
10614d5da7dSwilliam.wu 	u32 mask, val;
10714d5da7dSwilliam.wu 
10814d5da7dSwilliam.wu 	mask = GENMASK(cfg->pipe_phy_status.bitend,
10914d5da7dSwilliam.wu 		       cfg->pipe_phy_status.bitstart);
11014d5da7dSwilliam.wu 
11114d5da7dSwilliam.wu 	regmap_read(priv->phy_grf, cfg->pipe_phy_status.offset, &val);
11214d5da7dSwilliam.wu 	val = (val & mask) >> cfg->pipe_phy_status.bitstart;
11314d5da7dSwilliam.wu 
11414d5da7dSwilliam.wu 	return val;
11514d5da7dSwilliam.wu }
11614d5da7dSwilliam.wu 
rockchip_combphy_pcie_init(struct rockchip_combphy_priv * priv)117925c5749SYifeng Zhao static int rockchip_combphy_pcie_init(struct rockchip_combphy_priv *priv)
118925c5749SYifeng Zhao {
119925c5749SYifeng Zhao 	int ret = 0;
120fb632bccSShawn Lin 	u32 val;
121925c5749SYifeng Zhao 
122925c5749SYifeng Zhao 	if (priv->cfg->combphy_cfg) {
123925c5749SYifeng Zhao 		ret = priv->cfg->combphy_cfg(priv);
124925c5749SYifeng Zhao 		if (ret) {
125925c5749SYifeng Zhao 			dev_err(priv->dev, "failed to init phy for pcie\n");
126925c5749SYifeng Zhao 			return ret;
127925c5749SYifeng Zhao 		}
128925c5749SYifeng Zhao 	}
129925c5749SYifeng Zhao 
130fb632bccSShawn Lin 	if (priv->cfg->force_det_out) {
131fb632bccSShawn Lin 		val = readl(priv->mmio + (0x19 << 2));
132fb632bccSShawn Lin 		val |= BIT(5);
133fb632bccSShawn Lin 		writel(val, priv->mmio + (0x19 << 2));
134fb632bccSShawn Lin 	}
135fb632bccSShawn Lin 
136925c5749SYifeng Zhao 	return ret;
137925c5749SYifeng Zhao }
138925c5749SYifeng Zhao 
rockchip_combphy_usb3_init(struct rockchip_combphy_priv * priv)139925c5749SYifeng Zhao static int rockchip_combphy_usb3_init(struct rockchip_combphy_priv *priv)
140925c5749SYifeng Zhao {
141ac8e4a89SWilliam Wu 	const struct rockchip_combphy_grfcfg *cfg = priv->cfg->grfcfg;
142925c5749SYifeng Zhao 	int ret = 0;
143925c5749SYifeng Zhao 
144ac8e4a89SWilliam Wu 	if (dev_read_bool(priv->dev, "rockchip,dis-u3otg0-port")) {
145ac8e4a89SWilliam Wu 		ret = param_write(priv->pipe_grf, &cfg->u3otg0_port_en, false);
146ac8e4a89SWilliam Wu 		return ret;
147ac8e4a89SWilliam Wu 	} else if (dev_read_bool(priv->dev, "rockchip,dis-u3otg1-port")) {
148ac8e4a89SWilliam Wu 		param_write(priv->pipe_grf, &cfg->u3otg1_port_en, false);
149ac8e4a89SWilliam Wu #ifdef CONFIG_ROCKCHIP_RK3576
150ac8e4a89SWilliam Wu 		param_write(priv->phy_grf,  &cfg->usb_mode_set, true);
151ac8e4a89SWilliam Wu #endif
152ac8e4a89SWilliam Wu 		return ret;
153*84b0fdcdSFrank Wang 	} else {
154*84b0fdcdSFrank Wang 		if (cfg->u3otg0_clamp_dis.enable)
155*84b0fdcdSFrank Wang 			param_write(priv->pipe_grf, &cfg->u3otg0_clamp_dis, true);
156ac8e4a89SWilliam Wu 	}
157ac8e4a89SWilliam Wu 
158925c5749SYifeng Zhao 	if (priv->cfg->combphy_cfg) {
159925c5749SYifeng Zhao 		ret = priv->cfg->combphy_cfg(priv);
160925c5749SYifeng Zhao 		if (ret) {
161925c5749SYifeng Zhao 			dev_err(priv->dev, "failed to init phy for usb3\n");
162925c5749SYifeng Zhao 			return ret;
163925c5749SYifeng Zhao 		}
164925c5749SYifeng Zhao 	}
165925c5749SYifeng Zhao 
166925c5749SYifeng Zhao 	return ret;
167925c5749SYifeng Zhao }
168925c5749SYifeng Zhao 
rockchip_combphy_sata_init(struct rockchip_combphy_priv * priv)169925c5749SYifeng Zhao static int rockchip_combphy_sata_init(struct rockchip_combphy_priv *priv)
170925c5749SYifeng Zhao {
171925c5749SYifeng Zhao 	int ret = 0;
172925c5749SYifeng Zhao 
173925c5749SYifeng Zhao 	if (priv->cfg->combphy_cfg) {
174925c5749SYifeng Zhao 		ret = priv->cfg->combphy_cfg(priv);
175925c5749SYifeng Zhao 		if (ret) {
176925c5749SYifeng Zhao 			dev_err(priv->dev, "failed to init phy for sata\n");
177925c5749SYifeng Zhao 			return ret;
178925c5749SYifeng Zhao 		}
179925c5749SYifeng Zhao 	}
180925c5749SYifeng Zhao 
181925c5749SYifeng Zhao 	return ret;
182925c5749SYifeng Zhao }
183925c5749SYifeng Zhao 
rockchip_combphy_sgmii_init(struct rockchip_combphy_priv * priv)184925c5749SYifeng Zhao static int rockchip_combphy_sgmii_init(struct rockchip_combphy_priv *priv)
185925c5749SYifeng Zhao {
186925c5749SYifeng Zhao 	int ret = 0;
187925c5749SYifeng Zhao 
188925c5749SYifeng Zhao 	if (priv->cfg->combphy_cfg) {
189925c5749SYifeng Zhao 		ret = priv->cfg->combphy_cfg(priv);
190925c5749SYifeng Zhao 		if (ret) {
191925c5749SYifeng Zhao 			dev_err(priv->dev, "failed to init phy for sgmii\n");
192925c5749SYifeng Zhao 			return ret;
193925c5749SYifeng Zhao 		}
194925c5749SYifeng Zhao 	}
195925c5749SYifeng Zhao 
196925c5749SYifeng Zhao 	return ret;
197925c5749SYifeng Zhao }
198925c5749SYifeng Zhao 
rockchip_combphy_usb3_uboot_init(fdt_addr_t phy_addr)1999863b7ebSFrank Wang int rockchip_combphy_usb3_uboot_init(fdt_addr_t phy_addr)
20014d5da7dSwilliam.wu {
2019863b7ebSFrank Wang 	struct udevice *udev = NULL;
2029863b7ebSFrank Wang 	struct udevice *dev;
2039863b7ebSFrank Wang 	struct uclass *uc;
2049863b7ebSFrank Wang 	const struct driver *find_drv;
20514d5da7dSwilliam.wu 	struct rockchip_combphy_priv *priv;
20614d5da7dSwilliam.wu 	const struct rockchip_combphy_grfcfg *cfg;
20714d5da7dSwilliam.wu 	u32 val;
2089863b7ebSFrank Wang 	int ret = 0;
20914d5da7dSwilliam.wu 
2109863b7ebSFrank Wang 	ret = uclass_get(UCLASS_PHY, &uc);
2119863b7ebSFrank Wang 	if (ret)
2129863b7ebSFrank Wang 		return ret;
2139863b7ebSFrank Wang 
2149863b7ebSFrank Wang 	find_drv = DM_GET_DRIVER(rockchip_naneng_combphy);
2159863b7ebSFrank Wang 	list_for_each_entry(dev, &uc->dev_head, uclass_node) {
2169863b7ebSFrank Wang 		if (dev->driver == find_drv && dev_read_addr(dev) == phy_addr) {
2179863b7ebSFrank Wang 			ret = uclass_get_device_tail(dev, 0, &udev);
2189863b7ebSFrank Wang 			break;
2199863b7ebSFrank Wang 		}
2209863b7ebSFrank Wang 	}
2219863b7ebSFrank Wang 
2229863b7ebSFrank Wang 	if (!udev || ret) {
2239863b7ebSFrank Wang 		ret = ret ? ret : -ENODEV;
22414d5da7dSwilliam.wu 		pr_err("%s: get usb3-phy node failed: %d\n", __func__, ret);
22514d5da7dSwilliam.wu 		return ret;
22614d5da7dSwilliam.wu 	}
22714d5da7dSwilliam.wu 
22814d5da7dSwilliam.wu 	priv = dev_get_priv(udev);
22914d5da7dSwilliam.wu 	priv->mode = PHY_TYPE_USB3;
23014d5da7dSwilliam.wu 	cfg = priv->cfg->grfcfg;
23114d5da7dSwilliam.wu 
23214d5da7dSwilliam.wu 	rockchip_combphy_usb3_init(priv);
23314d5da7dSwilliam.wu 	reset_deassert(&priv->phy_rst);
23414d5da7dSwilliam.wu 
23514d5da7dSwilliam.wu 	if (cfg->pipe_phy_grf_reset.enable)
23614d5da7dSwilliam.wu 		param_write(priv->phy_grf, &cfg->pipe_phy_grf_reset, false);
23714d5da7dSwilliam.wu 
23814d5da7dSwilliam.wu 	if (priv->mode == PHY_TYPE_USB3) {
23914d5da7dSwilliam.wu 		ret = readx_poll_timeout(rockchip_combphy_is_ready,
24014d5da7dSwilliam.wu 					 priv, val,
24114d5da7dSwilliam.wu 					 val == cfg->pipe_phy_status.enable,
24214d5da7dSwilliam.wu 					 1000);
24314d5da7dSwilliam.wu 		if (ret) {
24414d5da7dSwilliam.wu 			dev_err(priv->dev, "wait phy status ready timeout\n");
24514d5da7dSwilliam.wu 			param_write(priv->phy_grf, &cfg->usb_mode_set, false);
24614d5da7dSwilliam.wu 			if (cfg->u3otg0_pipe_clk_sel.disable)
24714d5da7dSwilliam.wu 				param_write(priv->phy_grf, &cfg->u3otg0_pipe_clk_sel, false);
24814d5da7dSwilliam.wu 			return ret;
24914d5da7dSwilliam.wu 		}
25014d5da7dSwilliam.wu 	}
25114d5da7dSwilliam.wu 
25214d5da7dSwilliam.wu 	/* Select clk_usb3otg0_pipe for source clk */
25314d5da7dSwilliam.wu 	if (cfg->u3otg0_pipe_clk_sel.disable)
25414d5da7dSwilliam.wu 		param_write(priv->phy_grf, &cfg->u3otg0_pipe_clk_sel, true);
25514d5da7dSwilliam.wu 
25614d5da7dSwilliam.wu 	return ret;
25714d5da7dSwilliam.wu }
25814d5da7dSwilliam.wu 
rockchip_combphy_set_mode(struct rockchip_combphy_priv * priv)259925c5749SYifeng Zhao static int rockchip_combphy_set_mode(struct rockchip_combphy_priv *priv)
260925c5749SYifeng Zhao {
261925c5749SYifeng Zhao 	switch (priv->mode) {
262925c5749SYifeng Zhao 	case PHY_TYPE_PCIE:
263925c5749SYifeng Zhao 		rockchip_combphy_pcie_init(priv);
264925c5749SYifeng Zhao 		break;
265925c5749SYifeng Zhao 	case PHY_TYPE_USB3:
266925c5749SYifeng Zhao 		rockchip_combphy_usb3_init(priv);
267925c5749SYifeng Zhao 		break;
268925c5749SYifeng Zhao 	case PHY_TYPE_SATA:
269925c5749SYifeng Zhao 		rockchip_combphy_sata_init(priv);
270925c5749SYifeng Zhao 		break;
271925c5749SYifeng Zhao 	case PHY_TYPE_SGMII:
272925c5749SYifeng Zhao 	case PHY_TYPE_QSGMII:
273925c5749SYifeng Zhao 		return rockchip_combphy_sgmii_init(priv);
274925c5749SYifeng Zhao 	default:
275925c5749SYifeng Zhao 		dev_err(priv->dev, "incompatible PHY type\n");
276925c5749SYifeng Zhao 		return -EINVAL;
277925c5749SYifeng Zhao 	}
278925c5749SYifeng Zhao 
279925c5749SYifeng Zhao 	return 0;
280925c5749SYifeng Zhao }
281925c5749SYifeng Zhao 
rockchip_combphy_init(struct phy * phy)282925c5749SYifeng Zhao static int rockchip_combphy_init(struct phy *phy)
283925c5749SYifeng Zhao {
284925c5749SYifeng Zhao 	struct rockchip_combphy_priv *priv = dev_get_priv(phy->dev);
28586b316b4SFrank Wang 	const struct rockchip_combphy_grfcfg *cfg = priv->cfg->grfcfg;
286925c5749SYifeng Zhao 	int ret;
287925c5749SYifeng Zhao 
288925c5749SYifeng Zhao 	ret = clk_enable(&priv->ref_clk);
289925c5749SYifeng Zhao 	if (ret < 0 && ret != -ENOSYS)
290925c5749SYifeng Zhao 		return ret;
291925c5749SYifeng Zhao 
292925c5749SYifeng Zhao 	ret = rockchip_combphy_set_mode(priv);
293925c5749SYifeng Zhao 	if (ret)
294925c5749SYifeng Zhao 		goto err_clk;
295925c5749SYifeng Zhao 
296925c5749SYifeng Zhao 	reset_deassert(&priv->phy_rst);
297925c5749SYifeng Zhao 
29886b316b4SFrank Wang 	if (cfg->pipe_phy_grf_reset.enable)
29986b316b4SFrank Wang 		param_write(priv->phy_grf, &cfg->pipe_phy_grf_reset, false);
30086b316b4SFrank Wang 
301925c5749SYifeng Zhao 	return 0;
302925c5749SYifeng Zhao 
303925c5749SYifeng Zhao err_clk:
304925c5749SYifeng Zhao 	clk_disable(&priv->ref_clk);
305925c5749SYifeng Zhao 
306925c5749SYifeng Zhao 	return ret;
307925c5749SYifeng Zhao }
308925c5749SYifeng Zhao 
rockchip_combphy_exit(struct phy * phy)309925c5749SYifeng Zhao static int rockchip_combphy_exit(struct phy *phy)
310925c5749SYifeng Zhao {
311925c5749SYifeng Zhao 	struct rockchip_combphy_priv *priv = dev_get_priv(phy->dev);
31286b316b4SFrank Wang 	const struct rockchip_combphy_grfcfg *cfg = priv->cfg->grfcfg;
313925c5749SYifeng Zhao 
31486b316b4SFrank Wang 	if (cfg->pipe_phy_grf_reset.enable)
31586b316b4SFrank Wang 		param_write(priv->phy_grf, &cfg->pipe_phy_grf_reset, true);
31686b316b4SFrank Wang 
317925c5749SYifeng Zhao 	reset_assert(&priv->phy_rst);
31886b316b4SFrank Wang 	clk_disable(&priv->ref_clk);
319925c5749SYifeng Zhao 
320925c5749SYifeng Zhao 	return 0;
321925c5749SYifeng Zhao }
322925c5749SYifeng Zhao 
rockchip_combphy_xlate(struct phy * phy,struct ofnode_phandle_args * args)323925c5749SYifeng Zhao static int rockchip_combphy_xlate(struct phy *phy, struct ofnode_phandle_args *args)
324925c5749SYifeng Zhao {
325925c5749SYifeng Zhao 	struct rockchip_combphy_priv *priv = dev_get_priv(phy->dev);
326925c5749SYifeng Zhao 
327925c5749SYifeng Zhao 	if (args->args_count != 1) {
328925c5749SYifeng Zhao 		pr_err("invalid number of arguments\n");
329925c5749SYifeng Zhao 		return -EINVAL;
330925c5749SYifeng Zhao 	}
331925c5749SYifeng Zhao 
332925c5749SYifeng Zhao 	priv->mode = args->args[0];
333925c5749SYifeng Zhao 
334925c5749SYifeng Zhao 	return 0;
335925c5749SYifeng Zhao }
336925c5749SYifeng Zhao 
337925c5749SYifeng Zhao static const struct phy_ops rochchip_combphy_ops = {
338925c5749SYifeng Zhao 	.init = rockchip_combphy_init,
339925c5749SYifeng Zhao 	.exit = rockchip_combphy_exit,
340925c5749SYifeng Zhao 	.of_xlate = rockchip_combphy_xlate,
341925c5749SYifeng Zhao };
342925c5749SYifeng Zhao 
rockchip_combphy_parse_dt(struct udevice * dev,struct rockchip_combphy_priv * priv)343925c5749SYifeng Zhao static int rockchip_combphy_parse_dt(struct udevice *dev,
344925c5749SYifeng Zhao 				     struct rockchip_combphy_priv *priv)
345925c5749SYifeng Zhao {
346925c5749SYifeng Zhao 	struct udevice *syscon;
347925c5749SYifeng Zhao 	int ret;
3487cc44222SJon Lin 	u32 vals[4];
349925c5749SYifeng Zhao 
350925c5749SYifeng Zhao 	ret = uclass_get_device_by_phandle(UCLASS_SYSCON, dev, "rockchip,pipe-grf", &syscon);
351925c5749SYifeng Zhao 	if (ret) {
352cf3c44cbSJon Lin 		dev_err(dev, "failed to find peri_ctrl pipe-grf regmap ret= %d\n", ret);
353925c5749SYifeng Zhao 		return ret;
354925c5749SYifeng Zhao 	}
355925c5749SYifeng Zhao 	priv->pipe_grf = syscon_get_regmap(syscon);
356925c5749SYifeng Zhao 
357925c5749SYifeng Zhao 	ret = uclass_get_device_by_phandle(UCLASS_SYSCON, dev, "rockchip,pipe-phy-grf", &syscon);
358925c5749SYifeng Zhao 	if (ret) {
359925c5749SYifeng Zhao 		dev_err(dev, "failed to find peri_ctrl pipe-phy-grf regmap\n");
360925c5749SYifeng Zhao 		return ret;
361925c5749SYifeng Zhao 	}
362925c5749SYifeng Zhao 	priv->phy_grf = syscon_get_regmap(syscon);
363925c5749SYifeng Zhao 
364925c5749SYifeng Zhao 	ret = clk_get_by_index(dev, 0, &priv->ref_clk);
365925c5749SYifeng Zhao 	if (ret) {
366925c5749SYifeng Zhao 		dev_err(dev, "failed to find ref clock\n");
367925c5749SYifeng Zhao 		return PTR_ERR(&priv->ref_clk);
368925c5749SYifeng Zhao 	}
369925c5749SYifeng Zhao 
370dbf89912SRen Jianing 	ret = reset_get_by_name(dev, "combphy", &priv->phy_rst);
371925c5749SYifeng Zhao 	if (ret) {
372925c5749SYifeng Zhao 		dev_err(dev, "no phy reset control specified\n");
373925c5749SYifeng Zhao 		return ret;
374925c5749SYifeng Zhao 	}
375925c5749SYifeng Zhao 
3767cc44222SJon Lin 	if (!dev_read_u32_array(dev, "rockchip,pcie1ln-sel-bits",
3777cc44222SJon Lin 				vals, ARRAY_SIZE(vals)))
3787cc44222SJon Lin 		regmap_write(priv->pipe_grf, vals[0],
3797cc44222SJon Lin 			     (GENMASK(vals[2], vals[1]) << 16) | vals[3]);
3807cc44222SJon Lin 
381925c5749SYifeng Zhao 	return 0;
382925c5749SYifeng Zhao }
383925c5749SYifeng Zhao 
rockchip_combphy_probe(struct udevice * udev)384925c5749SYifeng Zhao static int rockchip_combphy_probe(struct udevice *udev)
385925c5749SYifeng Zhao {
386925c5749SYifeng Zhao 	struct rockchip_combphy_priv *priv = dev_get_priv(udev);
387925c5749SYifeng Zhao 	const struct rockchip_combphy_cfg *phy_cfg;
388925c5749SYifeng Zhao 
389925c5749SYifeng Zhao 	priv->mmio = (void __iomem *)dev_read_addr(udev);
390925c5749SYifeng Zhao 	if (IS_ERR(priv->mmio))
391925c5749SYifeng Zhao 		return PTR_ERR(priv->mmio);
392925c5749SYifeng Zhao 
393925c5749SYifeng Zhao 	phy_cfg = (const struct rockchip_combphy_cfg *)dev_get_driver_data(udev);
394925c5749SYifeng Zhao 	if (!phy_cfg) {
395925c5749SYifeng Zhao 		dev_err(udev, "No OF match data provided\n");
396925c5749SYifeng Zhao 		return -EINVAL;
397925c5749SYifeng Zhao 	}
398925c5749SYifeng Zhao 
399925c5749SYifeng Zhao 	priv->dev = udev;
400925c5749SYifeng Zhao 	priv->mode = PHY_TYPE_SATA;
401925c5749SYifeng Zhao 	priv->cfg = phy_cfg;
402925c5749SYifeng Zhao 
4035eec6d12SJon Lin 	return rockchip_combphy_parse_dt(udev, priv);
404925c5749SYifeng Zhao }
405925c5749SYifeng Zhao 
406fc22f2adSWilliam Wu #ifdef CONFIG_ROCKCHIP_RK3528
rk3528_combphy_cfg(struct rockchip_combphy_priv * priv)4073452d642SJianwei Zheng static int rk3528_combphy_cfg(struct rockchip_combphy_priv *priv)
4083452d642SJianwei Zheng {
4093452d642SJianwei Zheng 	const struct rockchip_combphy_grfcfg *cfg = priv->cfg->grfcfg;
4103452d642SJianwei Zheng 	u32 val;
4113452d642SJianwei Zheng 
4123452d642SJianwei Zheng 	switch (priv->mode) {
4133452d642SJianwei Zheng 	case PHY_TYPE_PCIE:
4143452d642SJianwei Zheng 		/* Set SSC downward spread spectrum */
4153452d642SJianwei Zheng 		val = readl(priv->mmio + 0x18);
4163452d642SJianwei Zheng 		val &= ~GENMASK(5, 4);
4173452d642SJianwei Zheng 		val |= 0x01 << 4;
4183452d642SJianwei Zheng 		writel(val, priv->mmio + 0x18);
4193452d642SJianwei Zheng 
4203452d642SJianwei Zheng 		param_write(priv->phy_grf, &cfg->con0_for_pcie, true);
4213452d642SJianwei Zheng 		param_write(priv->phy_grf, &cfg->con1_for_pcie, true);
4223452d642SJianwei Zheng 		param_write(priv->phy_grf, &cfg->con2_for_pcie, true);
4233452d642SJianwei Zheng 		param_write(priv->phy_grf, &cfg->con3_for_pcie, true);
4243452d642SJianwei Zheng 		break;
4253452d642SJianwei Zheng 	case PHY_TYPE_USB3:
4263452d642SJianwei Zheng 		/* Set SSC downward spread spectrum */
4273452d642SJianwei Zheng 		val = readl(priv->mmio + 0x18);
4283452d642SJianwei Zheng 		val &= ~GENMASK(5, 4);
4293452d642SJianwei Zheng 		val |= 0x01 << 4;
4303452d642SJianwei Zheng 		writel(val, priv->mmio + 0x18);
4313452d642SJianwei Zheng 
4323452d642SJianwei Zheng 		/* Enable adaptive CTLE for USB3.0 Rx */
4333452d642SJianwei Zheng 		val = readl(priv->mmio + 0x200);
4343452d642SJianwei Zheng 		val &= ~GENMASK(17, 17);
4353452d642SJianwei Zheng 		val |= 0x01;
4363452d642SJianwei Zheng 		writel(val, priv->mmio + 0x200);
4373452d642SJianwei Zheng 
438fc3847fcSWilliam Wu 		/* Set Rx squelch input filler bandwidth */
439fc3847fcSWilliam Wu 		val = readl(priv->mmio + 0x20c);
440fc3847fcSWilliam Wu 		val &= ~GENMASK(2, 0);
441fc3847fcSWilliam Wu 		val |= 0x06;
442fc3847fcSWilliam Wu 		writel(val, priv->mmio + 0x20c);
443fc3847fcSWilliam Wu 
4443452d642SJianwei Zheng 		param_write(priv->phy_grf, &cfg->pipe_txcomp_sel, false);
4453452d642SJianwei Zheng 		param_write(priv->phy_grf, &cfg->pipe_txelec_sel, false);
4463452d642SJianwei Zheng 		param_write(priv->phy_grf, &cfg->usb_mode_set, true);
4473452d642SJianwei Zheng 		break;
4483452d642SJianwei Zheng 	default:
4493452d642SJianwei Zheng 		dev_err(priv->dev, "incompatible PHY type\n");
4503452d642SJianwei Zheng 		return -EINVAL;
4513452d642SJianwei Zheng 	}
4523452d642SJianwei Zheng 
4533452d642SJianwei Zheng 	param_write(priv->phy_grf, &cfg->pipe_clk_100m, true);
4543452d642SJianwei Zheng 	if (priv->mode == PHY_TYPE_PCIE) {
4553452d642SJianwei Zheng 		/* PLL KVCO tuning fine */
4563452d642SJianwei Zheng 		val = readl(priv->mmio + 0x18);
4573452d642SJianwei Zheng 		val &= ~(0x7 << 10);
4583452d642SJianwei Zheng 		val |= 0x2 << 10;
4593452d642SJianwei Zheng 		writel(val, priv->mmio + 0x18);
4603452d642SJianwei Zheng 
4613452d642SJianwei Zheng 		/* su_trim[6:4]=111, [10:7]=1001, [2:0]=000 */
4623452d642SJianwei Zheng 		val = readl(priv->mmio + 0x108);
4633452d642SJianwei Zheng 		val &= ~(0x7f7);
4643452d642SJianwei Zheng 		val |= 0x4f0;
4653452d642SJianwei Zheng 		writel(val, priv->mmio + 0x108);
4663452d642SJianwei Zheng 	}
4673452d642SJianwei Zheng 
4683452d642SJianwei Zheng 	return 0;
4693452d642SJianwei Zheng }
4703452d642SJianwei Zheng 
4713452d642SJianwei Zheng static const struct rockchip_combphy_grfcfg rk3528_combphy_grfcfgs = {
4723452d642SJianwei Zheng 	/* pipe-phy-grf */
4733452d642SJianwei Zheng 	.pcie_mode_set		= { 0x48000, 5, 0, 0x00, 0x11 },
4743452d642SJianwei Zheng 	.usb_mode_set		= { 0x48000, 5, 0, 0x00, 0x04 },
4753452d642SJianwei Zheng 	.pipe_rxterm_set	= { 0x48000, 12, 12, 0x00, 0x01 },
4763452d642SJianwei Zheng 	.pipe_txelec_set	= { 0x48004, 1, 1, 0x00, 0x01 },
4773452d642SJianwei Zheng 	.pipe_txcomp_set	= { 0x48004, 4, 4, 0x00, 0x01 },
4783452d642SJianwei Zheng 	.pipe_clk_24m		= { 0x48004, 14, 13, 0x00, 0x00 },
4793452d642SJianwei Zheng 	.pipe_clk_100m		= { 0x48004, 14, 13, 0x00, 0x02 },
4803452d642SJianwei Zheng 	.pipe_rxterm_sel	= { 0x48008, 8, 8, 0x00, 0x01 },
4813452d642SJianwei Zheng 	.pipe_txelec_sel	= { 0x48008, 12, 12, 0x00, 0x01 },
4823452d642SJianwei Zheng 	.pipe_txcomp_sel	= { 0x48008, 15, 15, 0x00, 0x01 },
4833452d642SJianwei Zheng 	.pipe_clk_ext		= { 0x4800c, 9, 8, 0x02, 0x01 },
4843452d642SJianwei Zheng 	.pipe_phy_status	= { 0x48034, 6, 6, 0x01, 0x00 },
4853452d642SJianwei Zheng 	.con0_for_pcie		= { 0x48000, 15, 0, 0x00, 0x110 },
4863452d642SJianwei Zheng 	.con1_for_pcie		= { 0x48004, 15, 0, 0x00, 0x00 },
4873452d642SJianwei Zheng 	.con2_for_pcie		= { 0x48008, 15, 0, 0x00, 0x101 },
4883452d642SJianwei Zheng 	.con3_for_pcie		= { 0x4800c, 15, 0, 0x00, 0x0200 },
4893452d642SJianwei Zheng 	/* pipe-grf */
49014d5da7dSwilliam.wu 	.u3otg0_pipe_clk_sel	= { 0x40044, 7, 7, 0x01, 0x00 },
4913452d642SJianwei Zheng 	.u3otg0_port_en		= { 0x40044, 15, 0, 0x0181, 0x1100 },
4923452d642SJianwei Zheng };
4933452d642SJianwei Zheng 
4943452d642SJianwei Zheng static const struct rockchip_combphy_cfg rk3528_combphy_cfgs = {
4953452d642SJianwei Zheng 	.grfcfg		= &rk3528_combphy_grfcfgs,
4963452d642SJianwei Zheng 	.combphy_cfg	= rk3528_combphy_cfg,
4973452d642SJianwei Zheng };
498fc22f2adSWilliam Wu #endif
4993452d642SJianwei Zheng 
500fc22f2adSWilliam Wu #ifdef CONFIG_ROCKCHIP_RK3562
rk3562_combphy_cfg(struct rockchip_combphy_priv * priv)501885c5d5dSFrank Wang static int rk3562_combphy_cfg(struct rockchip_combphy_priv *priv)
502885c5d5dSFrank Wang {
503885c5d5dSFrank Wang 	const struct rockchip_combphy_grfcfg *cfg = priv->cfg->grfcfg;
504885c5d5dSFrank Wang 	u32 val;
505885c5d5dSFrank Wang 
506885c5d5dSFrank Wang 	switch (priv->mode) {
507885c5d5dSFrank Wang 	case PHY_TYPE_PCIE:
508885c5d5dSFrank Wang 		/* Set SSC downward spread spectrum */
509885c5d5dSFrank Wang 		val = readl(priv->mmio + (0x1f << 2));
510885c5d5dSFrank Wang 		val &= ~GENMASK(5, 4);
511885c5d5dSFrank Wang 		val |= 0x01 << 4;
512885c5d5dSFrank Wang 		writel(val, priv->mmio + 0x7c);
513885c5d5dSFrank Wang 
514885c5d5dSFrank Wang 		param_write(priv->phy_grf, &cfg->con0_for_pcie, true);
515885c5d5dSFrank Wang 		param_write(priv->phy_grf, &cfg->con1_for_pcie, true);
516885c5d5dSFrank Wang 		param_write(priv->phy_grf, &cfg->con2_for_pcie, true);
517885c5d5dSFrank Wang 		param_write(priv->phy_grf, &cfg->con3_for_pcie, true);
518885c5d5dSFrank Wang 		break;
519885c5d5dSFrank Wang 	case PHY_TYPE_USB3:
520885c5d5dSFrank Wang 		/* Set SSC downward spread spectrum */
521885c5d5dSFrank Wang 		val = readl(priv->mmio + (0x1f << 2));
522885c5d5dSFrank Wang 		val &= ~GENMASK(5, 4);
523885c5d5dSFrank Wang 		val |= 0x01 << 4;
524885c5d5dSFrank Wang 		writel(val, priv->mmio + 0x7c);
525885c5d5dSFrank Wang 
526885c5d5dSFrank Wang 		/* Enable adaptive CTLE for USB3.0 Rx */
527885c5d5dSFrank Wang 		val = readl(priv->mmio + (0x0e << 2));
528885c5d5dSFrank Wang 		val &= ~GENMASK(0, 0);
529885c5d5dSFrank Wang 		val |= 0x01;
530885c5d5dSFrank Wang 		writel(val, priv->mmio + (0x0e << 2));
531885c5d5dSFrank Wang 
532885c5d5dSFrank Wang 		/* Set PLL KVCO fine tuning signals */
533885c5d5dSFrank Wang 		val = readl(priv->mmio + (0x20 << 2));
534885c5d5dSFrank Wang 		val &= ~(0x7 << 2);
535885c5d5dSFrank Wang 		val |= 0x2 << 2;
536885c5d5dSFrank Wang 		writel(val, priv->mmio + (0x20 << 2));
537885c5d5dSFrank Wang 
538885c5d5dSFrank Wang 		/* Set PLL LPF R1 to su_trim[10:7]=1001 */
539885c5d5dSFrank Wang 		writel(0x4, priv->mmio + (0xb << 2));
540885c5d5dSFrank Wang 
541885c5d5dSFrank Wang 		/* Set PLL input clock divider 1/2 */
542885c5d5dSFrank Wang 		val = readl(priv->mmio + (0x5 << 2));
543885c5d5dSFrank Wang 		val &= ~(0x3 << 6);
544885c5d5dSFrank Wang 		val |= 0x1 << 6;
545885c5d5dSFrank Wang 		writel(val, priv->mmio + (0x5 << 2));
546885c5d5dSFrank Wang 
547885c5d5dSFrank Wang 		/* Set PLL loop divider */
548885c5d5dSFrank Wang 		writel(0x32, priv->mmio + (0x11 << 2));
549885c5d5dSFrank Wang 
550885c5d5dSFrank Wang 		/* Set PLL KVCO to min and set PLL charge pump current to max */
551885c5d5dSFrank Wang 		writel(0xf0, priv->mmio + (0xa << 2));
552885c5d5dSFrank Wang 
553fc3847fcSWilliam Wu 		/* Set Rx squelch input filler bandwidth */
554fc3847fcSWilliam Wu 		writel(0x0e, priv->mmio + (0x14 << 2));
555fc3847fcSWilliam Wu 
556885c5d5dSFrank Wang 		param_write(priv->phy_grf, &cfg->pipe_sel_usb, true);
557885c5d5dSFrank Wang 		param_write(priv->phy_grf, &cfg->pipe_txcomp_sel, false);
558885c5d5dSFrank Wang 		param_write(priv->phy_grf, &cfg->pipe_txelec_sel, false);
559885c5d5dSFrank Wang 		param_write(priv->phy_grf, &cfg->usb_mode_set, true);
560885c5d5dSFrank Wang 		break;
561885c5d5dSFrank Wang 	default:
562885c5d5dSFrank Wang 		pr_err("%s, phy-type %d\n", __func__, priv->mode);
563885c5d5dSFrank Wang 		return -EINVAL;
564885c5d5dSFrank Wang 	}
565885c5d5dSFrank Wang 
566885c5d5dSFrank Wang 	clk_set_rate(&priv->ref_clk, 100000000);
567885c5d5dSFrank Wang 	param_write(priv->phy_grf, &cfg->pipe_clk_100m, true);
568885c5d5dSFrank Wang 
569cc9876f4SJon Lin 	if (priv->mode == PHY_TYPE_PCIE) {
570cc9876f4SJon Lin 		/* PLL KVCO tuning fine */
571cc9876f4SJon Lin 		val = readl(priv->mmio + (0x20 << 2));
572cc9876f4SJon Lin 		val &= ~(0x7 << 2);
573cc9876f4SJon Lin 		val |= 0x2 << 2;
574cc9876f4SJon Lin 		writel(val, priv->mmio + (0x20 << 2));
575cc9876f4SJon Lin 
576cc9876f4SJon Lin 		/* Enable controlling random jitter, aka RMJ */
577cc9876f4SJon Lin 		writel(0x4, priv->mmio + (0xb << 2));
578cc9876f4SJon Lin 
579cc9876f4SJon Lin 		val = readl(priv->mmio + (0x5 << 2));
580cc9876f4SJon Lin 		val &= ~(0x3 << 6);
581cc9876f4SJon Lin 		val |= 0x1 << 6;
582cc9876f4SJon Lin 		writel(val, priv->mmio + (0x5 << 2));
583cc9876f4SJon Lin 
584cc9876f4SJon Lin 		writel(0x32, priv->mmio + (0x11 << 2));
585cc9876f4SJon Lin 		writel(0xf0, priv->mmio + (0xa << 2));
586cc9876f4SJon Lin 	}
587cc9876f4SJon Lin 
5889bd901abSJon Lin 	if (dev_read_bool(priv->dev, "rockchip,ext-refclk")) {
5899bd901abSJon Lin 		param_write(priv->phy_grf, &cfg->pipe_clk_ext, true);
5909bd901abSJon Lin 		if (priv->mode == PHY_TYPE_PCIE) {
5919bd901abSJon Lin 			val = readl(priv->mmio + (0xc << 2));
5929bd901abSJon Lin 			val |= 0x3 << 4 | 0x1 << 7;
5939bd901abSJon Lin 			writel(val, priv->mmio + (0xc << 2));
5949bd901abSJon Lin 
5959bd901abSJon Lin 			val = readl(priv->mmio + (0xd << 2));
5969bd901abSJon Lin 			val |= 0x1;
5979bd901abSJon Lin 			writel(val, priv->mmio + (0xd << 2));
5989bd901abSJon Lin 		}
5999bd901abSJon Lin 	}
6009bd901abSJon Lin 
601885c5d5dSFrank Wang 	if (dev_read_bool(priv->dev, "rockchip,enable-ssc")) {
602885c5d5dSFrank Wang 		val = readl(priv->mmio + (0x7 << 2));
603885c5d5dSFrank Wang 		val |= BIT(4);
604885c5d5dSFrank Wang 		writel(val, priv->mmio + (0x7 << 2));
605885c5d5dSFrank Wang 	}
606885c5d5dSFrank Wang 
607885c5d5dSFrank Wang 	return 0;
608885c5d5dSFrank Wang }
609885c5d5dSFrank Wang 
610885c5d5dSFrank Wang static const struct rockchip_combphy_grfcfg rk3562_combphy_grfcfgs = {
611885c5d5dSFrank Wang 	/* pipe-phy-grf */
612885c5d5dSFrank Wang 	.pcie_mode_set		= { 0x0000, 5, 0, 0x00, 0x11 },
613885c5d5dSFrank Wang 	.usb_mode_set		= { 0x0000, 5, 0, 0x00, 0x04 },
614885c5d5dSFrank Wang 	.pipe_rxterm_set	= { 0x0000, 12, 12, 0x00, 0x01 },
615885c5d5dSFrank Wang 	.pipe_txelec_set	= { 0x0004, 1, 1, 0x00, 0x01 },
616885c5d5dSFrank Wang 	.pipe_txcomp_set	= { 0x0004, 4, 4, 0x00, 0x01 },
617885c5d5dSFrank Wang 	.pipe_clk_25m		= { 0x0004, 14, 13, 0x00, 0x01 },
618885c5d5dSFrank Wang 	.pipe_clk_100m		= { 0x0004, 14, 13, 0x00, 0x02 },
619885c5d5dSFrank Wang 	.pipe_phymode_sel	= { 0x0008, 1, 1, 0x00, 0x01 },
620885c5d5dSFrank Wang 	.pipe_rate_sel		= { 0x0008, 2, 2, 0x00, 0x01 },
621885c5d5dSFrank Wang 	.pipe_rxterm_sel	= { 0x0008, 8, 8, 0x00, 0x01 },
622885c5d5dSFrank Wang 	.pipe_txelec_sel	= { 0x0008, 12, 12, 0x00, 0x01 },
623885c5d5dSFrank Wang 	.pipe_txcomp_sel	= { 0x0008, 15, 15, 0x00, 0x01 },
624885c5d5dSFrank Wang 	.pipe_clk_ext		= { 0x000c, 9, 8, 0x02, 0x01 },
625885c5d5dSFrank Wang 	.pipe_sel_usb		= { 0x000c, 14, 13, 0x00, 0x01 },
626885c5d5dSFrank Wang 	.pipe_phy_status	= { 0x0034, 6, 6, 0x01, 0x00 },
627885c5d5dSFrank Wang 	.con0_for_pcie		= { 0x0000, 15, 0, 0x00, 0x1000 },
628885c5d5dSFrank Wang 	.con1_for_pcie		= { 0x0004, 15, 0, 0x00, 0x0000 },
629885c5d5dSFrank Wang 	.con2_for_pcie		= { 0x0008, 15, 0, 0x00, 0x0101 },
630885c5d5dSFrank Wang 	.con3_for_pcie		= { 0x000c, 15, 0, 0x00, 0x0200 },
63186b316b4SFrank Wang 	.pipe_phy_grf_reset	= { 0x0014, 1, 0, 0x3, 0x1 },
632885c5d5dSFrank Wang 	/* pipe-grf */
633885c5d5dSFrank Wang 	.u3otg0_port_en		= { 0x0094, 15, 0, 0x0181, 0x1100 },
634885c5d5dSFrank Wang };
635885c5d5dSFrank Wang 
636885c5d5dSFrank Wang static const struct rockchip_combphy_cfg rk3562_combphy_cfgs = {
637885c5d5dSFrank Wang 	.grfcfg		= &rk3562_combphy_grfcfgs,
638885c5d5dSFrank Wang 	.combphy_cfg	= rk3562_combphy_cfg,
639fb632bccSShawn Lin 	.force_det_out  = true,
640885c5d5dSFrank Wang };
641fc22f2adSWilliam Wu #endif
642885c5d5dSFrank Wang 
643fc22f2adSWilliam Wu #ifdef CONFIG_ROCKCHIP_RK3568
rk3568_combphy_cfg(struct rockchip_combphy_priv * priv)644925c5749SYifeng Zhao static int rk3568_combphy_cfg(struct rockchip_combphy_priv *priv)
645925c5749SYifeng Zhao {
646925c5749SYifeng Zhao 	const struct rockchip_combphy_grfcfg *cfg = priv->cfg->grfcfg;
647925c5749SYifeng Zhao 	u32 val;
648925c5749SYifeng Zhao 
649925c5749SYifeng Zhao 	switch (priv->mode) {
650925c5749SYifeng Zhao 	case PHY_TYPE_PCIE:
651925c5749SYifeng Zhao 		/* Set SSC downward spread spectrum */
652925c5749SYifeng Zhao 		val = readl(priv->mmio + (0x1f << 2));
653925c5749SYifeng Zhao 		val &= ~GENMASK(5, 4);
654925c5749SYifeng Zhao 		val |= 0x01 << 4;
655925c5749SYifeng Zhao 		writel(val, priv->mmio + 0x7c);
656925c5749SYifeng Zhao 
657925c5749SYifeng Zhao 		param_write(priv->phy_grf, &cfg->con0_for_pcie, true);
658925c5749SYifeng Zhao 		param_write(priv->phy_grf, &cfg->con1_for_pcie, true);
659925c5749SYifeng Zhao 		param_write(priv->phy_grf, &cfg->con2_for_pcie, true);
660925c5749SYifeng Zhao 		param_write(priv->phy_grf, &cfg->con3_for_pcie, true);
661925c5749SYifeng Zhao 		break;
662925c5749SYifeng Zhao 	case PHY_TYPE_USB3:
663925c5749SYifeng Zhao 		/* Set SSC downward spread spectrum */
664925c5749SYifeng Zhao 		val = readl(priv->mmio + (0x1f << 2));
665925c5749SYifeng Zhao 		val &= ~GENMASK(5, 4);
666925c5749SYifeng Zhao 		val |= 0x01 << 4;
667925c5749SYifeng Zhao 		writel(val, priv->mmio + 0x7c);
668925c5749SYifeng Zhao 
669925c5749SYifeng Zhao 		/* Enable adaptive CTLE for USB3.0 Rx */
670925c5749SYifeng Zhao 		val = readl(priv->mmio + (0x0e << 2));
671925c5749SYifeng Zhao 		val &= ~GENMASK(0, 0);
672925c5749SYifeng Zhao 		val |= 0x01;
673925c5749SYifeng Zhao 		writel(val, priv->mmio + (0x0e << 2));
674925c5749SYifeng Zhao 
675a0d03578SWilliam Wu 		/* Set PLL KVCO fine tuning signals */
676a0d03578SWilliam Wu 		val = readl(priv->mmio + (0x20 << 2));
677a0d03578SWilliam Wu 		val &= ~(0x7 << 2);
678a0d03578SWilliam Wu 		val |= 0x2 << 2;
679a0d03578SWilliam Wu 		writel(val, priv->mmio + (0x20 << 2));
680a0d03578SWilliam Wu 
681a0d03578SWilliam Wu 		/* Set PLL LPF R1 to su_trim[10:7]=1001 */
682a0d03578SWilliam Wu 		writel(0x4, priv->mmio + (0xb << 2));
683a0d03578SWilliam Wu 
684a0d03578SWilliam Wu 		/* Set PLL input clock divider 1/2 */
685a0d03578SWilliam Wu 		val = readl(priv->mmio + (0x5 << 2));
686a0d03578SWilliam Wu 		val &= ~(0x3 << 6);
687a0d03578SWilliam Wu 		val |= 0x1 << 6;
688a0d03578SWilliam Wu 		writel(val, priv->mmio + (0x5 << 2));
689a0d03578SWilliam Wu 
690a0d03578SWilliam Wu 		/* Set PLL loop divider */
691a0d03578SWilliam Wu 		writel(0x32, priv->mmio + (0x11 << 2));
692a0d03578SWilliam Wu 
693a0d03578SWilliam Wu 		/* Set PLL KVCO to min and set PLL charge pump current to max */
694a0d03578SWilliam Wu 		writel(0xf0, priv->mmio + (0xa << 2));
695a0d03578SWilliam Wu 
696fc3847fcSWilliam Wu 		/* Set Rx squelch input filler bandwidth */
697fc3847fcSWilliam Wu 		writel(0x0e, priv->mmio + (0x14 << 2));
698fc3847fcSWilliam Wu 
699925c5749SYifeng Zhao 		param_write(priv->phy_grf, &cfg->pipe_sel_usb, true);
700925c5749SYifeng Zhao 		param_write(priv->phy_grf, &cfg->pipe_txcomp_sel, false);
701925c5749SYifeng Zhao 		param_write(priv->phy_grf, &cfg->pipe_txelec_sel, false);
702925c5749SYifeng Zhao 		param_write(priv->phy_grf, &cfg->usb_mode_set, true);
703925c5749SYifeng Zhao 		break;
704925c5749SYifeng Zhao 	case PHY_TYPE_SATA:
705925c5749SYifeng Zhao 		writel(0x41, priv->mmio + 0x38);
706925c5749SYifeng Zhao 		writel(0x8F, priv->mmio + 0x18);
707925c5749SYifeng Zhao 		param_write(priv->phy_grf, &cfg->con0_for_sata, true);
708925c5749SYifeng Zhao 		param_write(priv->phy_grf, &cfg->con1_for_sata, true);
709925c5749SYifeng Zhao 		param_write(priv->phy_grf, &cfg->con2_for_sata, true);
710925c5749SYifeng Zhao 		param_write(priv->phy_grf, &cfg->con3_for_sata, true);
711925c5749SYifeng Zhao 		param_write(priv->pipe_grf, &cfg->pipe_con0_for_sata, true);
712925c5749SYifeng Zhao 		break;
713925c5749SYifeng Zhao 	case PHY_TYPE_SGMII:
714925c5749SYifeng Zhao 		param_write(priv->pipe_grf, &cfg->pipe_xpcs_phy_ready, true);
715925c5749SYifeng Zhao 		param_write(priv->phy_grf, &cfg->pipe_phymode_sel, true);
716925c5749SYifeng Zhao 		param_write(priv->phy_grf, &cfg->pipe_sel_qsgmii, true);
717925c5749SYifeng Zhao 		param_write(priv->phy_grf, &cfg->sgmii_mode_set, true);
718925c5749SYifeng Zhao 		break;
719925c5749SYifeng Zhao 	case PHY_TYPE_QSGMII:
720925c5749SYifeng Zhao 		param_write(priv->pipe_grf, &cfg->pipe_xpcs_phy_ready, true);
721925c5749SYifeng Zhao 		param_write(priv->phy_grf, &cfg->pipe_phymode_sel, true);
722925c5749SYifeng Zhao 		param_write(priv->phy_grf, &cfg->pipe_rate_sel, true);
723925c5749SYifeng Zhao 		param_write(priv->phy_grf, &cfg->pipe_sel_qsgmii, true);
724925c5749SYifeng Zhao 		param_write(priv->phy_grf, &cfg->qsgmii_mode_set, true);
725925c5749SYifeng Zhao 		break;
726925c5749SYifeng Zhao 	default:
727925c5749SYifeng Zhao 		pr_err("%s, phy-type %d\n", __func__, priv->mode);
728925c5749SYifeng Zhao 		return -EINVAL;
729925c5749SYifeng Zhao 	}
730925c5749SYifeng Zhao 
731dbf89912SRen Jianing 	/* The default ref clock is 25Mhz */
732dbf89912SRen Jianing 	param_write(priv->phy_grf, &cfg->pipe_clk_25m, true);
733925c5749SYifeng Zhao 
734925c5749SYifeng Zhao 	if (dev_read_bool(priv->dev, "rockchip,enable-ssc")) {
735925c5749SYifeng Zhao 		val = readl(priv->mmio + (0x7 << 2));
736925c5749SYifeng Zhao 		val |= BIT(4);
737925c5749SYifeng Zhao 		writel(val, priv->mmio + (0x7 << 2));
738925c5749SYifeng Zhao 	}
739925c5749SYifeng Zhao 
740925c5749SYifeng Zhao 	return 0;
741925c5749SYifeng Zhao }
742925c5749SYifeng Zhao 
743925c5749SYifeng Zhao static const struct rockchip_combphy_grfcfg rk3568_combphy_grfcfgs = {
744925c5749SYifeng Zhao 	/* pipe-phy-grf */
745925c5749SYifeng Zhao 	.pcie_mode_set		= { 0x0000, 5, 0, 0x00, 0x11 },
746925c5749SYifeng Zhao 	.usb_mode_set		= { 0x0000, 5, 0, 0x00, 0x04 },
747925c5749SYifeng Zhao 	.sgmii_mode_set		= { 0x0000, 5, 0, 0x00, 0x01 },
748925c5749SYifeng Zhao 	.qsgmii_mode_set	= { 0x0000, 5, 0, 0x00, 0x21 },
749925c5749SYifeng Zhao 	.pipe_rxterm_set	= { 0x0000, 12, 12, 0x00, 0x01 },
750925c5749SYifeng Zhao 	.pipe_txelec_set	= { 0x0004, 1, 1, 0x00, 0x01 },
751925c5749SYifeng Zhao 	.pipe_txcomp_set	= { 0x0004, 4, 4, 0x00, 0x01 },
752925c5749SYifeng Zhao 	.pipe_clk_25m		= { 0x0004, 14, 13, 0x00, 0x01 },
753925c5749SYifeng Zhao 	.pipe_clk_100m		= { 0x0004, 14, 13, 0x00, 0x02 },
754925c5749SYifeng Zhao 	.pipe_phymode_sel	= { 0x0008, 1, 1, 0x00, 0x01 },
755925c5749SYifeng Zhao 	.pipe_rate_sel		= { 0x0008, 2, 2, 0x00, 0x01 },
756925c5749SYifeng Zhao 	.pipe_rxterm_sel	= { 0x0008, 8, 8, 0x00, 0x01 },
757925c5749SYifeng Zhao 	.pipe_txelec_sel	= { 0x0008, 12, 12, 0x00, 0x01 },
758925c5749SYifeng Zhao 	.pipe_txcomp_sel	= { 0x0008, 15, 15, 0x00, 0x01 },
759925c5749SYifeng Zhao 	.pipe_clk_ext		= { 0x000c, 9, 8, 0x02, 0x01 },
760925c5749SYifeng Zhao 	.pipe_sel_usb		= { 0x000c, 14, 13, 0x00, 0x01 },
761925c5749SYifeng Zhao 	.pipe_sel_qsgmii	= { 0x000c, 15, 13, 0x00, 0x07 },
762925c5749SYifeng Zhao 	.pipe_phy_status	= { 0x0034, 6, 6, 0x01, 0x00 },
763925c5749SYifeng Zhao 	.con0_for_pcie		= { 0x0000, 15, 0, 0x00, 0x1000 },
764925c5749SYifeng Zhao 	.con1_for_pcie		= { 0x0004, 15, 0, 0x00, 0x0000 },
765925c5749SYifeng Zhao 	.con2_for_pcie		= { 0x0008, 15, 0, 0x00, 0x0101 },
766925c5749SYifeng Zhao 	.con3_for_pcie		= { 0x000c, 15, 0, 0x00, 0x0200 },
767925c5749SYifeng Zhao 	.con0_for_sata		= { 0x0000, 15, 0, 0x00, 0x0119 },
768925c5749SYifeng Zhao 	.con1_for_sata		= { 0x0004, 15, 0, 0x00, 0x0040 },
769925c5749SYifeng Zhao 	.con2_for_sata		= { 0x0008, 15, 0, 0x00, 0x80c3 },
770925c5749SYifeng Zhao 	.con3_for_sata		= { 0x000c, 15, 0, 0x00, 0x4407 },
771925c5749SYifeng Zhao 	/* pipe-grf */
772925c5749SYifeng Zhao 	.pipe_con0_for_sata	= { 0x0000, 15, 0, 0x00, 0x2220 },
773925c5749SYifeng Zhao 	.pipe_sgmii_mac_sel	= { 0x0040, 1, 1, 0x00, 0x01 },
774925c5749SYifeng Zhao 	.pipe_xpcs_phy_ready	= { 0x0040, 2, 2, 0x00, 0x01 },
775925c5749SYifeng Zhao 	.u3otg0_port_en		= { 0x0104, 15, 0, 0x0181, 0x1100 },
776925c5749SYifeng Zhao 	.u3otg1_port_en		= { 0x0144, 15, 0, 0x0181, 0x1100 },
777925c5749SYifeng Zhao };
778925c5749SYifeng Zhao 
779925c5749SYifeng Zhao static const struct rockchip_combphy_cfg rk3568_combphy_cfgs = {
780925c5749SYifeng Zhao 	.grfcfg		= &rk3568_combphy_grfcfgs,
781925c5749SYifeng Zhao 	.combphy_cfg	= rk3568_combphy_cfg,
782fb632bccSShawn Lin 	.force_det_out  = true,
783925c5749SYifeng Zhao };
784fc22f2adSWilliam Wu #endif
785925c5749SYifeng Zhao 
786fc22f2adSWilliam Wu #ifdef CONFIG_ROCKCHIP_RK3588
rk3588_combphy_cfg(struct rockchip_combphy_priv * priv)787cf3c44cbSJon Lin static int rk3588_combphy_cfg(struct rockchip_combphy_priv *priv)
788cf3c44cbSJon Lin {
789cf3c44cbSJon Lin 	const struct rockchip_combphy_grfcfg *cfg = priv->cfg->grfcfg;
790d8968f57SWilliam Wu 	u32 val;
791cf3c44cbSJon Lin 
792cf3c44cbSJon Lin 	switch (priv->mode) {
793cf3c44cbSJon Lin 	case PHY_TYPE_PCIE:
794cf3c44cbSJon Lin 		param_write(priv->phy_grf, &cfg->con0_for_pcie, true);
795cf3c44cbSJon Lin 		param_write(priv->phy_grf, &cfg->con1_for_pcie, true);
796cf3c44cbSJon Lin 		param_write(priv->phy_grf, &cfg->con2_for_pcie, true);
797cf3c44cbSJon Lin 		param_write(priv->phy_grf, &cfg->con3_for_pcie, true);
798cf3c44cbSJon Lin 		break;
799cf3c44cbSJon Lin 	case PHY_TYPE_USB3:
800d8968f57SWilliam Wu 		/* Set SSC downward spread spectrum */
801d8968f57SWilliam Wu 		val = readl(priv->mmio + (0x1f << 2));
802d8968f57SWilliam Wu 		val &= ~GENMASK(5, 4);
803d8968f57SWilliam Wu 		val |= 0x01 << 4;
804d8968f57SWilliam Wu 		writel(val, priv->mmio + 0x7c);
805d8968f57SWilliam Wu 
806d8968f57SWilliam Wu 		/* Enable adaptive CTLE for USB3.0 Rx */
807d8968f57SWilliam Wu 		val = readl(priv->mmio + (0x0e << 2));
808d8968f57SWilliam Wu 		val &= ~GENMASK(0, 0);
809d8968f57SWilliam Wu 		val |= 0x01;
810d8968f57SWilliam Wu 		writel(val, priv->mmio + (0x0e << 2));
811d8968f57SWilliam Wu 
812d8968f57SWilliam Wu 		/* Set PLL KVCO fine tuning signals */
813d8968f57SWilliam Wu 		val = readl(priv->mmio + (0x20 << 2));
814d8968f57SWilliam Wu 		val &= ~(0x7 << 2);
815d8968f57SWilliam Wu 		val |= 0x2 << 2;
816d8968f57SWilliam Wu 		writel(val, priv->mmio + (0x20 << 2));
817d8968f57SWilliam Wu 
818d8968f57SWilliam Wu 		/* Set PLL LPF R1 to su_trim[10:7]=1001 */
819d8968f57SWilliam Wu 		writel(0x4, priv->mmio + (0xb << 2));
820d8968f57SWilliam Wu 
821d8968f57SWilliam Wu 		/* Set PLL input clock divider 1/2 */
822d8968f57SWilliam Wu 		val = readl(priv->mmio + (0x5 << 2));
823d8968f57SWilliam Wu 		val &= ~(0x3 << 6);
824d8968f57SWilliam Wu 		val |= 0x1 << 6;
825d8968f57SWilliam Wu 		writel(val, priv->mmio + (0x5 << 2));
826d8968f57SWilliam Wu 
827d8968f57SWilliam Wu 		/* Set PLL loop divider */
828d8968f57SWilliam Wu 		writel(0x32, priv->mmio + (0x11 << 2));
829d8968f57SWilliam Wu 
830d8968f57SWilliam Wu 		/* Set PLL KVCO to min and set PLL charge pump current to max */
831d8968f57SWilliam Wu 		writel(0xf0, priv->mmio + (0xa << 2));
832d8968f57SWilliam Wu 
83387bfcd06SWilliam Wu 		/* Set Rx squelch input filler bandwidth */
83487bfcd06SWilliam Wu 		writel(0x0d, priv->mmio + (0x14 << 2));
83587bfcd06SWilliam Wu 
836cf3c44cbSJon Lin 		param_write(priv->phy_grf, &cfg->pipe_txcomp_sel, false);
837cf3c44cbSJon Lin 		param_write(priv->phy_grf, &cfg->pipe_txelec_sel, false);
838cf3c44cbSJon Lin 		param_write(priv->phy_grf, &cfg->usb_mode_set, true);
839cf3c44cbSJon Lin 		break;
840cf3c44cbSJon Lin 	case PHY_TYPE_SATA:
841418dd88dSYifeng Zhao 		/* Enable adaptive CTLE for SATA Rx */
842418dd88dSYifeng Zhao 		val = readl(priv->mmio + (0x0e << 2));
843418dd88dSYifeng Zhao 		val &= ~GENMASK(0, 0);
844418dd88dSYifeng Zhao 		val |= 0x01;
845418dd88dSYifeng Zhao 		writel(val, priv->mmio + (0x0e << 2));
846418dd88dSYifeng Zhao 		/* Set tx_rterm = 50 ohm and rx_rterm = 43.5 ohm */
847418dd88dSYifeng Zhao 		writel(0x8F, priv->mmio + (0x06 << 2));
848418dd88dSYifeng Zhao 
849cf3c44cbSJon Lin 		param_write(priv->phy_grf, &cfg->con0_for_sata, true);
850cf3c44cbSJon Lin 		param_write(priv->phy_grf, &cfg->con1_for_sata, true);
851cf3c44cbSJon Lin 		param_write(priv->phy_grf, &cfg->con2_for_sata, true);
852cf3c44cbSJon Lin 		param_write(priv->phy_grf, &cfg->con3_for_sata, true);
853cf3c44cbSJon Lin 		param_write(priv->pipe_grf, &cfg->pipe_con0_for_sata, true);
854cf3c44cbSJon Lin 		param_write(priv->pipe_grf, &cfg->pipe_con1_for_sata, true);
855cf3c44cbSJon Lin 		break;
856cf3c44cbSJon Lin 	case PHY_TYPE_SGMII:
857cf3c44cbSJon Lin 	case PHY_TYPE_QSGMII:
858cf3c44cbSJon Lin 	default:
859cf3c44cbSJon Lin 		dev_err(priv->dev, "incompatible PHY type\n");
860cf3c44cbSJon Lin 		return -EINVAL;
861cf3c44cbSJon Lin 	}
862cf3c44cbSJon Lin 
863c72d402cSJon Lin 	/* 100MHz refclock signal is good */
864c72d402cSJon Lin 	clk_set_rate(&priv->ref_clk, 100000000);
865cf3c44cbSJon Lin 	param_write(priv->phy_grf, &cfg->pipe_clk_100m, true);
866e278c201SKever Yang 	if (priv->mode == PHY_TYPE_PCIE) {
867e278c201SKever Yang 		/* PLL KVCO tuning fine */
868e278c201SKever Yang 		val = readl(priv->mmio + (0x20 << 2));
869e278c201SKever Yang 		val &= ~GENMASK(4, 2);
870e278c201SKever Yang 		val |= 0x4 << 2;
871e278c201SKever Yang 		writel(val, priv->mmio + (0x20 << 2));
872e278c201SKever Yang 
873e278c201SKever Yang 		/* Set up rx_trim: PLL LPF C1 85pf R1 1.25kohm */
874e278c201SKever Yang 		val = 0x4c;
875e278c201SKever Yang 		writel(val, priv->mmio + (0x1b << 2));
876e278c201SKever Yang 
877e278c201SKever Yang 		/* Set up su_trim: T3 */
878e278c201SKever Yang 		val = 0xb0;
879e278c201SKever Yang 		writel(val, priv->mmio + (0xa << 2));
880e278c201SKever Yang 		val = 0x47;
881e278c201SKever Yang 		writel(val, priv->mmio + (0xb << 2));
882e278c201SKever Yang 		val = 0x57;
883e278c201SKever Yang 		writel(val, priv->mmio + (0xd << 2));
884e278c201SKever Yang 	}
885cf3c44cbSJon Lin 
886cf3c44cbSJon Lin 	return 0;
887cf3c44cbSJon Lin }
888cf3c44cbSJon Lin 
889cf3c44cbSJon Lin static const struct rockchip_combphy_grfcfg rk3588_combphy_grfcfgs = {
890cf3c44cbSJon Lin 	/* pipe-phy-grf */
891cf3c44cbSJon Lin 	.pcie_mode_set		= { 0x0000, 5, 0, 0x00, 0x11 },
892cf3c44cbSJon Lin 	.usb_mode_set		= { 0x0000, 5, 0, 0x00, 0x04 },
893cf3c44cbSJon Lin 	.pipe_rxterm_set	= { 0x0000, 12, 12, 0x00, 0x01 },
894cf3c44cbSJon Lin 	.pipe_txelec_set	= { 0x0004, 1, 1, 0x00, 0x01 },
895cf3c44cbSJon Lin 	.pipe_txcomp_set	= { 0x0004, 4, 4, 0x00, 0x01 },
896cf3c44cbSJon Lin 	.pipe_clk_25m		= { 0x0004, 14, 13, 0x00, 0x01 },
897cf3c44cbSJon Lin 	.pipe_clk_100m		= { 0x0004, 14, 13, 0x00, 0x02 },
898cf3c44cbSJon Lin 	.pipe_rxterm_sel	= { 0x0008, 8, 8, 0x00, 0x01 },
899cf3c44cbSJon Lin 	.pipe_txelec_sel	= { 0x0008, 12, 12, 0x00, 0x01 },
900cf3c44cbSJon Lin 	.pipe_txcomp_sel	= { 0x0008, 15, 15, 0x00, 0x01 },
901cf3c44cbSJon Lin 	.pipe_clk_ext		= { 0x000c, 9, 8, 0x02, 0x01 },
902cf3c44cbSJon Lin 	.pipe_phy_status	= { 0x0034, 6, 6, 0x01, 0x00 },
903cf3c44cbSJon Lin 	.con0_for_pcie		= { 0x0000, 15, 0, 0x00, 0x1000 },
904cf3c44cbSJon Lin 	.con1_for_pcie		= { 0x0004, 15, 0, 0x00, 0x0000 },
905cf3c44cbSJon Lin 	.con2_for_pcie		= { 0x0008, 15, 0, 0x00, 0x0101 },
906cf3c44cbSJon Lin 	.con3_for_pcie		= { 0x000c, 15, 0, 0x00, 0x0200 },
907cf3c44cbSJon Lin 	.con0_for_sata		= { 0x0000, 15, 0, 0x00, 0x0129 },
908418dd88dSYifeng Zhao 	.con1_for_sata		= { 0x0004, 15, 0, 0x00, 0x0000 },
909cf3c44cbSJon Lin 	.con2_for_sata		= { 0x0008, 15, 0, 0x00, 0x80c1 },
910cf3c44cbSJon Lin 	.con3_for_sata		= { 0x000c, 15, 0, 0x00, 0x0407 },
911cf3c44cbSJon Lin 	/* pipe-grf */
912cf3c44cbSJon Lin 	.pipe_con0_for_sata	= { 0x0000, 11, 5, 0x00, 0x22 },
913cf3c44cbSJon Lin 	.pipe_con1_for_sata	= { 0x0000, 2, 0, 0x00, 0x2 },
914cf3c44cbSJon Lin };
915cf3c44cbSJon Lin 
916cf3c44cbSJon Lin static const struct rockchip_combphy_cfg rk3588_combphy_cfgs = {
917cf3c44cbSJon Lin 	.grfcfg		= &rk3588_combphy_grfcfgs,
918cf3c44cbSJon Lin 	.combphy_cfg	= rk3588_combphy_cfg,
919fb632bccSShawn Lin 	.force_det_out  = true,
920cf3c44cbSJon Lin };
921fc22f2adSWilliam Wu #endif
922cf3c44cbSJon Lin 
9233f21b61aSJon Lin 
9243f21b61aSJon Lin #ifdef CONFIG_ROCKCHIP_RK3576
rk3576_combphy_cfg(struct rockchip_combphy_priv * priv)9253f21b61aSJon Lin static int rk3576_combphy_cfg(struct rockchip_combphy_priv *priv)
9263f21b61aSJon Lin {
9273f21b61aSJon Lin 	const struct rockchip_combphy_grfcfg *cfg = priv->cfg->grfcfg;
9283f21b61aSJon Lin 	u32 val;
9293f21b61aSJon Lin 
9303f21b61aSJon Lin 	switch (priv->mode) {
9313f21b61aSJon Lin 	case PHY_TYPE_PCIE:
9323f21b61aSJon Lin 		param_write(priv->phy_grf, &cfg->con0_for_pcie, true);
9333f21b61aSJon Lin 		param_write(priv->phy_grf, &cfg->con1_for_pcie, true);
9343f21b61aSJon Lin 		param_write(priv->phy_grf, &cfg->con2_for_pcie, true);
9353f21b61aSJon Lin 		param_write(priv->phy_grf, &cfg->con3_for_pcie, true);
9363f21b61aSJon Lin 		break;
9373f21b61aSJon Lin 	case PHY_TYPE_USB3:
9383f21b61aSJon Lin 		/* Set SSC downward spread spectrum */
9393f21b61aSJon Lin 		val = readl(priv->mmio + (0x1f << 2));
9403f21b61aSJon Lin 		val &= ~GENMASK(5, 4);
9413f21b61aSJon Lin 		val |= 0x01 << 4;
9423f21b61aSJon Lin 		writel(val, priv->mmio + 0x7c);
9433f21b61aSJon Lin 
9443f21b61aSJon Lin 		/* Enable adaptive CTLE for USB3.0 Rx */
9453f21b61aSJon Lin 		val = readl(priv->mmio + (0x0e << 2));
9463f21b61aSJon Lin 		val &= ~GENMASK(0, 0);
9473f21b61aSJon Lin 		val |= 0x01;
9483f21b61aSJon Lin 		writel(val, priv->mmio + (0x0e << 2));
9493f21b61aSJon Lin 
9503f21b61aSJon Lin 		/* Set PLL KVCO fine tuning signals */
9513f21b61aSJon Lin 		val = readl(priv->mmio + (0x20 << 2));
9523f21b61aSJon Lin 		val &= ~(0x7 << 2);
9533f21b61aSJon Lin 		val |= 0x2 << 2;
9543f21b61aSJon Lin 		writel(val, priv->mmio + (0x20 << 2));
9553f21b61aSJon Lin 
9563f21b61aSJon Lin 		/* Set PLL LPF R1 to su_trim[10:7]=1001 */
9573f21b61aSJon Lin 		writel(0x4, priv->mmio + (0xb << 2));
9583f21b61aSJon Lin 
9593f21b61aSJon Lin 		/* Set PLL input clock divider 1/2 */
9603f21b61aSJon Lin 		val = readl(priv->mmio + (0x5 << 2));
9613f21b61aSJon Lin 		val &= ~(0x3 << 6);
9623f21b61aSJon Lin 		val |= 0x1 << 6;
9633f21b61aSJon Lin 		writel(val, priv->mmio + (0x5 << 2));
9643f21b61aSJon Lin 
9653f21b61aSJon Lin 		/* Set PLL loop divider */
9663f21b61aSJon Lin 		writel(0x32, priv->mmio + (0x11 << 2));
9673f21b61aSJon Lin 
9683f21b61aSJon Lin 		/* Set PLL KVCO to min and set PLL charge pump current to max */
9693f21b61aSJon Lin 		writel(0xf0, priv->mmio + (0xa << 2));
9703f21b61aSJon Lin 
9713f21b61aSJon Lin 		/* Set Rx squelch input filler bandwidth */
9723f21b61aSJon Lin 		writel(0x0d, priv->mmio + (0x14 << 2));
9733f21b61aSJon Lin 
9743f21b61aSJon Lin 		param_write(priv->phy_grf, &cfg->pipe_txcomp_sel, false);
9753f21b61aSJon Lin 		param_write(priv->phy_grf, &cfg->pipe_txelec_sel, false);
9763f21b61aSJon Lin 		param_write(priv->phy_grf, &cfg->usb_mode_set, true);
9773f21b61aSJon Lin 		break;
9783f21b61aSJon Lin 	case PHY_TYPE_SATA:
9793f21b61aSJon Lin 		/* Enable adaptive CTLE for SATA Rx */
9803f21b61aSJon Lin 		val = readl(priv->mmio + (0x0e << 2));
9813f21b61aSJon Lin 		val &= ~GENMASK(0, 0);
9823f21b61aSJon Lin 		val |= 0x01;
9833f21b61aSJon Lin 		writel(val, priv->mmio + (0x0e << 2));
9843f21b61aSJon Lin 		/* Set tx_rterm = 50 ohm and rx_rterm = 43.5 ohm */
9853f21b61aSJon Lin 		writel(0x8F, priv->mmio + (0x06 << 2));
9863f21b61aSJon Lin 
9873f21b61aSJon Lin 		param_write(priv->phy_grf, &cfg->con0_for_sata, true);
9883f21b61aSJon Lin 		param_write(priv->phy_grf, &cfg->con1_for_sata, true);
9893f21b61aSJon Lin 		param_write(priv->phy_grf, &cfg->con2_for_sata, true);
9903f21b61aSJon Lin 		param_write(priv->phy_grf, &cfg->con3_for_sata, true);
9913f21b61aSJon Lin 		param_write(priv->pipe_grf, &cfg->pipe_con0_for_sata, true);
9923f21b61aSJon Lin 		param_write(priv->pipe_grf, &cfg->pipe_con1_for_sata, true);
9933f21b61aSJon Lin 		break;
9943f21b61aSJon Lin 	case PHY_TYPE_SGMII:
9953f21b61aSJon Lin 	case PHY_TYPE_QSGMII:
9963f21b61aSJon Lin 	default:
9973f21b61aSJon Lin 		dev_err(priv->dev, "incompatible PHY type\n");
9983f21b61aSJon Lin 		return -EINVAL;
9993f21b61aSJon Lin 	}
10003f21b61aSJon Lin 
10013f21b61aSJon Lin 	/* 100MHz refclock signal is good */
10023f21b61aSJon Lin 	clk_set_rate(&priv->ref_clk, 100000000);
10033f21b61aSJon Lin 	param_write(priv->phy_grf, &cfg->pipe_clk_100m, true);
10043f21b61aSJon Lin 	if (priv->mode == PHY_TYPE_PCIE) {
10053f21b61aSJon Lin 		/* gate_tx_pck_sel length select work for L1SS */
10063f21b61aSJon Lin 		writel(0xc0, priv->mmio + 0x74);
10073f21b61aSJon Lin 
10083f21b61aSJon Lin 		/* PLL KVCO tuning fine */
10093f21b61aSJon Lin 		val = readl(priv->mmio + (0x20 << 2));
10103f21b61aSJon Lin 		val &= ~(0x7 << 2);
10113f21b61aSJon Lin 		val |= 0x2 << 2;
10123f21b61aSJon Lin 		writel(val, priv->mmio + (0x20 << 2));
10133f21b61aSJon Lin 
10143f21b61aSJon Lin 		/* Set up rx_trim: PLL LPF C1 85pf R1 1.25kohm */
10153f21b61aSJon Lin 		writel(0x4c, priv->mmio + (0x1b << 2));
10163f21b61aSJon Lin 
10173f21b61aSJon Lin 		/* Set up su_trim: T3_P1 650mv */
10183f21b61aSJon Lin 		writel(0x90, priv->mmio + (0xa << 2));
10193f21b61aSJon Lin 		writel(0x43, priv->mmio + (0xb << 2));
10203f21b61aSJon Lin 		writel(0x88, priv->mmio + (0xc << 2));
10213f21b61aSJon Lin 		writel(0x56, priv->mmio + (0xd << 2));
10223f21b61aSJon Lin 	}
10233f21b61aSJon Lin 
10243f21b61aSJon Lin 	return 0;
10253f21b61aSJon Lin }
10263f21b61aSJon Lin 
10273f21b61aSJon Lin static const struct rockchip_combphy_grfcfg rk3576_combphy_grfcfgs = {
10283f21b61aSJon Lin 	/* pipe-phy-grf */
10293f21b61aSJon Lin 	.pcie_mode_set		= { 0x0000, 5, 0, 0x00, 0x11 },
10303f21b61aSJon Lin 	.usb_mode_set		= { 0x0000, 5, 0, 0x00, 0x04 },
10313f21b61aSJon Lin 	.pipe_rxterm_set	= { 0x0000, 12, 12, 0x00, 0x01 },
10323f21b61aSJon Lin 	.pipe_txelec_set	= { 0x0004, 1, 1, 0x00, 0x01 },
10333f21b61aSJon Lin 	.pipe_txcomp_set	= { 0x0004, 4, 4, 0x00, 0x01 },
10343f21b61aSJon Lin 	.pipe_clk_24m		= { 0x0004, 14, 13, 0x00, 0x00 },
10353f21b61aSJon Lin 	.pipe_clk_25m		= { 0x0004, 14, 13, 0x00, 0x01 },
10363f21b61aSJon Lin 	.pipe_clk_100m		= { 0x0004, 14, 13, 0x00, 0x02 },
10373f21b61aSJon Lin 	.pipe_phymode_sel	= { 0x0008, 1, 1, 0x00, 0x01 },
10383f21b61aSJon Lin 	.pipe_rate_sel		= { 0x0008, 2, 2, 0x00, 0x01 },
10393f21b61aSJon Lin 	.pipe_rxterm_sel	= { 0x0008, 8, 8, 0x00, 0x01 },
10403f21b61aSJon Lin 	.pipe_txelec_sel	= { 0x0008, 12, 12, 0x00, 0x01 },
10413f21b61aSJon Lin 	.pipe_txcomp_sel	= { 0x0008, 15, 15, 0x00, 0x01 },
10423f21b61aSJon Lin 	.pipe_clk_ext		= { 0x000c, 9, 8, 0x02, 0x01 },
10433f21b61aSJon Lin 	.pipe_phy_status	= { 0x0034, 6, 6, 0x01, 0x00 },
10443f21b61aSJon Lin 	.con0_for_pcie		= { 0x0000, 15, 0, 0x00, 0x1000 },
10453f21b61aSJon Lin 	.con1_for_pcie		= { 0x0004, 15, 0, 0x00, 0x0000 },
10463f21b61aSJon Lin 	.con2_for_pcie		= { 0x0008, 15, 0, 0x00, 0x0101 },
10473f21b61aSJon Lin 	.con3_for_pcie		= { 0x000c, 15, 0, 0x00, 0x0200 },
10483f21b61aSJon Lin 	.con0_for_sata		= { 0x0000, 15, 0, 0x00, 0x0129 },
10493f21b61aSJon Lin 	.con1_for_sata		= { 0x0004, 15, 0, 0x00, 0x0000 },
10503f21b61aSJon Lin 	.con2_for_sata		= { 0x0008, 15, 0, 0x00, 0x80c1 },
10513f21b61aSJon Lin 	.con3_for_sata		= { 0x000c, 15, 0, 0x00, 0x0407 },
10523f21b61aSJon Lin 	.pipe_phy_grf_reset	= { 0x0014, 1, 0, 0x3, 0x1 },
10533f21b61aSJon Lin 	/* php-grf */
10543f21b61aSJon Lin 	.pipe_con0_for_sata	= { 0x001C, 2, 0, 0x00, 0x2 },
10553f21b61aSJon Lin 	.pipe_con1_for_sata	= { 0x0020, 2, 0, 0x00, 0x2 },
10563f21b61aSJon Lin 	.u3otg1_port_en		= { 0x0038, 15, 0, 0x0181, 0x1100 },
10573f21b61aSJon Lin };
10583f21b61aSJon Lin 
10593f21b61aSJon Lin static const struct rockchip_combphy_cfg rk3576_combphy_cfgs = {
10603f21b61aSJon Lin 	.grfcfg		= &rk3576_combphy_grfcfgs,
10613f21b61aSJon Lin 	.combphy_cfg	= rk3576_combphy_cfg,
10623f21b61aSJon Lin };
10633f21b61aSJon Lin #endif
10643f21b61aSJon Lin 
1065eed45787SFrank Wang #ifdef CONFIG_ROCKCHIP_RV1126B
rv1126b_combphy_cfg(struct rockchip_combphy_priv * priv)1066eed45787SFrank Wang static int rv1126b_combphy_cfg(struct rockchip_combphy_priv *priv)
1067eed45787SFrank Wang {
1068eed45787SFrank Wang 	const struct rockchip_combphy_grfcfg *cfg = priv->cfg->grfcfg;
1069eed45787SFrank Wang 	u32 val;
1070eed45787SFrank Wang 
1071eed45787SFrank Wang 	switch (priv->mode) {
1072eed45787SFrank Wang 	case PHY_TYPE_USB3:
1073eed45787SFrank Wang 		/* Set SSC downward spread spectrum */
1074eed45787SFrank Wang 		val = readl(priv->mmio + (0x1f << 2));
1075eed45787SFrank Wang 		val &= ~GENMASK(5, 4);
1076eed45787SFrank Wang 		val |= 0x01 << 4;
1077eed45787SFrank Wang 		writel(val, priv->mmio + 0x7c);
1078eed45787SFrank Wang 
1079eed45787SFrank Wang 		/* Enable adaptive CTLE for USB3.0 Rx */
1080eed45787SFrank Wang 		val = readl(priv->mmio + (0x0e << 2));
1081eed45787SFrank Wang 		val &= ~GENMASK(0, 0);
1082eed45787SFrank Wang 		val |= 0x01;
1083eed45787SFrank Wang 		writel(val, priv->mmio + (0x0e << 2));
1084eed45787SFrank Wang 
1085eed45787SFrank Wang 		/* Set PLL KVCO fine tuning signals */
1086eed45787SFrank Wang 		val = readl(priv->mmio + (0x20 << 2));
1087eed45787SFrank Wang 		val &= ~(0x7 << 2);
1088eed45787SFrank Wang 		val |= 0x2 << 2;
1089eed45787SFrank Wang 		writel(val, priv->mmio + (0x20 << 2));
1090eed45787SFrank Wang 
1091eed45787SFrank Wang 		/* Set PLL LPF R1 to su_trim[10:7]=1001 */
1092eed45787SFrank Wang 		writel(0x4, priv->mmio + (0x0b << 2));
1093eed45787SFrank Wang 
1094eed45787SFrank Wang 		/* Set PLL input clock divider 1/2 */
1095eed45787SFrank Wang 		val = readl(priv->mmio + (0x5 << 2));
1096eed45787SFrank Wang 		val &= ~(0x3 << 6);
1097eed45787SFrank Wang 		val |= 0x1 << 6;
1098eed45787SFrank Wang 		writel(val, priv->mmio + (0x5 << 2));
1099eed45787SFrank Wang 
1100eed45787SFrank Wang 		/* Set PLL loop divider */
1101eed45787SFrank Wang 		writel(0x32, priv->mmio + (0x11 << 2));
1102eed45787SFrank Wang 
1103eed45787SFrank Wang 		/* Set PLL KVCO to min and set PLL charge pump current to max */
1104eed45787SFrank Wang 		writel(0xf0, priv->mmio + (0x0a << 2));
1105eed45787SFrank Wang 
1106eed45787SFrank Wang 		/* Set Rx squelch input filler bandwidth */
1107eed45787SFrank Wang 		writel(0x0e, priv->mmio + (0x14 << 2));
1108eed45787SFrank Wang 
1109eed45787SFrank Wang 		param_write(priv->phy_grf, &cfg->pipe_sel_usb, true);
1110eed45787SFrank Wang 		param_write(priv->phy_grf, &cfg->pipe_txcomp_sel, false);
1111eed45787SFrank Wang 		param_write(priv->phy_grf, &cfg->pipe_txelec_sel, false);
1112eed45787SFrank Wang 		param_write(priv->phy_grf, &cfg->usb_mode_set, true);
1113eed45787SFrank Wang 		break;
1114eed45787SFrank Wang 	default:
1115eed45787SFrank Wang 		dev_err(priv->dev, "incompatible PHY type\n");
1116eed45787SFrank Wang 		return -EINVAL;
1117eed45787SFrank Wang 	}
1118eed45787SFrank Wang 
1119eed45787SFrank Wang 	clk_set_rate(&priv->ref_clk, 100000000);
1120eed45787SFrank Wang 	param_write(priv->phy_grf, &cfg->pipe_clk_100m, true);
1121eed45787SFrank Wang 
1122eed45787SFrank Wang 	return 0;
1123eed45787SFrank Wang }
1124eed45787SFrank Wang 
1125eed45787SFrank Wang static const struct rockchip_combphy_grfcfg rv1126b_combphy_grfcfgs = {
1126eed45787SFrank Wang 	/* pipe-phy-grf */
1127eed45787SFrank Wang 	.usb_mode_set		= { 0x18000, 5, 0, 0x00, 0x04 },
1128eed45787SFrank Wang 	.pipe_rxterm_set	= { 0x18000, 12, 12, 0x00, 0x01 },
1129eed45787SFrank Wang 	.pipe_txelec_set	= { 0x18004, 1, 1, 0x00, 0x01 },
1130eed45787SFrank Wang 	.pipe_txcomp_set	= { 0x18004, 4, 4, 0x00, 0x01 },
1131eed45787SFrank Wang 	.pipe_clk_25m		= { 0x18004, 14, 13, 0x00, 0x01 },
1132eed45787SFrank Wang 	.pipe_clk_100m		= { 0x18004, 14, 13, 0x00, 0x02 },
1133eed45787SFrank Wang 	.pipe_phymode_sel	= { 0x18008, 1, 1, 0x00, 0x01 },
1134eed45787SFrank Wang 	.pipe_rate_sel		= { 0x18008, 2, 2, 0x00, 0x01 },
1135eed45787SFrank Wang 	.pipe_rxterm_sel	= { 0x18008, 8, 8, 0x00, 0x01 },
1136eed45787SFrank Wang 	.pipe_txelec_sel	= { 0x18008, 12, 12, 0x00, 0x01 },
1137eed45787SFrank Wang 	.pipe_txcomp_sel	= { 0x18008, 15, 15, 0x00, 0x01 },
1138eed45787SFrank Wang 	.pipe_clk_ext		= { 0x1800c, 9, 8, 0x02, 0x01 },
1139eed45787SFrank Wang 	.pipe_sel_usb		= { 0x1800c, 14, 13, 0x00, 0x01 },
1140eed45787SFrank Wang 	.pipe_phy_status	= { 0x18034, 6, 6, 0x01, 0x00 },
1141eed45787SFrank Wang 	/* peri-grf */
1142eed45787SFrank Wang 	.u3otg0_port_en		= { 0x1003c, 15, 0, 0x0189, 0x1100 },
1143*84b0fdcdSFrank Wang 	/* pmu-grf */
1144*84b0fdcdSFrank Wang 	.u3otg0_clamp_dis	= { 0x30000, 14, 14, 0x00, 0x01 },
1145eed45787SFrank Wang };
1146eed45787SFrank Wang 
1147eed45787SFrank Wang static const struct rockchip_combphy_cfg rv1126b_combphy_cfgs = {
1148eed45787SFrank Wang 	.grfcfg		= &rv1126b_combphy_grfcfgs,
1149eed45787SFrank Wang 	.combphy_cfg	= rv1126b_combphy_cfg,
1150eed45787SFrank Wang 	.force_det_out	= true,
1151eed45787SFrank Wang };
1152eed45787SFrank Wang #endif
1153eed45787SFrank Wang 
1154925c5749SYifeng Zhao static const struct udevice_id rockchip_combphy_ids[] = {
1155fc22f2adSWilliam Wu #ifdef CONFIG_ROCKCHIP_RK3528
1156925c5749SYifeng Zhao 	{
11573452d642SJianwei Zheng 		.compatible = "rockchip,rk3528-naneng-combphy",
11583452d642SJianwei Zheng 		.data = (ulong)&rk3528_combphy_cfgs
11593452d642SJianwei Zheng 	},
1160fc22f2adSWilliam Wu #endif
1161fc22f2adSWilliam Wu #ifdef CONFIG_ROCKCHIP_RK3562
11623452d642SJianwei Zheng 	{
1163885c5d5dSFrank Wang 		.compatible = "rockchip,rk3562-naneng-combphy",
1164885c5d5dSFrank Wang 		.data = (ulong)&rk3562_combphy_cfgs
1165885c5d5dSFrank Wang 	},
1166fc22f2adSWilliam Wu #endif
1167fc22f2adSWilliam Wu #ifdef CONFIG_ROCKCHIP_RK3568
1168885c5d5dSFrank Wang 	{
1169925c5749SYifeng Zhao 		.compatible = "rockchip,rk3568-naneng-combphy",
1170925c5749SYifeng Zhao 		.data = (ulong)&rk3568_combphy_cfgs
1171925c5749SYifeng Zhao 	},
1172fc22f2adSWilliam Wu #endif
1173fc22f2adSWilliam Wu #ifdef CONFIG_ROCKCHIP_RK3588
1174cf3c44cbSJon Lin 	{
1175cf3c44cbSJon Lin 		.compatible = "rockchip,rk3588-naneng-combphy",
1176cf3c44cbSJon Lin 		.data = (ulong)&rk3588_combphy_cfgs
1177cf3c44cbSJon Lin 	},
1178fc22f2adSWilliam Wu #endif
11793f21b61aSJon Lin #ifdef CONFIG_ROCKCHIP_RK3576
11803f21b61aSJon Lin 	{
11813f21b61aSJon Lin 		.compatible = "rockchip,rk3576-naneng-combphy",
11823f21b61aSJon Lin 		.data = (ulong)&rk3576_combphy_cfgs
11833f21b61aSJon Lin 	},
11843f21b61aSJon Lin #endif
1185eed45787SFrank Wang #ifdef CONFIG_ROCKCHIP_RV1126B
1186eed45787SFrank Wang 	{
1187eed45787SFrank Wang 		.compatible = "rockchip,rv1126b-usb3-phy",
1188eed45787SFrank Wang 		.data = (ulong)&rv1126b_combphy_cfgs
1189eed45787SFrank Wang 	},
1190eed45787SFrank Wang #endif
1191925c5749SYifeng Zhao 	{ }
1192925c5749SYifeng Zhao };
1193925c5749SYifeng Zhao 
1194925c5749SYifeng Zhao U_BOOT_DRIVER(rockchip_naneng_combphy) = {
1195925c5749SYifeng Zhao 	.name		= "naneng-combphy",
1196925c5749SYifeng Zhao 	.id		= UCLASS_PHY,
1197925c5749SYifeng Zhao 	.of_match	= rockchip_combphy_ids,
1198925c5749SYifeng Zhao 	.ops		= &rochchip_combphy_ops,
1199925c5749SYifeng Zhao 	.probe		= rockchip_combphy_probe,
1200925c5749SYifeng Zhao 	.priv_auto_alloc_size = sizeof(struct rockchip_combphy_priv),
1201925c5749SYifeng Zhao };
1202