1 // SPDX-License-Identifier: BSD-3-Clause
2 /* Copyright (c) 2016-2018, NXP Semiconductors
3 * Copyright (c) 2018-2019, Vladimir Oltean <olteanv@gmail.com>
4 */
5 #include <linux/packing.h>
6 #include "sja1105.h"
7
8 #define SJA1105_SIZE_CGU_CMD 4
9
10 /* Common structure for CFG_PAD_MIIx_RX and CFG_PAD_MIIx_TX */
11 struct sja1105_cfg_pad_mii {
12 u64 d32_os;
13 u64 d32_ih;
14 u64 d32_ipud;
15 u64 d10_ih;
16 u64 d10_os;
17 u64 d10_ipud;
18 u64 ctrl_os;
19 u64 ctrl_ih;
20 u64 ctrl_ipud;
21 u64 clk_os;
22 u64 clk_ih;
23 u64 clk_ipud;
24 };
25
26 struct sja1105_cfg_pad_mii_id {
27 u64 rxc_stable_ovr;
28 u64 rxc_delay;
29 u64 rxc_bypass;
30 u64 rxc_pd;
31 u64 txc_stable_ovr;
32 u64 txc_delay;
33 u64 txc_bypass;
34 u64 txc_pd;
35 };
36
37 /* UM10944 Table 82.
38 * IDIV_0_C to IDIV_4_C control registers
39 * (addr. 10000Bh to 10000Fh)
40 */
41 struct sja1105_cgu_idiv {
42 u64 clksrc;
43 u64 autoblock;
44 u64 idiv;
45 u64 pd;
46 };
47
48 /* PLL_1_C control register
49 *
50 * SJA1105 E/T: UM10944 Table 81 (address 10000Ah)
51 * SJA1105 P/Q/R/S: UM11040 Table 116 (address 10000Ah)
52 */
53 struct sja1105_cgu_pll_ctrl {
54 u64 pllclksrc;
55 u64 msel;
56 u64 autoblock;
57 u64 psel;
58 u64 direct;
59 u64 fbsel;
60 u64 bypass;
61 u64 pd;
62 };
63
64 enum {
65 CLKSRC_MII0_TX_CLK = 0x00,
66 CLKSRC_MII0_RX_CLK = 0x01,
67 CLKSRC_MII1_TX_CLK = 0x02,
68 CLKSRC_MII1_RX_CLK = 0x03,
69 CLKSRC_MII2_TX_CLK = 0x04,
70 CLKSRC_MII2_RX_CLK = 0x05,
71 CLKSRC_MII3_TX_CLK = 0x06,
72 CLKSRC_MII3_RX_CLK = 0x07,
73 CLKSRC_MII4_TX_CLK = 0x08,
74 CLKSRC_MII4_RX_CLK = 0x09,
75 CLKSRC_PLL0 = 0x0B,
76 CLKSRC_PLL1 = 0x0E,
77 CLKSRC_IDIV0 = 0x11,
78 CLKSRC_IDIV1 = 0x12,
79 CLKSRC_IDIV2 = 0x13,
80 CLKSRC_IDIV3 = 0x14,
81 CLKSRC_IDIV4 = 0x15,
82 };
83
84 /* UM10944 Table 83.
85 * MIIx clock control registers 1 to 30
86 * (addresses 100013h to 100035h)
87 */
88 struct sja1105_cgu_mii_ctrl {
89 u64 clksrc;
90 u64 autoblock;
91 u64 pd;
92 };
93
sja1105_cgu_idiv_packing(void * buf,struct sja1105_cgu_idiv * idiv,enum packing_op op)94 static void sja1105_cgu_idiv_packing(void *buf, struct sja1105_cgu_idiv *idiv,
95 enum packing_op op)
96 {
97 const int size = 4;
98
99 sja1105_packing(buf, &idiv->clksrc, 28, 24, size, op);
100 sja1105_packing(buf, &idiv->autoblock, 11, 11, size, op);
101 sja1105_packing(buf, &idiv->idiv, 5, 2, size, op);
102 sja1105_packing(buf, &idiv->pd, 0, 0, size, op);
103 }
104
sja1105_cgu_idiv_config(struct sja1105_private * priv,int port,bool enabled,int factor)105 static int sja1105_cgu_idiv_config(struct sja1105_private *priv, int port,
106 bool enabled, int factor)
107 {
108 const struct sja1105_regs *regs = priv->info->regs;
109 struct device *dev = priv->ds->dev;
110 struct sja1105_cgu_idiv idiv;
111 u8 packed_buf[SJA1105_SIZE_CGU_CMD] = {0};
112
113 if (enabled && factor != 1 && factor != 10) {
114 dev_err(dev, "idiv factor must be 1 or 10\n");
115 return -ERANGE;
116 }
117
118 /* Payload for packed_buf */
119 idiv.clksrc = 0x0A; /* 25MHz */
120 idiv.autoblock = 1; /* Block clk automatically */
121 idiv.idiv = factor - 1; /* Divide by 1 or 10 */
122 idiv.pd = enabled ? 0 : 1; /* Power down? */
123 sja1105_cgu_idiv_packing(packed_buf, &idiv, PACK);
124
125 return sja1105_xfer_buf(priv, SPI_WRITE, regs->cgu_idiv[port],
126 packed_buf, SJA1105_SIZE_CGU_CMD);
127 }
128
129 static void
sja1105_cgu_mii_control_packing(void * buf,struct sja1105_cgu_mii_ctrl * cmd,enum packing_op op)130 sja1105_cgu_mii_control_packing(void *buf, struct sja1105_cgu_mii_ctrl *cmd,
131 enum packing_op op)
132 {
133 const int size = 4;
134
135 sja1105_packing(buf, &cmd->clksrc, 28, 24, size, op);
136 sja1105_packing(buf, &cmd->autoblock, 11, 11, size, op);
137 sja1105_packing(buf, &cmd->pd, 0, 0, size, op);
138 }
139
sja1105_cgu_mii_tx_clk_config(struct sja1105_private * priv,int port,sja1105_mii_role_t role)140 static int sja1105_cgu_mii_tx_clk_config(struct sja1105_private *priv,
141 int port, sja1105_mii_role_t role)
142 {
143 const struct sja1105_regs *regs = priv->info->regs;
144 struct sja1105_cgu_mii_ctrl mii_tx_clk;
145 const int mac_clk_sources[] = {
146 CLKSRC_MII0_TX_CLK,
147 CLKSRC_MII1_TX_CLK,
148 CLKSRC_MII2_TX_CLK,
149 CLKSRC_MII3_TX_CLK,
150 CLKSRC_MII4_TX_CLK,
151 };
152 const int phy_clk_sources[] = {
153 CLKSRC_IDIV0,
154 CLKSRC_IDIV1,
155 CLKSRC_IDIV2,
156 CLKSRC_IDIV3,
157 CLKSRC_IDIV4,
158 };
159 u8 packed_buf[SJA1105_SIZE_CGU_CMD] = {0};
160 int clksrc;
161
162 if (role == XMII_MAC)
163 clksrc = mac_clk_sources[port];
164 else
165 clksrc = phy_clk_sources[port];
166
167 /* Payload for packed_buf */
168 mii_tx_clk.clksrc = clksrc;
169 mii_tx_clk.autoblock = 1; /* Autoblock clk while changing clksrc */
170 mii_tx_clk.pd = 0; /* Power Down off => enabled */
171 sja1105_cgu_mii_control_packing(packed_buf, &mii_tx_clk, PACK);
172
173 return sja1105_xfer_buf(priv, SPI_WRITE, regs->mii_tx_clk[port],
174 packed_buf, SJA1105_SIZE_CGU_CMD);
175 }
176
177 static int
sja1105_cgu_mii_rx_clk_config(struct sja1105_private * priv,int port)178 sja1105_cgu_mii_rx_clk_config(struct sja1105_private *priv, int port)
179 {
180 const struct sja1105_regs *regs = priv->info->regs;
181 struct sja1105_cgu_mii_ctrl mii_rx_clk;
182 u8 packed_buf[SJA1105_SIZE_CGU_CMD] = {0};
183 const int clk_sources[] = {
184 CLKSRC_MII0_RX_CLK,
185 CLKSRC_MII1_RX_CLK,
186 CLKSRC_MII2_RX_CLK,
187 CLKSRC_MII3_RX_CLK,
188 CLKSRC_MII4_RX_CLK,
189 };
190
191 /* Payload for packed_buf */
192 mii_rx_clk.clksrc = clk_sources[port];
193 mii_rx_clk.autoblock = 1; /* Autoblock clk while changing clksrc */
194 mii_rx_clk.pd = 0; /* Power Down off => enabled */
195 sja1105_cgu_mii_control_packing(packed_buf, &mii_rx_clk, PACK);
196
197 return sja1105_xfer_buf(priv, SPI_WRITE, regs->mii_rx_clk[port],
198 packed_buf, SJA1105_SIZE_CGU_CMD);
199 }
200
201 static int
sja1105_cgu_mii_ext_tx_clk_config(struct sja1105_private * priv,int port)202 sja1105_cgu_mii_ext_tx_clk_config(struct sja1105_private *priv, int port)
203 {
204 const struct sja1105_regs *regs = priv->info->regs;
205 struct sja1105_cgu_mii_ctrl mii_ext_tx_clk;
206 u8 packed_buf[SJA1105_SIZE_CGU_CMD] = {0};
207 const int clk_sources[] = {
208 CLKSRC_IDIV0,
209 CLKSRC_IDIV1,
210 CLKSRC_IDIV2,
211 CLKSRC_IDIV3,
212 CLKSRC_IDIV4,
213 };
214
215 /* Payload for packed_buf */
216 mii_ext_tx_clk.clksrc = clk_sources[port];
217 mii_ext_tx_clk.autoblock = 1; /* Autoblock clk while changing clksrc */
218 mii_ext_tx_clk.pd = 0; /* Power Down off => enabled */
219 sja1105_cgu_mii_control_packing(packed_buf, &mii_ext_tx_clk, PACK);
220
221 return sja1105_xfer_buf(priv, SPI_WRITE, regs->mii_ext_tx_clk[port],
222 packed_buf, SJA1105_SIZE_CGU_CMD);
223 }
224
225 static int
sja1105_cgu_mii_ext_rx_clk_config(struct sja1105_private * priv,int port)226 sja1105_cgu_mii_ext_rx_clk_config(struct sja1105_private *priv, int port)
227 {
228 const struct sja1105_regs *regs = priv->info->regs;
229 struct sja1105_cgu_mii_ctrl mii_ext_rx_clk;
230 u8 packed_buf[SJA1105_SIZE_CGU_CMD] = {0};
231 const int clk_sources[] = {
232 CLKSRC_IDIV0,
233 CLKSRC_IDIV1,
234 CLKSRC_IDIV2,
235 CLKSRC_IDIV3,
236 CLKSRC_IDIV4,
237 };
238
239 /* Payload for packed_buf */
240 mii_ext_rx_clk.clksrc = clk_sources[port];
241 mii_ext_rx_clk.autoblock = 1; /* Autoblock clk while changing clksrc */
242 mii_ext_rx_clk.pd = 0; /* Power Down off => enabled */
243 sja1105_cgu_mii_control_packing(packed_buf, &mii_ext_rx_clk, PACK);
244
245 return sja1105_xfer_buf(priv, SPI_WRITE, regs->mii_ext_rx_clk[port],
246 packed_buf, SJA1105_SIZE_CGU_CMD);
247 }
248
sja1105_mii_clocking_setup(struct sja1105_private * priv,int port,sja1105_mii_role_t role)249 static int sja1105_mii_clocking_setup(struct sja1105_private *priv, int port,
250 sja1105_mii_role_t role)
251 {
252 struct device *dev = priv->ds->dev;
253 int rc;
254
255 dev_dbg(dev, "Configuring MII-%s clocking\n",
256 (role == XMII_MAC) ? "MAC" : "PHY");
257 /* If role is MAC, disable IDIV
258 * If role is PHY, enable IDIV and configure for 1/1 divider
259 */
260 rc = sja1105_cgu_idiv_config(priv, port, (role == XMII_PHY), 1);
261 if (rc < 0)
262 return rc;
263
264 /* Configure CLKSRC of MII_TX_CLK_n
265 * * If role is MAC, select TX_CLK_n
266 * * If role is PHY, select IDIV_n
267 */
268 rc = sja1105_cgu_mii_tx_clk_config(priv, port, role);
269 if (rc < 0)
270 return rc;
271
272 /* Configure CLKSRC of MII_RX_CLK_n
273 * Select RX_CLK_n
274 */
275 rc = sja1105_cgu_mii_rx_clk_config(priv, port);
276 if (rc < 0)
277 return rc;
278
279 if (role == XMII_PHY) {
280 /* Per MII spec, the PHY (which is us) drives the TX_CLK pin */
281
282 /* Configure CLKSRC of EXT_TX_CLK_n
283 * Select IDIV_n
284 */
285 rc = sja1105_cgu_mii_ext_tx_clk_config(priv, port);
286 if (rc < 0)
287 return rc;
288
289 /* Configure CLKSRC of EXT_RX_CLK_n
290 * Select IDIV_n
291 */
292 rc = sja1105_cgu_mii_ext_rx_clk_config(priv, port);
293 if (rc < 0)
294 return rc;
295 }
296 return 0;
297 }
298
299 static void
sja1105_cgu_pll_control_packing(void * buf,struct sja1105_cgu_pll_ctrl * cmd,enum packing_op op)300 sja1105_cgu_pll_control_packing(void *buf, struct sja1105_cgu_pll_ctrl *cmd,
301 enum packing_op op)
302 {
303 const int size = 4;
304
305 sja1105_packing(buf, &cmd->pllclksrc, 28, 24, size, op);
306 sja1105_packing(buf, &cmd->msel, 23, 16, size, op);
307 sja1105_packing(buf, &cmd->autoblock, 11, 11, size, op);
308 sja1105_packing(buf, &cmd->psel, 9, 8, size, op);
309 sja1105_packing(buf, &cmd->direct, 7, 7, size, op);
310 sja1105_packing(buf, &cmd->fbsel, 6, 6, size, op);
311 sja1105_packing(buf, &cmd->bypass, 1, 1, size, op);
312 sja1105_packing(buf, &cmd->pd, 0, 0, size, op);
313 }
314
sja1105_cgu_rgmii_tx_clk_config(struct sja1105_private * priv,int port,sja1105_speed_t speed)315 static int sja1105_cgu_rgmii_tx_clk_config(struct sja1105_private *priv,
316 int port, sja1105_speed_t speed)
317 {
318 const struct sja1105_regs *regs = priv->info->regs;
319 struct sja1105_cgu_mii_ctrl txc;
320 u8 packed_buf[SJA1105_SIZE_CGU_CMD] = {0};
321 int clksrc;
322
323 if (speed == SJA1105_SPEED_1000MBPS) {
324 clksrc = CLKSRC_PLL0;
325 } else {
326 int clk_sources[] = {CLKSRC_IDIV0, CLKSRC_IDIV1, CLKSRC_IDIV2,
327 CLKSRC_IDIV3, CLKSRC_IDIV4};
328 clksrc = clk_sources[port];
329 }
330
331 /* RGMII: 125MHz for 1000, 25MHz for 100, 2.5MHz for 10 */
332 txc.clksrc = clksrc;
333 /* Autoblock clk while changing clksrc */
334 txc.autoblock = 1;
335 /* Power Down off => enabled */
336 txc.pd = 0;
337 sja1105_cgu_mii_control_packing(packed_buf, &txc, PACK);
338
339 return sja1105_xfer_buf(priv, SPI_WRITE, regs->rgmii_tx_clk[port],
340 packed_buf, SJA1105_SIZE_CGU_CMD);
341 }
342
343 /* AGU */
344 static void
sja1105_cfg_pad_mii_packing(void * buf,struct sja1105_cfg_pad_mii * cmd,enum packing_op op)345 sja1105_cfg_pad_mii_packing(void *buf, struct sja1105_cfg_pad_mii *cmd,
346 enum packing_op op)
347 {
348 const int size = 4;
349
350 sja1105_packing(buf, &cmd->d32_os, 28, 27, size, op);
351 sja1105_packing(buf, &cmd->d32_ih, 26, 26, size, op);
352 sja1105_packing(buf, &cmd->d32_ipud, 25, 24, size, op);
353 sja1105_packing(buf, &cmd->d10_os, 20, 19, size, op);
354 sja1105_packing(buf, &cmd->d10_ih, 18, 18, size, op);
355 sja1105_packing(buf, &cmd->d10_ipud, 17, 16, size, op);
356 sja1105_packing(buf, &cmd->ctrl_os, 12, 11, size, op);
357 sja1105_packing(buf, &cmd->ctrl_ih, 10, 10, size, op);
358 sja1105_packing(buf, &cmd->ctrl_ipud, 9, 8, size, op);
359 sja1105_packing(buf, &cmd->clk_os, 4, 3, size, op);
360 sja1105_packing(buf, &cmd->clk_ih, 2, 2, size, op);
361 sja1105_packing(buf, &cmd->clk_ipud, 1, 0, size, op);
362 }
363
sja1105_rgmii_cfg_pad_tx_config(struct sja1105_private * priv,int port)364 static int sja1105_rgmii_cfg_pad_tx_config(struct sja1105_private *priv,
365 int port)
366 {
367 const struct sja1105_regs *regs = priv->info->regs;
368 struct sja1105_cfg_pad_mii pad_mii_tx = {0};
369 u8 packed_buf[SJA1105_SIZE_CGU_CMD] = {0};
370
371 /* Payload */
372 pad_mii_tx.d32_os = 3; /* TXD[3:2] output stage: */
373 /* high noise/high speed */
374 pad_mii_tx.d10_os = 3; /* TXD[1:0] output stage: */
375 /* high noise/high speed */
376 pad_mii_tx.d32_ipud = 2; /* TXD[3:2] input stage: */
377 /* plain input (default) */
378 pad_mii_tx.d10_ipud = 2; /* TXD[1:0] input stage: */
379 /* plain input (default) */
380 pad_mii_tx.ctrl_os = 3; /* TX_CTL / TX_ER output stage */
381 pad_mii_tx.ctrl_ipud = 2; /* TX_CTL / TX_ER input stage (default) */
382 pad_mii_tx.clk_os = 3; /* TX_CLK output stage */
383 pad_mii_tx.clk_ih = 0; /* TX_CLK input hysteresis (default) */
384 pad_mii_tx.clk_ipud = 2; /* TX_CLK input stage (default) */
385 sja1105_cfg_pad_mii_packing(packed_buf, &pad_mii_tx, PACK);
386
387 return sja1105_xfer_buf(priv, SPI_WRITE, regs->pad_mii_tx[port],
388 packed_buf, SJA1105_SIZE_CGU_CMD);
389 }
390
sja1105_cfg_pad_rx_config(struct sja1105_private * priv,int port)391 static int sja1105_cfg_pad_rx_config(struct sja1105_private *priv, int port)
392 {
393 const struct sja1105_regs *regs = priv->info->regs;
394 struct sja1105_cfg_pad_mii pad_mii_rx = {0};
395 u8 packed_buf[SJA1105_SIZE_CGU_CMD] = {0};
396
397 /* Payload */
398 pad_mii_rx.d32_ih = 0; /* RXD[3:2] input stage hysteresis: */
399 /* non-Schmitt (default) */
400 pad_mii_rx.d32_ipud = 2; /* RXD[3:2] input weak pull-up/down */
401 /* plain input (default) */
402 pad_mii_rx.d10_ih = 0; /* RXD[1:0] input stage hysteresis: */
403 /* non-Schmitt (default) */
404 pad_mii_rx.d10_ipud = 2; /* RXD[1:0] input weak pull-up/down */
405 /* plain input (default) */
406 pad_mii_rx.ctrl_ih = 0; /* RX_DV/CRS_DV/RX_CTL and RX_ER */
407 /* input stage hysteresis: */
408 /* non-Schmitt (default) */
409 pad_mii_rx.ctrl_ipud = 3; /* RX_DV/CRS_DV/RX_CTL and RX_ER */
410 /* input stage weak pull-up/down: */
411 /* pull-down */
412 pad_mii_rx.clk_os = 2; /* RX_CLK/RXC output stage: */
413 /* medium noise/fast speed (default) */
414 pad_mii_rx.clk_ih = 0; /* RX_CLK/RXC input hysteresis: */
415 /* non-Schmitt (default) */
416 pad_mii_rx.clk_ipud = 2; /* RX_CLK/RXC input pull-up/down: */
417 /* plain input (default) */
418 sja1105_cfg_pad_mii_packing(packed_buf, &pad_mii_rx, PACK);
419
420 return sja1105_xfer_buf(priv, SPI_WRITE, regs->pad_mii_rx[port],
421 packed_buf, SJA1105_SIZE_CGU_CMD);
422 }
423
424 static void
sja1105_cfg_pad_mii_id_packing(void * buf,struct sja1105_cfg_pad_mii_id * cmd,enum packing_op op)425 sja1105_cfg_pad_mii_id_packing(void *buf, struct sja1105_cfg_pad_mii_id *cmd,
426 enum packing_op op)
427 {
428 const int size = SJA1105_SIZE_CGU_CMD;
429
430 sja1105_packing(buf, &cmd->rxc_stable_ovr, 15, 15, size, op);
431 sja1105_packing(buf, &cmd->rxc_delay, 14, 10, size, op);
432 sja1105_packing(buf, &cmd->rxc_bypass, 9, 9, size, op);
433 sja1105_packing(buf, &cmd->rxc_pd, 8, 8, size, op);
434 sja1105_packing(buf, &cmd->txc_stable_ovr, 7, 7, size, op);
435 sja1105_packing(buf, &cmd->txc_delay, 6, 2, size, op);
436 sja1105_packing(buf, &cmd->txc_bypass, 1, 1, size, op);
437 sja1105_packing(buf, &cmd->txc_pd, 0, 0, size, op);
438 }
439
440 /* Valid range in degrees is an integer between 73.8 and 101.7 */
sja1105_rgmii_delay(u64 phase)441 static u64 sja1105_rgmii_delay(u64 phase)
442 {
443 /* UM11040.pdf: The delay in degree phase is 73.8 + delay_tune * 0.9.
444 * To avoid floating point operations we'll multiply by 10
445 * and get 1 decimal point precision.
446 */
447 phase *= 10;
448 return (phase - 738) / 9;
449 }
450
451 /* The RGMII delay setup procedure is 2-step and gets called upon each
452 * .phylink_mac_config. Both are strategic.
453 * The reason is that the RX Tunable Delay Line of the SJA1105 MAC has issues
454 * with recovering from a frequency change of the link partner's RGMII clock.
455 * The easiest way to recover from this is to temporarily power down the TDL,
456 * as it will re-lock at the new frequency afterwards.
457 */
sja1105pqrs_setup_rgmii_delay(const void * ctx,int port)458 int sja1105pqrs_setup_rgmii_delay(const void *ctx, int port)
459 {
460 const struct sja1105_private *priv = ctx;
461 const struct sja1105_regs *regs = priv->info->regs;
462 struct sja1105_cfg_pad_mii_id pad_mii_id = {0};
463 u8 packed_buf[SJA1105_SIZE_CGU_CMD] = {0};
464 int rc;
465
466 if (priv->rgmii_rx_delay[port])
467 pad_mii_id.rxc_delay = sja1105_rgmii_delay(90);
468 if (priv->rgmii_tx_delay[port])
469 pad_mii_id.txc_delay = sja1105_rgmii_delay(90);
470
471 /* Stage 1: Turn the RGMII delay lines off. */
472 pad_mii_id.rxc_bypass = 1;
473 pad_mii_id.rxc_pd = 1;
474 pad_mii_id.txc_bypass = 1;
475 pad_mii_id.txc_pd = 1;
476 sja1105_cfg_pad_mii_id_packing(packed_buf, &pad_mii_id, PACK);
477
478 rc = sja1105_xfer_buf(priv, SPI_WRITE, regs->pad_mii_id[port],
479 packed_buf, SJA1105_SIZE_CGU_CMD);
480 if (rc < 0)
481 return rc;
482
483 /* Stage 2: Turn the RGMII delay lines on. */
484 if (priv->rgmii_rx_delay[port]) {
485 pad_mii_id.rxc_bypass = 0;
486 pad_mii_id.rxc_pd = 0;
487 }
488 if (priv->rgmii_tx_delay[port]) {
489 pad_mii_id.txc_bypass = 0;
490 pad_mii_id.txc_pd = 0;
491 }
492 sja1105_cfg_pad_mii_id_packing(packed_buf, &pad_mii_id, PACK);
493
494 return sja1105_xfer_buf(priv, SPI_WRITE, regs->pad_mii_id[port],
495 packed_buf, SJA1105_SIZE_CGU_CMD);
496 }
497
sja1105_rgmii_clocking_setup(struct sja1105_private * priv,int port,sja1105_mii_role_t role)498 static int sja1105_rgmii_clocking_setup(struct sja1105_private *priv, int port,
499 sja1105_mii_role_t role)
500 {
501 struct device *dev = priv->ds->dev;
502 struct sja1105_mac_config_entry *mac;
503 sja1105_speed_t speed;
504 int rc;
505
506 mac = priv->static_config.tables[BLK_IDX_MAC_CONFIG].entries;
507 speed = mac[port].speed;
508
509 dev_dbg(dev, "Configuring port %d RGMII at speed %dMbps\n",
510 port, speed);
511
512 switch (speed) {
513 case SJA1105_SPEED_1000MBPS:
514 /* 1000Mbps, IDIV disabled (125 MHz) */
515 rc = sja1105_cgu_idiv_config(priv, port, false, 1);
516 break;
517 case SJA1105_SPEED_100MBPS:
518 /* 100Mbps, IDIV enabled, divide by 1 (25 MHz) */
519 rc = sja1105_cgu_idiv_config(priv, port, true, 1);
520 break;
521 case SJA1105_SPEED_10MBPS:
522 /* 10Mbps, IDIV enabled, divide by 10 (2.5 MHz) */
523 rc = sja1105_cgu_idiv_config(priv, port, true, 10);
524 break;
525 case SJA1105_SPEED_AUTO:
526 /* Skip CGU configuration if there is no speed available
527 * (e.g. link is not established yet)
528 */
529 dev_dbg(dev, "Speed not available, skipping CGU config\n");
530 return 0;
531 default:
532 rc = -EINVAL;
533 }
534
535 if (rc < 0) {
536 dev_err(dev, "Failed to configure idiv\n");
537 return rc;
538 }
539 rc = sja1105_cgu_rgmii_tx_clk_config(priv, port, speed);
540 if (rc < 0) {
541 dev_err(dev, "Failed to configure RGMII Tx clock\n");
542 return rc;
543 }
544 rc = sja1105_rgmii_cfg_pad_tx_config(priv, port);
545 if (rc < 0) {
546 dev_err(dev, "Failed to configure Tx pad registers\n");
547 return rc;
548 }
549 if (!priv->info->setup_rgmii_delay)
550 return 0;
551 /* The role has no hardware effect for RGMII. However we use it as
552 * a proxy for this interface being a MAC-to-MAC connection, with
553 * the RGMII internal delays needing to be applied by us.
554 */
555 if (role == XMII_MAC)
556 return 0;
557
558 return priv->info->setup_rgmii_delay(priv, port);
559 }
560
sja1105_cgu_rmii_ref_clk_config(struct sja1105_private * priv,int port)561 static int sja1105_cgu_rmii_ref_clk_config(struct sja1105_private *priv,
562 int port)
563 {
564 const struct sja1105_regs *regs = priv->info->regs;
565 struct sja1105_cgu_mii_ctrl ref_clk;
566 u8 packed_buf[SJA1105_SIZE_CGU_CMD] = {0};
567 const int clk_sources[] = {
568 CLKSRC_MII0_TX_CLK,
569 CLKSRC_MII1_TX_CLK,
570 CLKSRC_MII2_TX_CLK,
571 CLKSRC_MII3_TX_CLK,
572 CLKSRC_MII4_TX_CLK,
573 };
574
575 /* Payload for packed_buf */
576 ref_clk.clksrc = clk_sources[port];
577 ref_clk.autoblock = 1; /* Autoblock clk while changing clksrc */
578 ref_clk.pd = 0; /* Power Down off => enabled */
579 sja1105_cgu_mii_control_packing(packed_buf, &ref_clk, PACK);
580
581 return sja1105_xfer_buf(priv, SPI_WRITE, regs->rmii_ref_clk[port],
582 packed_buf, SJA1105_SIZE_CGU_CMD);
583 }
584
585 static int
sja1105_cgu_rmii_ext_tx_clk_config(struct sja1105_private * priv,int port)586 sja1105_cgu_rmii_ext_tx_clk_config(struct sja1105_private *priv, int port)
587 {
588 const struct sja1105_regs *regs = priv->info->regs;
589 struct sja1105_cgu_mii_ctrl ext_tx_clk;
590 u8 packed_buf[SJA1105_SIZE_CGU_CMD] = {0};
591
592 /* Payload for packed_buf */
593 ext_tx_clk.clksrc = CLKSRC_PLL1;
594 ext_tx_clk.autoblock = 1; /* Autoblock clk while changing clksrc */
595 ext_tx_clk.pd = 0; /* Power Down off => enabled */
596 sja1105_cgu_mii_control_packing(packed_buf, &ext_tx_clk, PACK);
597
598 return sja1105_xfer_buf(priv, SPI_WRITE, regs->rmii_ext_tx_clk[port],
599 packed_buf, SJA1105_SIZE_CGU_CMD);
600 }
601
sja1105_cgu_rmii_pll_config(struct sja1105_private * priv)602 static int sja1105_cgu_rmii_pll_config(struct sja1105_private *priv)
603 {
604 const struct sja1105_regs *regs = priv->info->regs;
605 u8 packed_buf[SJA1105_SIZE_CGU_CMD] = {0};
606 struct sja1105_cgu_pll_ctrl pll = {0};
607 struct device *dev = priv->ds->dev;
608 int rc;
609
610 /* PLL1 must be enabled and output 50 Mhz.
611 * This is done by writing first 0x0A010941 to
612 * the PLL_1_C register and then deasserting
613 * power down (PD) 0x0A010940.
614 */
615
616 /* Step 1: PLL1 setup for 50Mhz */
617 pll.pllclksrc = 0xA;
618 pll.msel = 0x1;
619 pll.autoblock = 0x1;
620 pll.psel = 0x1;
621 pll.direct = 0x0;
622 pll.fbsel = 0x1;
623 pll.bypass = 0x0;
624 pll.pd = 0x1;
625
626 sja1105_cgu_pll_control_packing(packed_buf, &pll, PACK);
627 rc = sja1105_xfer_buf(priv, SPI_WRITE, regs->rmii_pll1, packed_buf,
628 SJA1105_SIZE_CGU_CMD);
629 if (rc < 0) {
630 dev_err(dev, "failed to configure PLL1 for 50MHz\n");
631 return rc;
632 }
633
634 /* Step 2: Enable PLL1 */
635 pll.pd = 0x0;
636
637 sja1105_cgu_pll_control_packing(packed_buf, &pll, PACK);
638 rc = sja1105_xfer_buf(priv, SPI_WRITE, regs->rmii_pll1, packed_buf,
639 SJA1105_SIZE_CGU_CMD);
640 if (rc < 0) {
641 dev_err(dev, "failed to enable PLL1\n");
642 return rc;
643 }
644 return rc;
645 }
646
sja1105_rmii_clocking_setup(struct sja1105_private * priv,int port,sja1105_mii_role_t role)647 static int sja1105_rmii_clocking_setup(struct sja1105_private *priv, int port,
648 sja1105_mii_role_t role)
649 {
650 struct device *dev = priv->ds->dev;
651 int rc;
652
653 dev_dbg(dev, "Configuring RMII-%s clocking\n",
654 (role == XMII_MAC) ? "MAC" : "PHY");
655 /* AH1601.pdf chapter 2.5.1. Sources */
656 if (role == XMII_MAC) {
657 /* Configure and enable PLL1 for 50Mhz output */
658 rc = sja1105_cgu_rmii_pll_config(priv);
659 if (rc < 0)
660 return rc;
661 }
662 /* Disable IDIV for this port */
663 rc = sja1105_cgu_idiv_config(priv, port, false, 1);
664 if (rc < 0)
665 return rc;
666 /* Source to sink mappings */
667 rc = sja1105_cgu_rmii_ref_clk_config(priv, port);
668 if (rc < 0)
669 return rc;
670 if (role == XMII_MAC) {
671 rc = sja1105_cgu_rmii_ext_tx_clk_config(priv, port);
672 if (rc < 0)
673 return rc;
674 }
675 return 0;
676 }
677
sja1105_clocking_setup_port(struct sja1105_private * priv,int port)678 int sja1105_clocking_setup_port(struct sja1105_private *priv, int port)
679 {
680 struct sja1105_xmii_params_entry *mii;
681 struct device *dev = priv->ds->dev;
682 sja1105_phy_interface_t phy_mode;
683 sja1105_mii_role_t role;
684 int rc;
685
686 mii = priv->static_config.tables[BLK_IDX_XMII_PARAMS].entries;
687
688 /* RGMII etc */
689 phy_mode = mii->xmii_mode[port];
690 /* MAC or PHY, for applicable types (not RGMII) */
691 role = mii->phy_mac[port];
692
693 switch (phy_mode) {
694 case XMII_MODE_MII:
695 rc = sja1105_mii_clocking_setup(priv, port, role);
696 break;
697 case XMII_MODE_RMII:
698 rc = sja1105_rmii_clocking_setup(priv, port, role);
699 break;
700 case XMII_MODE_RGMII:
701 rc = sja1105_rgmii_clocking_setup(priv, port, role);
702 break;
703 case XMII_MODE_SGMII:
704 /* Nothing to do in the CGU for SGMII */
705 rc = 0;
706 break;
707 default:
708 dev_err(dev, "Invalid interface mode specified: %d\n",
709 phy_mode);
710 return -EINVAL;
711 }
712 if (rc) {
713 dev_err(dev, "Clocking setup for port %d failed: %d\n",
714 port, rc);
715 return rc;
716 }
717
718 /* Internally pull down the RX_DV/CRS_DV/RX_CTL and RX_ER inputs */
719 return sja1105_cfg_pad_rx_config(priv, port);
720 }
721
sja1105_clocking_setup(struct sja1105_private * priv)722 int sja1105_clocking_setup(struct sja1105_private *priv)
723 {
724 int port, rc;
725
726 for (port = 0; port < SJA1105_NUM_PORTS; port++) {
727 rc = sja1105_clocking_setup_port(priv, port);
728 if (rc < 0)
729 return rc;
730 }
731 return 0;
732 }
733