1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * Rockchip PIPE USB3.0 PCIE SATA combphy driver
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * Copyright (C) 2020 Rockchip Electronics Co., Ltd.
6*4882a593Smuzhiyun */
7*4882a593Smuzhiyun
8*4882a593Smuzhiyun #include <linux/clk.h>
9*4882a593Smuzhiyun #include <linux/delay.h>
10*4882a593Smuzhiyun #include <linux/io.h>
11*4882a593Smuzhiyun #include <linux/iopoll.h>
12*4882a593Smuzhiyun #include <linux/kernel.h>
13*4882a593Smuzhiyun #include <linux/mfd/syscon.h>
14*4882a593Smuzhiyun #include <linux/module.h>
15*4882a593Smuzhiyun #include <linux/of_device.h>
16*4882a593Smuzhiyun #include <linux/phy/phy.h>
17*4882a593Smuzhiyun #include <linux/regmap.h>
18*4882a593Smuzhiyun #include <linux/reset.h>
19*4882a593Smuzhiyun #include <dt-bindings/phy/phy.h>
20*4882a593Smuzhiyun
21*4882a593Smuzhiyun #define BIT_WRITEABLE_SHIFT 16
22*4882a593Smuzhiyun
23*4882a593Smuzhiyun struct rockchip_combphy_priv;
24*4882a593Smuzhiyun
25*4882a593Smuzhiyun struct combphy_reg {
26*4882a593Smuzhiyun u32 offset;
27*4882a593Smuzhiyun u16 bitend;
28*4882a593Smuzhiyun u16 bitstart;
29*4882a593Smuzhiyun u16 disable;
30*4882a593Smuzhiyun u16 enable;
31*4882a593Smuzhiyun };
32*4882a593Smuzhiyun
33*4882a593Smuzhiyun struct rockchip_combphy_grfcfg {
34*4882a593Smuzhiyun struct combphy_reg pcie_mode_set;
35*4882a593Smuzhiyun struct combphy_reg usb_mode_set;
36*4882a593Smuzhiyun struct combphy_reg sgmii_mode_set;
37*4882a593Smuzhiyun struct combphy_reg qsgmii_mode_set;
38*4882a593Smuzhiyun struct combphy_reg pipe_rxterm_set;
39*4882a593Smuzhiyun struct combphy_reg pipe_txelec_set;
40*4882a593Smuzhiyun struct combphy_reg pipe_txcomp_set;
41*4882a593Smuzhiyun struct combphy_reg pipe_clk_24m;
42*4882a593Smuzhiyun struct combphy_reg pipe_clk_25m;
43*4882a593Smuzhiyun struct combphy_reg pipe_clk_100m;
44*4882a593Smuzhiyun struct combphy_reg pipe_phymode_sel;
45*4882a593Smuzhiyun struct combphy_reg pipe_rate_sel;
46*4882a593Smuzhiyun struct combphy_reg pipe_rxterm_sel;
47*4882a593Smuzhiyun struct combphy_reg pipe_txelec_sel;
48*4882a593Smuzhiyun struct combphy_reg pipe_txcomp_sel;
49*4882a593Smuzhiyun struct combphy_reg pipe_clk_ext;
50*4882a593Smuzhiyun struct combphy_reg pipe_sel_usb;
51*4882a593Smuzhiyun struct combphy_reg pipe_sel_qsgmii;
52*4882a593Smuzhiyun struct combphy_reg pipe_phy_status;
53*4882a593Smuzhiyun struct combphy_reg con0_for_pcie;
54*4882a593Smuzhiyun struct combphy_reg con1_for_pcie;
55*4882a593Smuzhiyun struct combphy_reg con2_for_pcie;
56*4882a593Smuzhiyun struct combphy_reg con3_for_pcie;
57*4882a593Smuzhiyun struct combphy_reg con0_for_sata;
58*4882a593Smuzhiyun struct combphy_reg con1_for_sata;
59*4882a593Smuzhiyun struct combphy_reg con2_for_sata;
60*4882a593Smuzhiyun struct combphy_reg con3_for_sata;
61*4882a593Smuzhiyun struct combphy_reg pipe_con0_for_sata;
62*4882a593Smuzhiyun struct combphy_reg pipe_con1_for_sata;
63*4882a593Smuzhiyun struct combphy_reg pipe_sgmii_mac_sel;
64*4882a593Smuzhiyun struct combphy_reg pipe_xpcs_phy_ready;
65*4882a593Smuzhiyun struct combphy_reg u3otg0_port_en;
66*4882a593Smuzhiyun struct combphy_reg u3otg1_port_en;
67*4882a593Smuzhiyun struct combphy_reg pipe_phy_grf_reset;
68*4882a593Smuzhiyun };
69*4882a593Smuzhiyun
70*4882a593Smuzhiyun struct rockchip_combphy_cfg {
71*4882a593Smuzhiyun const int num_clks;
72*4882a593Smuzhiyun const struct clk_bulk_data *clks;
73*4882a593Smuzhiyun const struct rockchip_combphy_grfcfg *grfcfg;
74*4882a593Smuzhiyun bool force_det_out; /* Tx detect Rx errata */
75*4882a593Smuzhiyun int (*combphy_cfg)(struct rockchip_combphy_priv *priv);
76*4882a593Smuzhiyun };
77*4882a593Smuzhiyun
78*4882a593Smuzhiyun struct rockchip_combphy_priv {
79*4882a593Smuzhiyun u8 mode;
80*4882a593Smuzhiyun void __iomem *mmio;
81*4882a593Smuzhiyun int num_clks;
82*4882a593Smuzhiyun struct clk_bulk_data *clks;
83*4882a593Smuzhiyun struct device *dev;
84*4882a593Smuzhiyun struct regmap *pipe_grf;
85*4882a593Smuzhiyun struct regmap *phy_grf;
86*4882a593Smuzhiyun struct phy *phy;
87*4882a593Smuzhiyun struct reset_control *apb_rst;
88*4882a593Smuzhiyun struct reset_control *phy_rst;
89*4882a593Smuzhiyun const struct rockchip_combphy_cfg *cfg;
90*4882a593Smuzhiyun };
91*4882a593Smuzhiyun
param_read(struct regmap * base,const struct combphy_reg * reg,u32 val)92*4882a593Smuzhiyun static inline bool param_read(struct regmap *base,
93*4882a593Smuzhiyun const struct combphy_reg *reg, u32 val)
94*4882a593Smuzhiyun {
95*4882a593Smuzhiyun int ret;
96*4882a593Smuzhiyun u32 mask, orig, tmp;
97*4882a593Smuzhiyun
98*4882a593Smuzhiyun ret = regmap_read(base, reg->offset, &orig);
99*4882a593Smuzhiyun if (ret)
100*4882a593Smuzhiyun return false;
101*4882a593Smuzhiyun
102*4882a593Smuzhiyun mask = GENMASK(reg->bitend, reg->bitstart);
103*4882a593Smuzhiyun tmp = (orig & mask) >> reg->bitstart;
104*4882a593Smuzhiyun
105*4882a593Smuzhiyun return tmp == val;
106*4882a593Smuzhiyun }
107*4882a593Smuzhiyun
param_write(struct regmap * base,const struct combphy_reg * reg,bool en)108*4882a593Smuzhiyun static int param_write(struct regmap *base,
109*4882a593Smuzhiyun const struct combphy_reg *reg, bool en)
110*4882a593Smuzhiyun {
111*4882a593Smuzhiyun u32 val, mask, tmp;
112*4882a593Smuzhiyun
113*4882a593Smuzhiyun tmp = en ? reg->enable : reg->disable;
114*4882a593Smuzhiyun mask = GENMASK(reg->bitend, reg->bitstart);
115*4882a593Smuzhiyun val = (tmp << reg->bitstart) | (mask << BIT_WRITEABLE_SHIFT);
116*4882a593Smuzhiyun
117*4882a593Smuzhiyun return regmap_write(base, reg->offset, val);
118*4882a593Smuzhiyun }
119*4882a593Smuzhiyun
rockchip_combphy_is_ready(struct rockchip_combphy_priv * priv)120*4882a593Smuzhiyun static u32 rockchip_combphy_is_ready(struct rockchip_combphy_priv *priv)
121*4882a593Smuzhiyun {
122*4882a593Smuzhiyun const struct rockchip_combphy_grfcfg *cfg = priv->cfg->grfcfg;
123*4882a593Smuzhiyun u32 mask, val;
124*4882a593Smuzhiyun
125*4882a593Smuzhiyun mask = GENMASK(cfg->pipe_phy_status.bitend,
126*4882a593Smuzhiyun cfg->pipe_phy_status.bitstart);
127*4882a593Smuzhiyun
128*4882a593Smuzhiyun regmap_read(priv->phy_grf, cfg->pipe_phy_status.offset, &val);
129*4882a593Smuzhiyun val = (val & mask) >> cfg->pipe_phy_status.bitstart;
130*4882a593Smuzhiyun
131*4882a593Smuzhiyun return val;
132*4882a593Smuzhiyun }
133*4882a593Smuzhiyun
rockchip_combphy_pcie_init(struct rockchip_combphy_priv * priv)134*4882a593Smuzhiyun static int rockchip_combphy_pcie_init(struct rockchip_combphy_priv *priv)
135*4882a593Smuzhiyun {
136*4882a593Smuzhiyun int ret = 0;
137*4882a593Smuzhiyun u32 val;
138*4882a593Smuzhiyun
139*4882a593Smuzhiyun if (priv->cfg->combphy_cfg) {
140*4882a593Smuzhiyun ret = priv->cfg->combphy_cfg(priv);
141*4882a593Smuzhiyun if (ret) {
142*4882a593Smuzhiyun dev_err(priv->dev, "failed to init phy for pcie\n");
143*4882a593Smuzhiyun return ret;
144*4882a593Smuzhiyun }
145*4882a593Smuzhiyun }
146*4882a593Smuzhiyun
147*4882a593Smuzhiyun if (priv->cfg->force_det_out) {
148*4882a593Smuzhiyun val = readl(priv->mmio + (0x19 << 2));
149*4882a593Smuzhiyun val |= BIT(5);
150*4882a593Smuzhiyun writel(val, priv->mmio + (0x19 << 2));
151*4882a593Smuzhiyun }
152*4882a593Smuzhiyun
153*4882a593Smuzhiyun return ret;
154*4882a593Smuzhiyun }
155*4882a593Smuzhiyun
rockchip_combphy_usb3_init(struct rockchip_combphy_priv * priv)156*4882a593Smuzhiyun static int rockchip_combphy_usb3_init(struct rockchip_combphy_priv *priv)
157*4882a593Smuzhiyun {
158*4882a593Smuzhiyun const struct rockchip_combphy_cfg *phy_cfg = priv->cfg;
159*4882a593Smuzhiyun int ret = 0;
160*4882a593Smuzhiyun
161*4882a593Smuzhiyun if (device_property_present(priv->dev, "rockchip,dis-u3otg0-port")) {
162*4882a593Smuzhiyun ret = param_write(priv->pipe_grf, &phy_cfg->grfcfg->u3otg0_port_en,
163*4882a593Smuzhiyun false);
164*4882a593Smuzhiyun return ret;
165*4882a593Smuzhiyun } else if (device_property_present(priv->dev, "rockchip,dis-u3otg1-port")) {
166*4882a593Smuzhiyun ret = param_write(priv->pipe_grf, &phy_cfg->grfcfg->u3otg1_port_en,
167*4882a593Smuzhiyun false);
168*4882a593Smuzhiyun return ret;
169*4882a593Smuzhiyun }
170*4882a593Smuzhiyun
171*4882a593Smuzhiyun if (priv->cfg->combphy_cfg) {
172*4882a593Smuzhiyun ret = priv->cfg->combphy_cfg(priv);
173*4882a593Smuzhiyun if (ret) {
174*4882a593Smuzhiyun dev_err(priv->dev, "failed to init phy for usb3\n");
175*4882a593Smuzhiyun return ret;
176*4882a593Smuzhiyun }
177*4882a593Smuzhiyun }
178*4882a593Smuzhiyun
179*4882a593Smuzhiyun return ret;
180*4882a593Smuzhiyun }
181*4882a593Smuzhiyun
rockchip_combphy_sata_init(struct rockchip_combphy_priv * priv)182*4882a593Smuzhiyun static int rockchip_combphy_sata_init(struct rockchip_combphy_priv *priv)
183*4882a593Smuzhiyun {
184*4882a593Smuzhiyun int ret = 0;
185*4882a593Smuzhiyun
186*4882a593Smuzhiyun if (priv->cfg->combphy_cfg) {
187*4882a593Smuzhiyun ret = priv->cfg->combphy_cfg(priv);
188*4882a593Smuzhiyun if (ret) {
189*4882a593Smuzhiyun dev_err(priv->dev, "failed to init phy for sata\n");
190*4882a593Smuzhiyun return ret;
191*4882a593Smuzhiyun }
192*4882a593Smuzhiyun }
193*4882a593Smuzhiyun
194*4882a593Smuzhiyun return ret;
195*4882a593Smuzhiyun }
196*4882a593Smuzhiyun
rockchip_combphy_sgmii_init(struct rockchip_combphy_priv * priv)197*4882a593Smuzhiyun static int rockchip_combphy_sgmii_init(struct rockchip_combphy_priv *priv)
198*4882a593Smuzhiyun {
199*4882a593Smuzhiyun int ret = 0;
200*4882a593Smuzhiyun
201*4882a593Smuzhiyun if (priv->cfg->combphy_cfg) {
202*4882a593Smuzhiyun ret = priv->cfg->combphy_cfg(priv);
203*4882a593Smuzhiyun if (ret) {
204*4882a593Smuzhiyun dev_err(priv->dev, "failed to init phy for sgmii\n");
205*4882a593Smuzhiyun return ret;
206*4882a593Smuzhiyun }
207*4882a593Smuzhiyun }
208*4882a593Smuzhiyun
209*4882a593Smuzhiyun return ret;
210*4882a593Smuzhiyun }
211*4882a593Smuzhiyun
rockchip_combphy_set_mode(struct rockchip_combphy_priv * priv)212*4882a593Smuzhiyun static int rockchip_combphy_set_mode(struct rockchip_combphy_priv *priv)
213*4882a593Smuzhiyun {
214*4882a593Smuzhiyun switch (priv->mode) {
215*4882a593Smuzhiyun case PHY_TYPE_PCIE:
216*4882a593Smuzhiyun rockchip_combphy_pcie_init(priv);
217*4882a593Smuzhiyun break;
218*4882a593Smuzhiyun case PHY_TYPE_USB3:
219*4882a593Smuzhiyun rockchip_combphy_usb3_init(priv);
220*4882a593Smuzhiyun break;
221*4882a593Smuzhiyun case PHY_TYPE_SATA:
222*4882a593Smuzhiyun rockchip_combphy_sata_init(priv);
223*4882a593Smuzhiyun break;
224*4882a593Smuzhiyun case PHY_TYPE_SGMII:
225*4882a593Smuzhiyun case PHY_TYPE_QSGMII:
226*4882a593Smuzhiyun return rockchip_combphy_sgmii_init(priv);
227*4882a593Smuzhiyun default:
228*4882a593Smuzhiyun dev_err(priv->dev, "incompatible PHY type\n");
229*4882a593Smuzhiyun return -EINVAL;
230*4882a593Smuzhiyun }
231*4882a593Smuzhiyun
232*4882a593Smuzhiyun return 0;
233*4882a593Smuzhiyun }
234*4882a593Smuzhiyun
rockchip_combphy_init(struct phy * phy)235*4882a593Smuzhiyun static int rockchip_combphy_init(struct phy *phy)
236*4882a593Smuzhiyun {
237*4882a593Smuzhiyun struct rockchip_combphy_priv *priv = phy_get_drvdata(phy);
238*4882a593Smuzhiyun const struct rockchip_combphy_grfcfg *cfg = priv->cfg->grfcfg;
239*4882a593Smuzhiyun u32 val;
240*4882a593Smuzhiyun int ret;
241*4882a593Smuzhiyun
242*4882a593Smuzhiyun ret = clk_bulk_prepare_enable(priv->num_clks, priv->clks);
243*4882a593Smuzhiyun if (ret) {
244*4882a593Smuzhiyun dev_err(priv->dev, "failed to enable clks\n");
245*4882a593Smuzhiyun return ret;
246*4882a593Smuzhiyun }
247*4882a593Smuzhiyun
248*4882a593Smuzhiyun ret = rockchip_combphy_set_mode(priv);
249*4882a593Smuzhiyun if (ret)
250*4882a593Smuzhiyun goto err_clk;
251*4882a593Smuzhiyun
252*4882a593Smuzhiyun ret = reset_control_deassert(priv->phy_rst);
253*4882a593Smuzhiyun if (ret)
254*4882a593Smuzhiyun goto err_clk;
255*4882a593Smuzhiyun
256*4882a593Smuzhiyun if (cfg->pipe_phy_grf_reset.enable)
257*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->pipe_phy_grf_reset, false);
258*4882a593Smuzhiyun
259*4882a593Smuzhiyun if (priv->mode == PHY_TYPE_USB3) {
260*4882a593Smuzhiyun ret = readx_poll_timeout_atomic(rockchip_combphy_is_ready,
261*4882a593Smuzhiyun priv, val,
262*4882a593Smuzhiyun val == cfg->pipe_phy_status.enable,
263*4882a593Smuzhiyun 10, 1000);
264*4882a593Smuzhiyun if (ret)
265*4882a593Smuzhiyun dev_warn(priv->dev, "wait phy status ready timeout\n");
266*4882a593Smuzhiyun }
267*4882a593Smuzhiyun
268*4882a593Smuzhiyun return 0;
269*4882a593Smuzhiyun
270*4882a593Smuzhiyun err_clk:
271*4882a593Smuzhiyun clk_bulk_disable_unprepare(priv->num_clks, priv->clks);
272*4882a593Smuzhiyun
273*4882a593Smuzhiyun return ret;
274*4882a593Smuzhiyun }
275*4882a593Smuzhiyun
rockchip_combphy_exit(struct phy * phy)276*4882a593Smuzhiyun static int rockchip_combphy_exit(struct phy *phy)
277*4882a593Smuzhiyun {
278*4882a593Smuzhiyun struct rockchip_combphy_priv *priv = phy_get_drvdata(phy);
279*4882a593Smuzhiyun const struct rockchip_combphy_grfcfg *cfg = priv->cfg->grfcfg;
280*4882a593Smuzhiyun
281*4882a593Smuzhiyun if (cfg->pipe_phy_grf_reset.enable)
282*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->pipe_phy_grf_reset, true);
283*4882a593Smuzhiyun
284*4882a593Smuzhiyun clk_bulk_disable_unprepare(priv->num_clks, priv->clks);
285*4882a593Smuzhiyun reset_control_assert(priv->phy_rst);
286*4882a593Smuzhiyun
287*4882a593Smuzhiyun return 0;
288*4882a593Smuzhiyun }
289*4882a593Smuzhiyun
290*4882a593Smuzhiyun static const struct phy_ops rochchip_combphy_ops = {
291*4882a593Smuzhiyun .init = rockchip_combphy_init,
292*4882a593Smuzhiyun .exit = rockchip_combphy_exit,
293*4882a593Smuzhiyun .owner = THIS_MODULE,
294*4882a593Smuzhiyun };
295*4882a593Smuzhiyun
rockchip_combphy_xlate(struct device * dev,struct of_phandle_args * args)296*4882a593Smuzhiyun static struct phy *rockchip_combphy_xlate(struct device *dev,
297*4882a593Smuzhiyun struct of_phandle_args *args)
298*4882a593Smuzhiyun {
299*4882a593Smuzhiyun struct rockchip_combphy_priv *priv = dev_get_drvdata(dev);
300*4882a593Smuzhiyun
301*4882a593Smuzhiyun if (args->args_count != 1) {
302*4882a593Smuzhiyun dev_err(dev, "invalid number of arguments\n");
303*4882a593Smuzhiyun return ERR_PTR(-EINVAL);
304*4882a593Smuzhiyun }
305*4882a593Smuzhiyun
306*4882a593Smuzhiyun if (priv->mode != PHY_NONE && priv->mode != args->args[0])
307*4882a593Smuzhiyun dev_warn(dev, "phy type select %d overwriting type %d\n",
308*4882a593Smuzhiyun args->args[0], priv->mode);
309*4882a593Smuzhiyun
310*4882a593Smuzhiyun priv->mode = args->args[0];
311*4882a593Smuzhiyun
312*4882a593Smuzhiyun return priv->phy;
313*4882a593Smuzhiyun }
314*4882a593Smuzhiyun
rockchip_combphy_parse_dt(struct device * dev,struct rockchip_combphy_priv * priv)315*4882a593Smuzhiyun static int rockchip_combphy_parse_dt(struct device *dev,
316*4882a593Smuzhiyun struct rockchip_combphy_priv *priv)
317*4882a593Smuzhiyun {
318*4882a593Smuzhiyun const struct rockchip_combphy_cfg *phy_cfg = priv->cfg;
319*4882a593Smuzhiyun int ret, mac_id;
320*4882a593Smuzhiyun u32 vals[4];
321*4882a593Smuzhiyun
322*4882a593Smuzhiyun ret = devm_clk_bulk_get(dev, priv->num_clks, priv->clks);
323*4882a593Smuzhiyun if (ret == -EPROBE_DEFER)
324*4882a593Smuzhiyun return -EPROBE_DEFER;
325*4882a593Smuzhiyun if (ret)
326*4882a593Smuzhiyun priv->num_clks = 0;
327*4882a593Smuzhiyun
328*4882a593Smuzhiyun priv->pipe_grf = syscon_regmap_lookup_by_phandle(dev->of_node,
329*4882a593Smuzhiyun "rockchip,pipe-grf");
330*4882a593Smuzhiyun if (IS_ERR(priv->pipe_grf)) {
331*4882a593Smuzhiyun dev_err(dev, "failed to find peri_ctrl pipe-grf regmap\n");
332*4882a593Smuzhiyun return PTR_ERR(priv->pipe_grf);
333*4882a593Smuzhiyun }
334*4882a593Smuzhiyun
335*4882a593Smuzhiyun priv->phy_grf = syscon_regmap_lookup_by_phandle(dev->of_node,
336*4882a593Smuzhiyun "rockchip,pipe-phy-grf");
337*4882a593Smuzhiyun if (IS_ERR(priv->phy_grf)) {
338*4882a593Smuzhiyun dev_err(dev, "failed to find peri_ctrl pipe-phy-grf regmap\n");
339*4882a593Smuzhiyun return PTR_ERR(priv->phy_grf);
340*4882a593Smuzhiyun }
341*4882a593Smuzhiyun
342*4882a593Smuzhiyun if (device_property_present(dev, "rockchip,dis-u3otg0-port"))
343*4882a593Smuzhiyun param_write(priv->pipe_grf, &phy_cfg->grfcfg->u3otg0_port_en,
344*4882a593Smuzhiyun false);
345*4882a593Smuzhiyun else if (device_property_present(dev, "rockchip,dis-u3otg1-port"))
346*4882a593Smuzhiyun param_write(priv->pipe_grf, &phy_cfg->grfcfg->u3otg1_port_en,
347*4882a593Smuzhiyun false);
348*4882a593Smuzhiyun
349*4882a593Smuzhiyun if (!device_property_read_u32(dev, "rockchip,sgmii-mac-sel", &mac_id) &&
350*4882a593Smuzhiyun (mac_id > 0))
351*4882a593Smuzhiyun param_write(priv->pipe_grf, &phy_cfg->grfcfg->pipe_sgmii_mac_sel,
352*4882a593Smuzhiyun true);
353*4882a593Smuzhiyun
354*4882a593Smuzhiyun if (!device_property_read_u32_array(dev, "rockchip,pcie1ln-sel-bits",
355*4882a593Smuzhiyun vals, ARRAY_SIZE(vals)))
356*4882a593Smuzhiyun regmap_write(priv->pipe_grf, vals[0],
357*4882a593Smuzhiyun (GENMASK(vals[2], vals[1]) << 16) | (vals[3] << vals[1]));
358*4882a593Smuzhiyun
359*4882a593Smuzhiyun priv->apb_rst = devm_reset_control_get_optional(dev, "combphy-apb");
360*4882a593Smuzhiyun if (IS_ERR(priv->apb_rst)) {
361*4882a593Smuzhiyun ret = PTR_ERR(priv->apb_rst);
362*4882a593Smuzhiyun
363*4882a593Smuzhiyun if (ret != -EPROBE_DEFER)
364*4882a593Smuzhiyun dev_warn(dev, "failed to get apb reset\n");
365*4882a593Smuzhiyun
366*4882a593Smuzhiyun return ret;
367*4882a593Smuzhiyun }
368*4882a593Smuzhiyun
369*4882a593Smuzhiyun priv->phy_rst = devm_reset_control_get_optional(dev, "combphy");
370*4882a593Smuzhiyun if (IS_ERR(priv->phy_rst)) {
371*4882a593Smuzhiyun ret = PTR_ERR(priv->phy_rst);
372*4882a593Smuzhiyun
373*4882a593Smuzhiyun if (ret != -EPROBE_DEFER)
374*4882a593Smuzhiyun dev_warn(dev, "failed to get phy reset\n");
375*4882a593Smuzhiyun
376*4882a593Smuzhiyun return ret;
377*4882a593Smuzhiyun }
378*4882a593Smuzhiyun
379*4882a593Smuzhiyun return reset_control_assert(priv->phy_rst);
380*4882a593Smuzhiyun }
381*4882a593Smuzhiyun
rockchip_combphy_probe(struct platform_device * pdev)382*4882a593Smuzhiyun static int rockchip_combphy_probe(struct platform_device *pdev)
383*4882a593Smuzhiyun {
384*4882a593Smuzhiyun struct phy_provider *phy_provider;
385*4882a593Smuzhiyun struct device *dev = &pdev->dev;
386*4882a593Smuzhiyun struct rockchip_combphy_priv *priv;
387*4882a593Smuzhiyun const struct rockchip_combphy_cfg *phy_cfg;
388*4882a593Smuzhiyun struct resource *res;
389*4882a593Smuzhiyun int ret;
390*4882a593Smuzhiyun
391*4882a593Smuzhiyun phy_cfg = of_device_get_match_data(dev);
392*4882a593Smuzhiyun if (!phy_cfg) {
393*4882a593Smuzhiyun dev_err(dev, "No OF match data provided\n");
394*4882a593Smuzhiyun return -EINVAL;
395*4882a593Smuzhiyun }
396*4882a593Smuzhiyun
397*4882a593Smuzhiyun priv = devm_kzalloc(dev, sizeof(*priv), GFP_KERNEL);
398*4882a593Smuzhiyun if (!priv)
399*4882a593Smuzhiyun return -ENOMEM;
400*4882a593Smuzhiyun
401*4882a593Smuzhiyun res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
402*4882a593Smuzhiyun priv->mmio = devm_ioremap_resource(dev, res);
403*4882a593Smuzhiyun if (IS_ERR(priv->mmio)) {
404*4882a593Smuzhiyun ret = PTR_ERR(priv->mmio);
405*4882a593Smuzhiyun return ret;
406*4882a593Smuzhiyun }
407*4882a593Smuzhiyun
408*4882a593Smuzhiyun priv->num_clks = phy_cfg->num_clks;
409*4882a593Smuzhiyun
410*4882a593Smuzhiyun priv->clks = devm_kmemdup(dev, phy_cfg->clks,
411*4882a593Smuzhiyun phy_cfg->num_clks * sizeof(struct clk_bulk_data),
412*4882a593Smuzhiyun GFP_KERNEL);
413*4882a593Smuzhiyun
414*4882a593Smuzhiyun if (!priv->clks)
415*4882a593Smuzhiyun return -ENOMEM;
416*4882a593Smuzhiyun
417*4882a593Smuzhiyun priv->dev = dev;
418*4882a593Smuzhiyun priv->mode = PHY_NONE;
419*4882a593Smuzhiyun priv->cfg = phy_cfg;
420*4882a593Smuzhiyun
421*4882a593Smuzhiyun ret = rockchip_combphy_parse_dt(dev, priv);
422*4882a593Smuzhiyun if (ret)
423*4882a593Smuzhiyun return ret;
424*4882a593Smuzhiyun
425*4882a593Smuzhiyun priv->phy = devm_phy_create(dev, NULL, &rochchip_combphy_ops);
426*4882a593Smuzhiyun if (IS_ERR(priv->phy)) {
427*4882a593Smuzhiyun dev_err(dev, "failed to create combphy\n");
428*4882a593Smuzhiyun return PTR_ERR(priv->phy);
429*4882a593Smuzhiyun }
430*4882a593Smuzhiyun
431*4882a593Smuzhiyun dev_set_drvdata(dev, priv);
432*4882a593Smuzhiyun phy_set_drvdata(priv->phy, priv);
433*4882a593Smuzhiyun
434*4882a593Smuzhiyun phy_provider = devm_of_phy_provider_register(dev, rockchip_combphy_xlate);
435*4882a593Smuzhiyun
436*4882a593Smuzhiyun return PTR_ERR_OR_ZERO(phy_provider);
437*4882a593Smuzhiyun }
438*4882a593Smuzhiyun
rk3528_combphy_cfg(struct rockchip_combphy_priv * priv)439*4882a593Smuzhiyun static int rk3528_combphy_cfg(struct rockchip_combphy_priv *priv)
440*4882a593Smuzhiyun {
441*4882a593Smuzhiyun const struct rockchip_combphy_grfcfg *cfg = priv->cfg->grfcfg;
442*4882a593Smuzhiyun struct clk *refclk = NULL;
443*4882a593Smuzhiyun unsigned long rate;
444*4882a593Smuzhiyun int i;
445*4882a593Smuzhiyun u32 val;
446*4882a593Smuzhiyun
447*4882a593Smuzhiyun /* Configure PHY reference clock frequency */
448*4882a593Smuzhiyun for (i = 0; i < priv->num_clks; i++) {
449*4882a593Smuzhiyun if (!strncmp(priv->clks[i].id, "refclk", 6)) {
450*4882a593Smuzhiyun refclk = priv->clks[i].clk;
451*4882a593Smuzhiyun break;
452*4882a593Smuzhiyun }
453*4882a593Smuzhiyun }
454*4882a593Smuzhiyun
455*4882a593Smuzhiyun if (!refclk) {
456*4882a593Smuzhiyun dev_err(priv->dev, "No refclk found\n");
457*4882a593Smuzhiyun return -EINVAL;
458*4882a593Smuzhiyun }
459*4882a593Smuzhiyun
460*4882a593Smuzhiyun switch (priv->mode) {
461*4882a593Smuzhiyun case PHY_TYPE_PCIE:
462*4882a593Smuzhiyun /* Set SSC downward spread spectrum */
463*4882a593Smuzhiyun val = readl(priv->mmio + 0x18);
464*4882a593Smuzhiyun val &= ~GENMASK(5, 4);
465*4882a593Smuzhiyun val |= 0x01 << 4;
466*4882a593Smuzhiyun writel(val, priv->mmio + 0x18);
467*4882a593Smuzhiyun
468*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->con0_for_pcie, true);
469*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->con1_for_pcie, true);
470*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->con2_for_pcie, true);
471*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->con3_for_pcie, true);
472*4882a593Smuzhiyun break;
473*4882a593Smuzhiyun case PHY_TYPE_USB3:
474*4882a593Smuzhiyun /* Set SSC downward spread spectrum */
475*4882a593Smuzhiyun val = readl(priv->mmio + 0x18);
476*4882a593Smuzhiyun val &= ~GENMASK(5, 4);
477*4882a593Smuzhiyun val |= 0x01 << 4;
478*4882a593Smuzhiyun writel(val, priv->mmio + 0x18);
479*4882a593Smuzhiyun
480*4882a593Smuzhiyun /* Enable adaptive CTLE for USB3.0 Rx */
481*4882a593Smuzhiyun val = readl(priv->mmio + 0x200);
482*4882a593Smuzhiyun val &= ~GENMASK(17, 17);
483*4882a593Smuzhiyun val |= 0x01 << 17;
484*4882a593Smuzhiyun writel(val, priv->mmio + 0x200);
485*4882a593Smuzhiyun
486*4882a593Smuzhiyun /* Set Rx squelch input filler bandwidth */
487*4882a593Smuzhiyun val = readl(priv->mmio + 0x20c);
488*4882a593Smuzhiyun val &= ~GENMASK(2, 0);
489*4882a593Smuzhiyun val |= 0x06;
490*4882a593Smuzhiyun writel(val, priv->mmio + 0x20c);
491*4882a593Smuzhiyun
492*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->pipe_txcomp_sel, false);
493*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->pipe_txelec_sel, false);
494*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->usb_mode_set, true);
495*4882a593Smuzhiyun break;
496*4882a593Smuzhiyun default:
497*4882a593Smuzhiyun dev_err(priv->dev, "incompatible PHY type\n");
498*4882a593Smuzhiyun return -EINVAL;
499*4882a593Smuzhiyun }
500*4882a593Smuzhiyun
501*4882a593Smuzhiyun rate = clk_get_rate(refclk);
502*4882a593Smuzhiyun
503*4882a593Smuzhiyun switch (rate) {
504*4882a593Smuzhiyun case 24000000:
505*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->pipe_clk_24m, true);
506*4882a593Smuzhiyun if (priv->mode == PHY_TYPE_USB3) {
507*4882a593Smuzhiyun /* Set ssc_cnt[10:0]=00101111101 & 31.5KHz */
508*4882a593Smuzhiyun val = readl(priv->mmio + 0x100);
509*4882a593Smuzhiyun val &= ~GENMASK(10, 0);
510*4882a593Smuzhiyun val |= 0x17d;
511*4882a593Smuzhiyun writel(val, priv->mmio + 0x100);
512*4882a593Smuzhiyun } else if (priv->mode == PHY_TYPE_PCIE) {
513*4882a593Smuzhiyun /* tx_trim[14]=1, Enable the counting clock of the rterm detect */
514*4882a593Smuzhiyun val = readl(priv->mmio + 0x218);
515*4882a593Smuzhiyun val |= (1 << 14);
516*4882a593Smuzhiyun writel(val, priv->mmio + 0x218);
517*4882a593Smuzhiyun }
518*4882a593Smuzhiyun break;
519*4882a593Smuzhiyun case 100000000:
520*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->pipe_clk_100m, true);
521*4882a593Smuzhiyun if (priv->mode == PHY_TYPE_PCIE) {
522*4882a593Smuzhiyun /* PLL KVCO tuning fine */
523*4882a593Smuzhiyun val = readl(priv->mmio + 0x18);
524*4882a593Smuzhiyun val &= ~(0x7 << 10);
525*4882a593Smuzhiyun val |= 0x2 << 10;
526*4882a593Smuzhiyun writel(val, priv->mmio + 0x18);
527*4882a593Smuzhiyun
528*4882a593Smuzhiyun /* su_trim[6:4]=111, [10:7]=1001, [2:0]=000, swing 650mv */
529*4882a593Smuzhiyun val = 0x570804f0;
530*4882a593Smuzhiyun writel(val, priv->mmio + 0x108);
531*4882a593Smuzhiyun }
532*4882a593Smuzhiyun break;
533*4882a593Smuzhiyun default:
534*4882a593Smuzhiyun dev_err(priv->dev, "Unsupported rate: %lu\n", rate);
535*4882a593Smuzhiyun return -EINVAL;
536*4882a593Smuzhiyun }
537*4882a593Smuzhiyun
538*4882a593Smuzhiyun return 0;
539*4882a593Smuzhiyun }
540*4882a593Smuzhiyun
541*4882a593Smuzhiyun static const struct rockchip_combphy_grfcfg rk3528_combphy_grfcfgs = {
542*4882a593Smuzhiyun /* pipe-phy-grf */
543*4882a593Smuzhiyun .pcie_mode_set = { 0x48000, 5, 0, 0x00, 0x11 },
544*4882a593Smuzhiyun .usb_mode_set = { 0x48000, 5, 0, 0x00, 0x04 },
545*4882a593Smuzhiyun .pipe_rxterm_set = { 0x48000, 12, 12, 0x00, 0x01 },
546*4882a593Smuzhiyun .pipe_txelec_set = { 0x48004, 1, 1, 0x00, 0x01 },
547*4882a593Smuzhiyun .pipe_txcomp_set = { 0x48004, 4, 4, 0x00, 0x01 },
548*4882a593Smuzhiyun .pipe_clk_24m = { 0x48004, 14, 13, 0x00, 0x00 },
549*4882a593Smuzhiyun .pipe_clk_100m = { 0x48004, 14, 13, 0x00, 0x02 },
550*4882a593Smuzhiyun .pipe_rxterm_sel = { 0x48008, 8, 8, 0x00, 0x01 },
551*4882a593Smuzhiyun .pipe_txelec_sel = { 0x48008, 12, 12, 0x00, 0x01 },
552*4882a593Smuzhiyun .pipe_txcomp_sel = { 0x48008, 15, 15, 0x00, 0x01 },
553*4882a593Smuzhiyun .pipe_clk_ext = { 0x4800c, 9, 8, 0x02, 0x01 },
554*4882a593Smuzhiyun .pipe_phy_status = { 0x48034, 6, 6, 0x01, 0x00 },
555*4882a593Smuzhiyun .con0_for_pcie = { 0x48000, 15, 0, 0x00, 0x110 },
556*4882a593Smuzhiyun .con1_for_pcie = { 0x48004, 15, 0, 0x00, 0x00 },
557*4882a593Smuzhiyun .con2_for_pcie = { 0x48008, 15, 0, 0x00, 0x101 },
558*4882a593Smuzhiyun .con3_for_pcie = { 0x4800c, 15, 0, 0x00, 0x0200 },
559*4882a593Smuzhiyun /* pipe-grf */
560*4882a593Smuzhiyun .u3otg0_port_en = { 0x40044, 15, 0, 0x0181, 0x1100 },
561*4882a593Smuzhiyun };
562*4882a593Smuzhiyun
563*4882a593Smuzhiyun static const struct clk_bulk_data rk3528_clks[] = {
564*4882a593Smuzhiyun { .id = "refclk" },
565*4882a593Smuzhiyun { .id = "apbclk" },
566*4882a593Smuzhiyun { .id = "pipe_clk" },
567*4882a593Smuzhiyun };
568*4882a593Smuzhiyun
569*4882a593Smuzhiyun static const struct rockchip_combphy_cfg rk3528_combphy_cfgs = {
570*4882a593Smuzhiyun .num_clks = ARRAY_SIZE(rk3528_clks),
571*4882a593Smuzhiyun .clks = rk3528_clks,
572*4882a593Smuzhiyun .grfcfg = &rk3528_combphy_grfcfgs,
573*4882a593Smuzhiyun .combphy_cfg = rk3528_combphy_cfg,
574*4882a593Smuzhiyun };
575*4882a593Smuzhiyun
rk3562_combphy_cfg(struct rockchip_combphy_priv * priv)576*4882a593Smuzhiyun static int rk3562_combphy_cfg(struct rockchip_combphy_priv *priv)
577*4882a593Smuzhiyun {
578*4882a593Smuzhiyun const struct rockchip_combphy_grfcfg *cfg = priv->cfg->grfcfg;
579*4882a593Smuzhiyun struct clk *refclk = NULL;
580*4882a593Smuzhiyun unsigned long rate;
581*4882a593Smuzhiyun int i;
582*4882a593Smuzhiyun u32 val;
583*4882a593Smuzhiyun
584*4882a593Smuzhiyun /* Configure PHY reference clock frequency */
585*4882a593Smuzhiyun for (i = 0; i < priv->num_clks; i++) {
586*4882a593Smuzhiyun if (!strncmp(priv->clks[i].id, "refclk", 6)) {
587*4882a593Smuzhiyun refclk = priv->clks[i].clk;
588*4882a593Smuzhiyun break;
589*4882a593Smuzhiyun }
590*4882a593Smuzhiyun }
591*4882a593Smuzhiyun
592*4882a593Smuzhiyun if (!refclk) {
593*4882a593Smuzhiyun dev_err(priv->dev, "No refclk found\n");
594*4882a593Smuzhiyun return -EINVAL;
595*4882a593Smuzhiyun }
596*4882a593Smuzhiyun
597*4882a593Smuzhiyun switch (priv->mode) {
598*4882a593Smuzhiyun case PHY_TYPE_PCIE:
599*4882a593Smuzhiyun /* Set SSC downward spread spectrum */
600*4882a593Smuzhiyun val = readl(priv->mmio + (0x1f << 2));
601*4882a593Smuzhiyun val &= ~GENMASK(5, 4);
602*4882a593Smuzhiyun val |= 0x01 << 4;
603*4882a593Smuzhiyun writel(val, priv->mmio + 0x7c);
604*4882a593Smuzhiyun
605*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->con0_for_pcie, true);
606*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->con1_for_pcie, true);
607*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->con2_for_pcie, true);
608*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->con3_for_pcie, true);
609*4882a593Smuzhiyun break;
610*4882a593Smuzhiyun case PHY_TYPE_USB3:
611*4882a593Smuzhiyun /* Set SSC downward spread spectrum */
612*4882a593Smuzhiyun val = readl(priv->mmio + (0x1f << 2));
613*4882a593Smuzhiyun val &= ~GENMASK(5, 4);
614*4882a593Smuzhiyun val |= 0x01 << 4;
615*4882a593Smuzhiyun writel(val, priv->mmio + 0x7c);
616*4882a593Smuzhiyun
617*4882a593Smuzhiyun /* Enable adaptive CTLE for USB3.0 Rx */
618*4882a593Smuzhiyun val = readl(priv->mmio + (0x0e << 2));
619*4882a593Smuzhiyun val &= ~GENMASK(0, 0);
620*4882a593Smuzhiyun val |= 0x01;
621*4882a593Smuzhiyun writel(val, priv->mmio + (0x0e << 2));
622*4882a593Smuzhiyun
623*4882a593Smuzhiyun /* Set PLL KVCO fine tuning signals */
624*4882a593Smuzhiyun val = readl(priv->mmio + (0x20 << 2));
625*4882a593Smuzhiyun val &= ~(0x7 << 2);
626*4882a593Smuzhiyun val |= 0x2 << 2;
627*4882a593Smuzhiyun writel(val, priv->mmio + (0x20 << 2));
628*4882a593Smuzhiyun
629*4882a593Smuzhiyun /* Set PLL LPF R1 to su_trim[10:7]=1001 */
630*4882a593Smuzhiyun writel(0x4, priv->mmio + (0xb << 2));
631*4882a593Smuzhiyun
632*4882a593Smuzhiyun /* Set PLL input clock divider 1/2 */
633*4882a593Smuzhiyun val = readl(priv->mmio + (0x5 << 2));
634*4882a593Smuzhiyun val &= ~(0x3 << 6);
635*4882a593Smuzhiyun val |= 0x1 << 6;
636*4882a593Smuzhiyun writel(val, priv->mmio + (0x5 << 2));
637*4882a593Smuzhiyun
638*4882a593Smuzhiyun /* Set PLL loop divider */
639*4882a593Smuzhiyun writel(0x32, priv->mmio + (0x11 << 2));
640*4882a593Smuzhiyun
641*4882a593Smuzhiyun /* Set PLL KVCO to min and set PLL charge pump current to max */
642*4882a593Smuzhiyun writel(0xf0, priv->mmio + (0xa << 2));
643*4882a593Smuzhiyun
644*4882a593Smuzhiyun /* Set Rx squelch input filler bandwidth */
645*4882a593Smuzhiyun writel(0x0e, priv->mmio + (0x14 << 2));
646*4882a593Smuzhiyun
647*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->pipe_sel_usb, true);
648*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->pipe_txcomp_sel, false);
649*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->pipe_txelec_sel, false);
650*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->usb_mode_set, true);
651*4882a593Smuzhiyun break;
652*4882a593Smuzhiyun default:
653*4882a593Smuzhiyun dev_err(priv->dev, "incompatible PHY type\n");
654*4882a593Smuzhiyun return -EINVAL;
655*4882a593Smuzhiyun }
656*4882a593Smuzhiyun
657*4882a593Smuzhiyun rate = clk_get_rate(refclk);
658*4882a593Smuzhiyun
659*4882a593Smuzhiyun switch (rate) {
660*4882a593Smuzhiyun case 24000000:
661*4882a593Smuzhiyun if (priv->mode == PHY_TYPE_USB3) {
662*4882a593Smuzhiyun /* Set ssc_cnt[9:0]=0101111101 & 31.5KHz */
663*4882a593Smuzhiyun val = readl(priv->mmio + (0x0e << 2));
664*4882a593Smuzhiyun val &= ~GENMASK(7, 6);
665*4882a593Smuzhiyun val |= 0x01 << 6;
666*4882a593Smuzhiyun writel(val, priv->mmio + (0x0e << 2));
667*4882a593Smuzhiyun
668*4882a593Smuzhiyun val = readl(priv->mmio + (0x0f << 2));
669*4882a593Smuzhiyun val &= ~GENMASK(7, 0);
670*4882a593Smuzhiyun val |= 0x5f;
671*4882a593Smuzhiyun writel(val, priv->mmio + (0x0f << 2));
672*4882a593Smuzhiyun }
673*4882a593Smuzhiyun break;
674*4882a593Smuzhiyun case 25000000:
675*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->pipe_clk_25m, true);
676*4882a593Smuzhiyun break;
677*4882a593Smuzhiyun case 100000000:
678*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->pipe_clk_100m, true);
679*4882a593Smuzhiyun if (priv->mode == PHY_TYPE_PCIE) {
680*4882a593Smuzhiyun /* PLL KVCO tuning fine */
681*4882a593Smuzhiyun val = readl(priv->mmio + (0x20 << 2));
682*4882a593Smuzhiyun val &= ~(0x7 << 2);
683*4882a593Smuzhiyun val |= 0x2 << 2;
684*4882a593Smuzhiyun writel(val, priv->mmio + (0x20 << 2));
685*4882a593Smuzhiyun
686*4882a593Smuzhiyun /* Enable controlling random jitter, aka RMJ */
687*4882a593Smuzhiyun writel(0x4, priv->mmio + (0xb << 2));
688*4882a593Smuzhiyun
689*4882a593Smuzhiyun val = readl(priv->mmio + (0x5 << 2));
690*4882a593Smuzhiyun val &= ~(0x3 << 6);
691*4882a593Smuzhiyun val |= 0x1 << 6;
692*4882a593Smuzhiyun writel(val, priv->mmio + (0x5 << 2));
693*4882a593Smuzhiyun
694*4882a593Smuzhiyun writel(0x32, priv->mmio + (0x11 << 2));
695*4882a593Smuzhiyun writel(0xf0, priv->mmio + (0xa << 2));
696*4882a593Smuzhiyun
697*4882a593Smuzhiyun /* CKDRV output swing adjust to 650mv */
698*4882a593Smuzhiyun val = readl(priv->mmio + (0xd << 2));
699*4882a593Smuzhiyun val &= ~(0xf << 1);
700*4882a593Smuzhiyun val |= (0xb << 1);
701*4882a593Smuzhiyun writel(val, priv->mmio + (0xd << 2));
702*4882a593Smuzhiyun }
703*4882a593Smuzhiyun break;
704*4882a593Smuzhiyun default:
705*4882a593Smuzhiyun dev_err(priv->dev, "Unsupported rate: %lu\n", rate);
706*4882a593Smuzhiyun return -EINVAL;
707*4882a593Smuzhiyun }
708*4882a593Smuzhiyun
709*4882a593Smuzhiyun if (device_property_read_bool(priv->dev, "rockchip,ext-refclk")) {
710*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->pipe_clk_ext, true);
711*4882a593Smuzhiyun if (priv->mode == PHY_TYPE_PCIE && rate == 100000000) {
712*4882a593Smuzhiyun val = readl(priv->mmio + (0xc << 2));
713*4882a593Smuzhiyun val |= 0x3 << 4 | 0x1 << 7;
714*4882a593Smuzhiyun writel(val, priv->mmio + (0xc << 2));
715*4882a593Smuzhiyun
716*4882a593Smuzhiyun val = readl(priv->mmio + (0xd << 2));
717*4882a593Smuzhiyun val |= 0x1;
718*4882a593Smuzhiyun writel(val, priv->mmio + (0xd << 2));
719*4882a593Smuzhiyun }
720*4882a593Smuzhiyun }
721*4882a593Smuzhiyun
722*4882a593Smuzhiyun if (device_property_read_bool(priv->dev, "rockchip,enable-ssc")) {
723*4882a593Smuzhiyun val = readl(priv->mmio + (0x7 << 2));
724*4882a593Smuzhiyun val |= BIT(4);
725*4882a593Smuzhiyun writel(val, priv->mmio + (0x7 << 2));
726*4882a593Smuzhiyun }
727*4882a593Smuzhiyun
728*4882a593Smuzhiyun return 0;
729*4882a593Smuzhiyun }
730*4882a593Smuzhiyun
731*4882a593Smuzhiyun static const struct rockchip_combphy_grfcfg rk3562_combphy_grfcfgs = {
732*4882a593Smuzhiyun /* pipe-phy-grf */
733*4882a593Smuzhiyun .pcie_mode_set = { 0x0000, 5, 0, 0x00, 0x11 },
734*4882a593Smuzhiyun .usb_mode_set = { 0x0000, 5, 0, 0x00, 0x04 },
735*4882a593Smuzhiyun .pipe_rxterm_set = { 0x0000, 12, 12, 0x00, 0x01 },
736*4882a593Smuzhiyun .pipe_txelec_set = { 0x0004, 1, 1, 0x00, 0x01 },
737*4882a593Smuzhiyun .pipe_txcomp_set = { 0x0004, 4, 4, 0x00, 0x01 },
738*4882a593Smuzhiyun .pipe_clk_25m = { 0x0004, 14, 13, 0x00, 0x01 },
739*4882a593Smuzhiyun .pipe_clk_100m = { 0x0004, 14, 13, 0x00, 0x02 },
740*4882a593Smuzhiyun .pipe_phymode_sel = { 0x0008, 1, 1, 0x00, 0x01 },
741*4882a593Smuzhiyun .pipe_rate_sel = { 0x0008, 2, 2, 0x00, 0x01 },
742*4882a593Smuzhiyun .pipe_rxterm_sel = { 0x0008, 8, 8, 0x00, 0x01 },
743*4882a593Smuzhiyun .pipe_txelec_sel = { 0x0008, 12, 12, 0x00, 0x01 },
744*4882a593Smuzhiyun .pipe_txcomp_sel = { 0x0008, 15, 15, 0x00, 0x01 },
745*4882a593Smuzhiyun .pipe_clk_ext = { 0x000c, 9, 8, 0x02, 0x01 },
746*4882a593Smuzhiyun .pipe_sel_usb = { 0x000c, 14, 13, 0x00, 0x01 },
747*4882a593Smuzhiyun .pipe_phy_status = { 0x0034, 6, 6, 0x01, 0x00 },
748*4882a593Smuzhiyun .con0_for_pcie = { 0x0000, 15, 0, 0x00, 0x1000 },
749*4882a593Smuzhiyun .con1_for_pcie = { 0x0004, 15, 0, 0x00, 0x0000 },
750*4882a593Smuzhiyun .con2_for_pcie = { 0x0008, 15, 0, 0x00, 0x0101 },
751*4882a593Smuzhiyun .con3_for_pcie = { 0x000c, 15, 0, 0x00, 0x0200 },
752*4882a593Smuzhiyun .pipe_phy_grf_reset = { 0x0014, 1, 0, 0x3, 0x1 },
753*4882a593Smuzhiyun /* peri-grf */
754*4882a593Smuzhiyun .u3otg0_port_en = { 0x0094, 15, 0, 0x0181, 0x1100 },
755*4882a593Smuzhiyun };
756*4882a593Smuzhiyun
757*4882a593Smuzhiyun static const struct clk_bulk_data rk3562_clks[] = {
758*4882a593Smuzhiyun { .id = "refclk" },
759*4882a593Smuzhiyun { .id = "apbclk" },
760*4882a593Smuzhiyun { .id = "pipe_clk" },
761*4882a593Smuzhiyun };
762*4882a593Smuzhiyun
763*4882a593Smuzhiyun static const struct rockchip_combphy_cfg rk3562_combphy_cfgs = {
764*4882a593Smuzhiyun .num_clks = ARRAY_SIZE(rk3562_clks),
765*4882a593Smuzhiyun .clks = rk3562_clks,
766*4882a593Smuzhiyun .grfcfg = &rk3562_combphy_grfcfgs,
767*4882a593Smuzhiyun .combphy_cfg = rk3562_combphy_cfg,
768*4882a593Smuzhiyun .force_det_out = true,
769*4882a593Smuzhiyun };
770*4882a593Smuzhiyun
rk3568_combphy_cfg(struct rockchip_combphy_priv * priv)771*4882a593Smuzhiyun static int rk3568_combphy_cfg(struct rockchip_combphy_priv *priv)
772*4882a593Smuzhiyun {
773*4882a593Smuzhiyun const struct rockchip_combphy_grfcfg *cfg = priv->cfg->grfcfg;
774*4882a593Smuzhiyun struct clk *refclk = NULL;
775*4882a593Smuzhiyun unsigned long rate;
776*4882a593Smuzhiyun int i;
777*4882a593Smuzhiyun u32 val;
778*4882a593Smuzhiyun
779*4882a593Smuzhiyun /* Configure PHY reference clock frequency */
780*4882a593Smuzhiyun for (i = 0; i < priv->num_clks; i++) {
781*4882a593Smuzhiyun if (!strncmp(priv->clks[i].id, "refclk", 6)) {
782*4882a593Smuzhiyun refclk = priv->clks[i].clk;
783*4882a593Smuzhiyun break;
784*4882a593Smuzhiyun }
785*4882a593Smuzhiyun }
786*4882a593Smuzhiyun
787*4882a593Smuzhiyun if (!refclk) {
788*4882a593Smuzhiyun dev_err(priv->dev, "No refclk found\n");
789*4882a593Smuzhiyun return -EINVAL;
790*4882a593Smuzhiyun }
791*4882a593Smuzhiyun
792*4882a593Smuzhiyun switch (priv->mode) {
793*4882a593Smuzhiyun case PHY_TYPE_PCIE:
794*4882a593Smuzhiyun /* Set SSC downward spread spectrum */
795*4882a593Smuzhiyun val = readl(priv->mmio + (0x1f << 2));
796*4882a593Smuzhiyun val &= ~GENMASK(5, 4);
797*4882a593Smuzhiyun val |= 0x01 << 4;
798*4882a593Smuzhiyun writel(val, priv->mmio + 0x7c);
799*4882a593Smuzhiyun
800*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->con0_for_pcie, true);
801*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->con1_for_pcie, true);
802*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->con2_for_pcie, true);
803*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->con3_for_pcie, true);
804*4882a593Smuzhiyun break;
805*4882a593Smuzhiyun case PHY_TYPE_USB3:
806*4882a593Smuzhiyun /* Set SSC downward spread spectrum */
807*4882a593Smuzhiyun val = readl(priv->mmio + (0x1f << 2));
808*4882a593Smuzhiyun val &= ~GENMASK(5, 4);
809*4882a593Smuzhiyun val |= 0x01 << 4;
810*4882a593Smuzhiyun writel(val, priv->mmio + 0x7c);
811*4882a593Smuzhiyun
812*4882a593Smuzhiyun /* Enable adaptive CTLE for USB3.0 Rx */
813*4882a593Smuzhiyun val = readl(priv->mmio + (0x0e << 2));
814*4882a593Smuzhiyun val &= ~GENMASK(0, 0);
815*4882a593Smuzhiyun val |= 0x01;
816*4882a593Smuzhiyun writel(val, priv->mmio + (0x0e << 2));
817*4882a593Smuzhiyun
818*4882a593Smuzhiyun /* Set PLL KVCO fine tuning signals */
819*4882a593Smuzhiyun val = readl(priv->mmio + (0x20 << 2));
820*4882a593Smuzhiyun val &= ~(0x7 << 2);
821*4882a593Smuzhiyun val |= 0x2 << 2;
822*4882a593Smuzhiyun writel(val, priv->mmio + (0x20 << 2));
823*4882a593Smuzhiyun
824*4882a593Smuzhiyun /* Set PLL LPF R1 to su_trim[10:7]=1001 */
825*4882a593Smuzhiyun writel(0x4, priv->mmio + (0xb << 2));
826*4882a593Smuzhiyun
827*4882a593Smuzhiyun /* Set PLL input clock divider 1/2 */
828*4882a593Smuzhiyun val = readl(priv->mmio + (0x5 << 2));
829*4882a593Smuzhiyun val &= ~(0x3 << 6);
830*4882a593Smuzhiyun val |= 0x1 << 6;
831*4882a593Smuzhiyun writel(val, priv->mmio + (0x5 << 2));
832*4882a593Smuzhiyun
833*4882a593Smuzhiyun /* Set PLL loop divider */
834*4882a593Smuzhiyun writel(0x32, priv->mmio + (0x11 << 2));
835*4882a593Smuzhiyun
836*4882a593Smuzhiyun /* Set PLL KVCO to min and set PLL charge pump current to max */
837*4882a593Smuzhiyun writel(0xf0, priv->mmio + (0xa << 2));
838*4882a593Smuzhiyun
839*4882a593Smuzhiyun /* Set Rx squelch input filler bandwidth */
840*4882a593Smuzhiyun writel(0x0e, priv->mmio + (0x14 << 2));
841*4882a593Smuzhiyun
842*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->pipe_sel_usb, true);
843*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->pipe_txcomp_sel, false);
844*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->pipe_txelec_sel, false);
845*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->usb_mode_set, true);
846*4882a593Smuzhiyun break;
847*4882a593Smuzhiyun case PHY_TYPE_SATA:
848*4882a593Smuzhiyun writel(0x41, priv->mmio + 0x38);
849*4882a593Smuzhiyun writel(0x8F, priv->mmio + 0x18);
850*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->con0_for_sata, true);
851*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->con1_for_sata, true);
852*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->con2_for_sata, true);
853*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->con3_for_sata, true);
854*4882a593Smuzhiyun param_write(priv->pipe_grf, &cfg->pipe_con0_for_sata, true);
855*4882a593Smuzhiyun break;
856*4882a593Smuzhiyun case PHY_TYPE_SGMII:
857*4882a593Smuzhiyun param_write(priv->pipe_grf, &cfg->pipe_xpcs_phy_ready, true);
858*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->pipe_phymode_sel, true);
859*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->pipe_sel_qsgmii, true);
860*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->sgmii_mode_set, true);
861*4882a593Smuzhiyun break;
862*4882a593Smuzhiyun case PHY_TYPE_QSGMII:
863*4882a593Smuzhiyun param_write(priv->pipe_grf, &cfg->pipe_xpcs_phy_ready, true);
864*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->pipe_phymode_sel, true);
865*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->pipe_rate_sel, true);
866*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->pipe_sel_qsgmii, true);
867*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->qsgmii_mode_set, true);
868*4882a593Smuzhiyun break;
869*4882a593Smuzhiyun default:
870*4882a593Smuzhiyun dev_err(priv->dev, "incompatible PHY type\n");
871*4882a593Smuzhiyun return -EINVAL;
872*4882a593Smuzhiyun }
873*4882a593Smuzhiyun
874*4882a593Smuzhiyun rate = clk_get_rate(refclk);
875*4882a593Smuzhiyun
876*4882a593Smuzhiyun switch (rate) {
877*4882a593Smuzhiyun case 24000000:
878*4882a593Smuzhiyun if (priv->mode == PHY_TYPE_USB3 || priv->mode == PHY_TYPE_SATA) {
879*4882a593Smuzhiyun /* Set ssc_cnt[9:0]=0101111101 & 31.5KHz */
880*4882a593Smuzhiyun val = readl(priv->mmio + (0x0e << 2));
881*4882a593Smuzhiyun val &= ~GENMASK(7, 6);
882*4882a593Smuzhiyun val |= 0x01 << 6;
883*4882a593Smuzhiyun writel(val, priv->mmio + (0x0e << 2));
884*4882a593Smuzhiyun
885*4882a593Smuzhiyun val = readl(priv->mmio + (0x0f << 2));
886*4882a593Smuzhiyun val &= ~GENMASK(7, 0);
887*4882a593Smuzhiyun val |= 0x5f;
888*4882a593Smuzhiyun writel(val, priv->mmio + (0x0f << 2));
889*4882a593Smuzhiyun }
890*4882a593Smuzhiyun break;
891*4882a593Smuzhiyun case 25000000:
892*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->pipe_clk_25m, true);
893*4882a593Smuzhiyun break;
894*4882a593Smuzhiyun case 100000000:
895*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->pipe_clk_100m, true);
896*4882a593Smuzhiyun if (priv->mode == PHY_TYPE_PCIE) {
897*4882a593Smuzhiyun /* PLL KVCO tuning fine */
898*4882a593Smuzhiyun val = readl(priv->mmio + (0x20 << 2));
899*4882a593Smuzhiyun val &= ~(0x7 << 2);
900*4882a593Smuzhiyun val |= 0x2 << 2;
901*4882a593Smuzhiyun writel(val, priv->mmio + (0x20 << 2));
902*4882a593Smuzhiyun
903*4882a593Smuzhiyun /* Enable controlling random jitter, aka RMJ */
904*4882a593Smuzhiyun writel(0x4, priv->mmio + (0xb << 2));
905*4882a593Smuzhiyun
906*4882a593Smuzhiyun val = readl(priv->mmio + (0x5 << 2));
907*4882a593Smuzhiyun val &= ~(0x3 << 6);
908*4882a593Smuzhiyun val |= 0x1 << 6;
909*4882a593Smuzhiyun writel(val, priv->mmio + (0x5 << 2));
910*4882a593Smuzhiyun
911*4882a593Smuzhiyun writel(0x32, priv->mmio + (0x11 << 2));
912*4882a593Smuzhiyun writel(0xf0, priv->mmio + (0xa << 2));
913*4882a593Smuzhiyun } else if (priv->mode == PHY_TYPE_SATA) {
914*4882a593Smuzhiyun /* downward spread spectrum +500ppm */
915*4882a593Smuzhiyun val = readl(priv->mmio + (0x1f << 2));
916*4882a593Smuzhiyun val &= ~GENMASK(7, 4);
917*4882a593Smuzhiyun val |= 0x50;
918*4882a593Smuzhiyun writel(val, priv->mmio + (0x1f << 2));
919*4882a593Smuzhiyun }
920*4882a593Smuzhiyun break;
921*4882a593Smuzhiyun default:
922*4882a593Smuzhiyun dev_err(priv->dev, "Unsupported rate: %lu\n", rate);
923*4882a593Smuzhiyun return -EINVAL;
924*4882a593Smuzhiyun }
925*4882a593Smuzhiyun
926*4882a593Smuzhiyun if (device_property_read_bool(priv->dev, "rockchip,ext-refclk")) {
927*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->pipe_clk_ext, true);
928*4882a593Smuzhiyun if (priv->mode == PHY_TYPE_PCIE && rate == 100000000) {
929*4882a593Smuzhiyun val = readl(priv->mmio + (0xc << 2));
930*4882a593Smuzhiyun val |= 0x3 << 4 | 0x1 << 7;
931*4882a593Smuzhiyun writel(val, priv->mmio + (0xc << 2));
932*4882a593Smuzhiyun
933*4882a593Smuzhiyun val = readl(priv->mmio + (0xd << 2));
934*4882a593Smuzhiyun val |= 0x1;
935*4882a593Smuzhiyun writel(val, priv->mmio + (0xd << 2));
936*4882a593Smuzhiyun }
937*4882a593Smuzhiyun }
938*4882a593Smuzhiyun
939*4882a593Smuzhiyun if (device_property_read_bool(priv->dev, "rockchip,enable-ssc")) {
940*4882a593Smuzhiyun val = readl(priv->mmio + (0x7 << 2));
941*4882a593Smuzhiyun val |= BIT(4);
942*4882a593Smuzhiyun writel(val, priv->mmio + (0x7 << 2));
943*4882a593Smuzhiyun }
944*4882a593Smuzhiyun
945*4882a593Smuzhiyun return 0;
946*4882a593Smuzhiyun }
947*4882a593Smuzhiyun
948*4882a593Smuzhiyun static const struct rockchip_combphy_grfcfg rk3568_combphy_grfcfgs = {
949*4882a593Smuzhiyun /* pipe-phy-grf */
950*4882a593Smuzhiyun .pcie_mode_set = { 0x0000, 5, 0, 0x00, 0x11 },
951*4882a593Smuzhiyun .usb_mode_set = { 0x0000, 5, 0, 0x00, 0x04 },
952*4882a593Smuzhiyun .sgmii_mode_set = { 0x0000, 5, 0, 0x00, 0x01 },
953*4882a593Smuzhiyun .qsgmii_mode_set = { 0x0000, 5, 0, 0x00, 0x21 },
954*4882a593Smuzhiyun .pipe_rxterm_set = { 0x0000, 12, 12, 0x00, 0x01 },
955*4882a593Smuzhiyun .pipe_txelec_set = { 0x0004, 1, 1, 0x00, 0x01 },
956*4882a593Smuzhiyun .pipe_txcomp_set = { 0x0004, 4, 4, 0x00, 0x01 },
957*4882a593Smuzhiyun .pipe_clk_25m = { 0x0004, 14, 13, 0x00, 0x01 },
958*4882a593Smuzhiyun .pipe_clk_100m = { 0x0004, 14, 13, 0x00, 0x02 },
959*4882a593Smuzhiyun .pipe_phymode_sel = { 0x0008, 1, 1, 0x00, 0x01 },
960*4882a593Smuzhiyun .pipe_rate_sel = { 0x0008, 2, 2, 0x00, 0x01 },
961*4882a593Smuzhiyun .pipe_rxterm_sel = { 0x0008, 8, 8, 0x00, 0x01 },
962*4882a593Smuzhiyun .pipe_txelec_sel = { 0x0008, 12, 12, 0x00, 0x01 },
963*4882a593Smuzhiyun .pipe_txcomp_sel = { 0x0008, 15, 15, 0x00, 0x01 },
964*4882a593Smuzhiyun .pipe_clk_ext = { 0x000c, 9, 8, 0x02, 0x01 },
965*4882a593Smuzhiyun .pipe_sel_usb = { 0x000c, 14, 13, 0x00, 0x01 },
966*4882a593Smuzhiyun .pipe_sel_qsgmii = { 0x000c, 15, 13, 0x00, 0x07 },
967*4882a593Smuzhiyun .pipe_phy_status = { 0x0034, 6, 6, 0x01, 0x00 },
968*4882a593Smuzhiyun .con0_for_pcie = { 0x0000, 15, 0, 0x00, 0x1000 },
969*4882a593Smuzhiyun .con1_for_pcie = { 0x0004, 15, 0, 0x00, 0x0000 },
970*4882a593Smuzhiyun .con2_for_pcie = { 0x0008, 15, 0, 0x00, 0x0101 },
971*4882a593Smuzhiyun .con3_for_pcie = { 0x000c, 15, 0, 0x00, 0x0200 },
972*4882a593Smuzhiyun .con0_for_sata = { 0x0000, 15, 0, 0x00, 0x0119 },
973*4882a593Smuzhiyun .con1_for_sata = { 0x0004, 15, 0, 0x00, 0x0040 },
974*4882a593Smuzhiyun .con2_for_sata = { 0x0008, 15, 0, 0x00, 0x80c3 },
975*4882a593Smuzhiyun .con3_for_sata = { 0x000c, 15, 0, 0x00, 0x4407 },
976*4882a593Smuzhiyun /* pipe-grf */
977*4882a593Smuzhiyun .pipe_con0_for_sata = { 0x0000, 15, 0, 0x00, 0x2220 },
978*4882a593Smuzhiyun .pipe_sgmii_mac_sel = { 0x0040, 1, 1, 0x00, 0x01 },
979*4882a593Smuzhiyun .pipe_xpcs_phy_ready = { 0x0040, 2, 2, 0x00, 0x01 },
980*4882a593Smuzhiyun .u3otg0_port_en = { 0x0104, 15, 0, 0x0181, 0x1100 },
981*4882a593Smuzhiyun .u3otg1_port_en = { 0x0144, 15, 0, 0x0181, 0x1100 },
982*4882a593Smuzhiyun };
983*4882a593Smuzhiyun
984*4882a593Smuzhiyun static const struct clk_bulk_data rk3568_clks[] = {
985*4882a593Smuzhiyun { .id = "refclk" },
986*4882a593Smuzhiyun { .id = "apbclk" },
987*4882a593Smuzhiyun { .id = "pipe_clk" },
988*4882a593Smuzhiyun };
989*4882a593Smuzhiyun
990*4882a593Smuzhiyun static const struct rockchip_combphy_cfg rk3568_combphy_cfgs = {
991*4882a593Smuzhiyun .num_clks = ARRAY_SIZE(rk3568_clks),
992*4882a593Smuzhiyun .clks = rk3568_clks,
993*4882a593Smuzhiyun .grfcfg = &rk3568_combphy_grfcfgs,
994*4882a593Smuzhiyun .combphy_cfg = rk3568_combphy_cfg,
995*4882a593Smuzhiyun .force_det_out = true,
996*4882a593Smuzhiyun };
997*4882a593Smuzhiyun
rk3588_combphy_cfg(struct rockchip_combphy_priv * priv)998*4882a593Smuzhiyun static int rk3588_combphy_cfg(struct rockchip_combphy_priv *priv)
999*4882a593Smuzhiyun {
1000*4882a593Smuzhiyun const struct rockchip_combphy_grfcfg *cfg = priv->cfg->grfcfg;
1001*4882a593Smuzhiyun struct clk *refclk = NULL;
1002*4882a593Smuzhiyun unsigned long rate;
1003*4882a593Smuzhiyun int i;
1004*4882a593Smuzhiyun u32 val;
1005*4882a593Smuzhiyun
1006*4882a593Smuzhiyun /* Configure PHY reference clock frequency */
1007*4882a593Smuzhiyun for (i = 0; i < priv->num_clks; i++) {
1008*4882a593Smuzhiyun if (!strncmp(priv->clks[i].id, "refclk", 6)) {
1009*4882a593Smuzhiyun refclk = priv->clks[i].clk;
1010*4882a593Smuzhiyun break;
1011*4882a593Smuzhiyun }
1012*4882a593Smuzhiyun }
1013*4882a593Smuzhiyun
1014*4882a593Smuzhiyun if (!refclk) {
1015*4882a593Smuzhiyun dev_err(priv->dev, "No refclk found\n");
1016*4882a593Smuzhiyun return -EINVAL;
1017*4882a593Smuzhiyun }
1018*4882a593Smuzhiyun
1019*4882a593Smuzhiyun switch (priv->mode) {
1020*4882a593Smuzhiyun case PHY_TYPE_PCIE:
1021*4882a593Smuzhiyun /* Set SSC downward spread spectrum */
1022*4882a593Smuzhiyun val = readl(priv->mmio + (0x1f << 2));
1023*4882a593Smuzhiyun val &= ~GENMASK(5, 4);
1024*4882a593Smuzhiyun val |= 0x01 << 4;
1025*4882a593Smuzhiyun writel(val, priv->mmio + 0x7c);
1026*4882a593Smuzhiyun
1027*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->con0_for_pcie, true);
1028*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->con1_for_pcie, true);
1029*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->con2_for_pcie, true);
1030*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->con3_for_pcie, true);
1031*4882a593Smuzhiyun break;
1032*4882a593Smuzhiyun case PHY_TYPE_USB3:
1033*4882a593Smuzhiyun /* Set SSC downward spread spectrum */
1034*4882a593Smuzhiyun val = readl(priv->mmio + (0x1f << 2));
1035*4882a593Smuzhiyun val &= ~GENMASK(5, 4);
1036*4882a593Smuzhiyun val |= 0x01 << 4;
1037*4882a593Smuzhiyun writel(val, priv->mmio + 0x7c);
1038*4882a593Smuzhiyun
1039*4882a593Smuzhiyun /* Enable adaptive CTLE for USB3.0 Rx */
1040*4882a593Smuzhiyun val = readl(priv->mmio + (0x0e << 2));
1041*4882a593Smuzhiyun val &= ~GENMASK(0, 0);
1042*4882a593Smuzhiyun val |= 0x01;
1043*4882a593Smuzhiyun writel(val, priv->mmio + (0x0e << 2));
1044*4882a593Smuzhiyun
1045*4882a593Smuzhiyun /* Set PLL KVCO fine tuning signals */
1046*4882a593Smuzhiyun val = readl(priv->mmio + (0x20 << 2));
1047*4882a593Smuzhiyun val &= ~(0x7 << 2);
1048*4882a593Smuzhiyun val |= 0x2 << 2;
1049*4882a593Smuzhiyun writel(val, priv->mmio + (0x20 << 2));
1050*4882a593Smuzhiyun
1051*4882a593Smuzhiyun /* Set PLL LPF R1 to su_trim[10:7]=1001 */
1052*4882a593Smuzhiyun writel(0x4, priv->mmio + (0xb << 2));
1053*4882a593Smuzhiyun
1054*4882a593Smuzhiyun /* Set PLL input clock divider 1/2 */
1055*4882a593Smuzhiyun val = readl(priv->mmio + (0x5 << 2));
1056*4882a593Smuzhiyun val &= ~(0x3 << 6);
1057*4882a593Smuzhiyun val |= 0x1 << 6;
1058*4882a593Smuzhiyun writel(val, priv->mmio + (0x5 << 2));
1059*4882a593Smuzhiyun
1060*4882a593Smuzhiyun /* Set PLL loop divider */
1061*4882a593Smuzhiyun writel(0x32, priv->mmio + (0x11 << 2));
1062*4882a593Smuzhiyun
1063*4882a593Smuzhiyun /* Set PLL KVCO to min and set PLL charge pump current to max */
1064*4882a593Smuzhiyun writel(0xf0, priv->mmio + (0xa << 2));
1065*4882a593Smuzhiyun
1066*4882a593Smuzhiyun /* Set Rx squelch input filler bandwidth */
1067*4882a593Smuzhiyun writel(0x0d, priv->mmio + (0x14 << 2));
1068*4882a593Smuzhiyun
1069*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->pipe_txcomp_sel, false);
1070*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->pipe_txelec_sel, false);
1071*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->usb_mode_set, true);
1072*4882a593Smuzhiyun break;
1073*4882a593Smuzhiyun case PHY_TYPE_SATA:
1074*4882a593Smuzhiyun /* Enable adaptive CTLE for SATA Rx */
1075*4882a593Smuzhiyun val = readl(priv->mmio + (0x0e << 2));
1076*4882a593Smuzhiyun val &= ~GENMASK(0, 0);
1077*4882a593Smuzhiyun val |= 0x01;
1078*4882a593Smuzhiyun writel(val, priv->mmio + (0x0e << 2));
1079*4882a593Smuzhiyun /* Set tx_rterm = 50 ohm and rx_rterm = 43.5 ohm */
1080*4882a593Smuzhiyun writel(0x8F, priv->mmio + (0x06 << 2));
1081*4882a593Smuzhiyun
1082*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->con0_for_sata, true);
1083*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->con1_for_sata, true);
1084*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->con2_for_sata, true);
1085*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->con3_for_sata, true);
1086*4882a593Smuzhiyun param_write(priv->pipe_grf, &cfg->pipe_con0_for_sata, true);
1087*4882a593Smuzhiyun param_write(priv->pipe_grf, &cfg->pipe_con1_for_sata, true);
1088*4882a593Smuzhiyun break;
1089*4882a593Smuzhiyun case PHY_TYPE_SGMII:
1090*4882a593Smuzhiyun case PHY_TYPE_QSGMII:
1091*4882a593Smuzhiyun default:
1092*4882a593Smuzhiyun dev_err(priv->dev, "incompatible PHY type\n");
1093*4882a593Smuzhiyun return -EINVAL;
1094*4882a593Smuzhiyun }
1095*4882a593Smuzhiyun
1096*4882a593Smuzhiyun rate = clk_get_rate(refclk);
1097*4882a593Smuzhiyun
1098*4882a593Smuzhiyun switch (rate) {
1099*4882a593Smuzhiyun case 24000000:
1100*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->pipe_clk_24m, true);
1101*4882a593Smuzhiyun if (priv->mode == PHY_TYPE_USB3 || priv->mode == PHY_TYPE_SATA) {
1102*4882a593Smuzhiyun /* Set ssc_cnt[9:0]=0101111101 & 31.5KHz */
1103*4882a593Smuzhiyun val = readl(priv->mmio + (0x0e << 2));
1104*4882a593Smuzhiyun val &= ~GENMASK(7, 6);
1105*4882a593Smuzhiyun val |= 0x01 << 6;
1106*4882a593Smuzhiyun writel(val, priv->mmio + (0x0e << 2));
1107*4882a593Smuzhiyun
1108*4882a593Smuzhiyun val = readl(priv->mmio + (0x0f << 2));
1109*4882a593Smuzhiyun val &= ~GENMASK(7, 0);
1110*4882a593Smuzhiyun val |= 0x5f;
1111*4882a593Smuzhiyun writel(val, priv->mmio + (0x0f << 2));
1112*4882a593Smuzhiyun } else if (priv->mode == PHY_TYPE_PCIE) {
1113*4882a593Smuzhiyun /* PLL KVCO tuning fine */
1114*4882a593Smuzhiyun val = readl(priv->mmio + (0x20 << 2));
1115*4882a593Smuzhiyun val &= ~GENMASK(4, 2);
1116*4882a593Smuzhiyun val |= 0x4 << 2;
1117*4882a593Smuzhiyun writel(val, priv->mmio + (0x20 << 2));
1118*4882a593Smuzhiyun
1119*4882a593Smuzhiyun /* Set up rx_trim */
1120*4882a593Smuzhiyun val = 0x0;
1121*4882a593Smuzhiyun writel(val, priv->mmio + (0x1b << 2));
1122*4882a593Smuzhiyun
1123*4882a593Smuzhiyun /* Set up su_trim: T0_1 */
1124*4882a593Smuzhiyun val = 0x90;
1125*4882a593Smuzhiyun writel(val, priv->mmio + (0xa << 2));
1126*4882a593Smuzhiyun val = 0x02;
1127*4882a593Smuzhiyun writel(val, priv->mmio + (0xb << 2));
1128*4882a593Smuzhiyun val = 0x57;
1129*4882a593Smuzhiyun writel(val, priv->mmio + (0xd << 2));
1130*4882a593Smuzhiyun
1131*4882a593Smuzhiyun val = 0x5f;
1132*4882a593Smuzhiyun writel(val, priv->mmio + (0xf << 2));
1133*4882a593Smuzhiyun }
1134*4882a593Smuzhiyun break;
1135*4882a593Smuzhiyun case 25000000:
1136*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->pipe_clk_25m, true);
1137*4882a593Smuzhiyun break;
1138*4882a593Smuzhiyun case 100000000:
1139*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->pipe_clk_100m, true);
1140*4882a593Smuzhiyun if (priv->mode == PHY_TYPE_PCIE) {
1141*4882a593Smuzhiyun /* gate_tx_pck_sel length select work for L1SS */
1142*4882a593Smuzhiyun val = 0xc0;
1143*4882a593Smuzhiyun writel(val, priv->mmio + 0x74);
1144*4882a593Smuzhiyun
1145*4882a593Smuzhiyun /* PLL KVCO tuning fine */
1146*4882a593Smuzhiyun val = readl(priv->mmio + (0x20 << 2));
1147*4882a593Smuzhiyun val &= ~GENMASK(4, 2);
1148*4882a593Smuzhiyun val |= 0x4 << 2;
1149*4882a593Smuzhiyun writel(val, priv->mmio + (0x20 << 2));
1150*4882a593Smuzhiyun
1151*4882a593Smuzhiyun /* Set up rx_trim: PLL LPF C1 85pf R1 1.25kohm */
1152*4882a593Smuzhiyun val = 0x4c;
1153*4882a593Smuzhiyun writel(val, priv->mmio + (0x1b << 2));
1154*4882a593Smuzhiyun
1155*4882a593Smuzhiyun /* Set up su_trim: T3_P1 650mv */
1156*4882a593Smuzhiyun val = 0x90;
1157*4882a593Smuzhiyun writel(val, priv->mmio + (0xa << 2));
1158*4882a593Smuzhiyun val = 0x43;
1159*4882a593Smuzhiyun writel(val, priv->mmio + (0xb << 2));
1160*4882a593Smuzhiyun val = 0x88;
1161*4882a593Smuzhiyun writel(val, priv->mmio + (0xc << 2));
1162*4882a593Smuzhiyun val = 0x56;
1163*4882a593Smuzhiyun writel(val, priv->mmio + (0xd << 2));
1164*4882a593Smuzhiyun } else if (priv->mode == PHY_TYPE_SATA) {
1165*4882a593Smuzhiyun /* downward spread spectrum +500ppm */
1166*4882a593Smuzhiyun val = readl(priv->mmio + (0x1f << 2));
1167*4882a593Smuzhiyun val &= ~GENMASK(7, 4);
1168*4882a593Smuzhiyun val |= 0x50;
1169*4882a593Smuzhiyun writel(val, priv->mmio + (0x1f << 2));
1170*4882a593Smuzhiyun
1171*4882a593Smuzhiyun /* ssc ppm adjust to 3500ppm */
1172*4882a593Smuzhiyun val = readl(priv->mmio + (0x9 << 2));
1173*4882a593Smuzhiyun val &= ~GENMASK(3, 0);
1174*4882a593Smuzhiyun val |= 0x7;
1175*4882a593Smuzhiyun writel(val, priv->mmio + (0x9 << 2));
1176*4882a593Smuzhiyun }
1177*4882a593Smuzhiyun break;
1178*4882a593Smuzhiyun default:
1179*4882a593Smuzhiyun dev_err(priv->dev, "Unsupported rate: %lu\n", rate);
1180*4882a593Smuzhiyun return -EINVAL;
1181*4882a593Smuzhiyun }
1182*4882a593Smuzhiyun
1183*4882a593Smuzhiyun if (device_property_read_bool(priv->dev, "rockchip,ext-refclk")) {
1184*4882a593Smuzhiyun param_write(priv->phy_grf, &cfg->pipe_clk_ext, true);
1185*4882a593Smuzhiyun if (priv->mode == PHY_TYPE_PCIE && rate == 100000000) {
1186*4882a593Smuzhiyun val = 0x10;
1187*4882a593Smuzhiyun writel(val, priv->mmio + (0x20 << 2));
1188*4882a593Smuzhiyun
1189*4882a593Smuzhiyun val = 0x0c;
1190*4882a593Smuzhiyun writel(val, priv->mmio + (0x1b << 2));
1191*4882a593Smuzhiyun
1192*4882a593Smuzhiyun /* Set up su_trim: T3_P1 650mv */
1193*4882a593Smuzhiyun val = 0x90;
1194*4882a593Smuzhiyun writel(val, priv->mmio + (0xa << 2));
1195*4882a593Smuzhiyun val = 0x43;
1196*4882a593Smuzhiyun writel(val, priv->mmio + (0xb << 2));
1197*4882a593Smuzhiyun val = 0x88;
1198*4882a593Smuzhiyun writel(val, priv->mmio + (0xc << 2));
1199*4882a593Smuzhiyun val = 0x56;
1200*4882a593Smuzhiyun writel(val, priv->mmio + (0xd << 2));
1201*4882a593Smuzhiyun }
1202*4882a593Smuzhiyun }
1203*4882a593Smuzhiyun
1204*4882a593Smuzhiyun if (device_property_read_bool(priv->dev, "rockchip,enable-ssc")) {
1205*4882a593Smuzhiyun val = readl(priv->mmio + (0x7 << 2));
1206*4882a593Smuzhiyun val |= BIT(4);
1207*4882a593Smuzhiyun writel(val, priv->mmio + (0x7 << 2));
1208*4882a593Smuzhiyun
1209*4882a593Smuzhiyun if (priv->mode == PHY_TYPE_PCIE && rate == 24000000) {
1210*4882a593Smuzhiyun /* Xin24M T0_1 650mV */
1211*4882a593Smuzhiyun writel(0x00, priv->mmio + (0x10 << 2));
1212*4882a593Smuzhiyun writel(0x32, priv->mmio + (0x11 << 2));
1213*4882a593Smuzhiyun writel(0x00, priv->mmio + (0x1b << 2));
1214*4882a593Smuzhiyun writel(0x90, priv->mmio + (0x0a << 2));
1215*4882a593Smuzhiyun writel(0x02, priv->mmio + (0x0b << 2));
1216*4882a593Smuzhiyun writel(0x08, priv->mmio + (0x0c << 2));
1217*4882a593Smuzhiyun writel(0x57, priv->mmio + (0x0d << 2));
1218*4882a593Smuzhiyun writel(0x40, priv->mmio + (0x0e << 2));
1219*4882a593Smuzhiyun writel(0x5f, priv->mmio + (0x0f << 2));
1220*4882a593Smuzhiyun writel(0x10, priv->mmio + (0x20 << 2));
1221*4882a593Smuzhiyun }
1222*4882a593Smuzhiyun }
1223*4882a593Smuzhiyun
1224*4882a593Smuzhiyun return 0;
1225*4882a593Smuzhiyun }
1226*4882a593Smuzhiyun
1227*4882a593Smuzhiyun static const struct rockchip_combphy_grfcfg rk3588_combphy_grfcfgs = {
1228*4882a593Smuzhiyun /* pipe-phy-grf */
1229*4882a593Smuzhiyun .pcie_mode_set = { 0x0000, 5, 0, 0x00, 0x11 },
1230*4882a593Smuzhiyun .usb_mode_set = { 0x0000, 5, 0, 0x00, 0x04 },
1231*4882a593Smuzhiyun .pipe_rxterm_set = { 0x0000, 12, 12, 0x00, 0x01 },
1232*4882a593Smuzhiyun .pipe_txelec_set = { 0x0004, 1, 1, 0x00, 0x01 },
1233*4882a593Smuzhiyun .pipe_txcomp_set = { 0x0004, 4, 4, 0x00, 0x01 },
1234*4882a593Smuzhiyun .pipe_clk_24m = { 0x0004, 14, 13, 0x00, 0x00 },
1235*4882a593Smuzhiyun .pipe_clk_25m = { 0x0004, 14, 13, 0x00, 0x01 },
1236*4882a593Smuzhiyun .pipe_clk_100m = { 0x0004, 14, 13, 0x00, 0x02 },
1237*4882a593Smuzhiyun .pipe_rxterm_sel = { 0x0008, 8, 8, 0x00, 0x01 },
1238*4882a593Smuzhiyun .pipe_txelec_sel = { 0x0008, 12, 12, 0x00, 0x01 },
1239*4882a593Smuzhiyun .pipe_txcomp_sel = { 0x0008, 15, 15, 0x00, 0x01 },
1240*4882a593Smuzhiyun .pipe_clk_ext = { 0x000c, 9, 8, 0x02, 0x01 },
1241*4882a593Smuzhiyun .pipe_phy_status = { 0x0034, 6, 6, 0x01, 0x00 },
1242*4882a593Smuzhiyun .con0_for_pcie = { 0x0000, 15, 0, 0x00, 0x1000 },
1243*4882a593Smuzhiyun .con1_for_pcie = { 0x0004, 15, 0, 0x00, 0x0000 },
1244*4882a593Smuzhiyun .con2_for_pcie = { 0x0008, 15, 0, 0x00, 0x0101 },
1245*4882a593Smuzhiyun .con3_for_pcie = { 0x000c, 15, 0, 0x00, 0x0200 },
1246*4882a593Smuzhiyun .con0_for_sata = { 0x0000, 15, 0, 0x00, 0x0129 },
1247*4882a593Smuzhiyun .con1_for_sata = { 0x0004, 15, 0, 0x00, 0x0000 },
1248*4882a593Smuzhiyun .con2_for_sata = { 0x0008, 15, 0, 0x00, 0x80c1 },
1249*4882a593Smuzhiyun .con3_for_sata = { 0x000c, 15, 0, 0x00, 0x0407 },
1250*4882a593Smuzhiyun /* pipe-grf */
1251*4882a593Smuzhiyun .pipe_con0_for_sata = { 0x0000, 11, 5, 0x00, 0x22 },
1252*4882a593Smuzhiyun .pipe_con1_for_sata = { 0x0004, 2, 0, 0x00, 0x2 },
1253*4882a593Smuzhiyun };
1254*4882a593Smuzhiyun
1255*4882a593Smuzhiyun static const struct clk_bulk_data rk3588_clks[] = {
1256*4882a593Smuzhiyun { .id = "refclk" },
1257*4882a593Smuzhiyun { .id = "apbclk" },
1258*4882a593Smuzhiyun { .id = "phpclk" },
1259*4882a593Smuzhiyun };
1260*4882a593Smuzhiyun
1261*4882a593Smuzhiyun static const struct rockchip_combphy_cfg rk3588_combphy_cfgs = {
1262*4882a593Smuzhiyun .num_clks = ARRAY_SIZE(rk3588_clks),
1263*4882a593Smuzhiyun .clks = rk3588_clks,
1264*4882a593Smuzhiyun .grfcfg = &rk3588_combphy_grfcfgs,
1265*4882a593Smuzhiyun .combphy_cfg = rk3588_combphy_cfg,
1266*4882a593Smuzhiyun .force_det_out = true,
1267*4882a593Smuzhiyun };
1268*4882a593Smuzhiyun
1269*4882a593Smuzhiyun static const struct of_device_id rockchip_combphy_of_match[] = {
1270*4882a593Smuzhiyun {
1271*4882a593Smuzhiyun .compatible = "rockchip,rk3528-naneng-combphy",
1272*4882a593Smuzhiyun .data = &rk3528_combphy_cfgs,
1273*4882a593Smuzhiyun },
1274*4882a593Smuzhiyun {
1275*4882a593Smuzhiyun .compatible = "rockchip,rk3562-naneng-combphy",
1276*4882a593Smuzhiyun .data = &rk3562_combphy_cfgs,
1277*4882a593Smuzhiyun },
1278*4882a593Smuzhiyun {
1279*4882a593Smuzhiyun .compatible = "rockchip,rk3568-naneng-combphy",
1280*4882a593Smuzhiyun .data = &rk3568_combphy_cfgs,
1281*4882a593Smuzhiyun },
1282*4882a593Smuzhiyun {
1283*4882a593Smuzhiyun .compatible = "rockchip,rk3588-naneng-combphy",
1284*4882a593Smuzhiyun .data = &rk3588_combphy_cfgs,
1285*4882a593Smuzhiyun },
1286*4882a593Smuzhiyun { },
1287*4882a593Smuzhiyun };
1288*4882a593Smuzhiyun MODULE_DEVICE_TABLE(of, rockchip_combphy_of_match);
1289*4882a593Smuzhiyun
1290*4882a593Smuzhiyun static struct platform_driver rockchip_combphy_driver = {
1291*4882a593Smuzhiyun .probe = rockchip_combphy_probe,
1292*4882a593Smuzhiyun .driver = {
1293*4882a593Smuzhiyun .name = "naneng-combphy",
1294*4882a593Smuzhiyun .of_match_table = rockchip_combphy_of_match,
1295*4882a593Smuzhiyun },
1296*4882a593Smuzhiyun };
1297*4882a593Smuzhiyun module_platform_driver(rockchip_combphy_driver);
1298*4882a593Smuzhiyun
1299*4882a593Smuzhiyun MODULE_DESCRIPTION("Rockchip NANENG COMBPHY driver");
1300*4882a593Smuzhiyun MODULE_LICENSE("GPL v2");
1301