Loading...
1// SPDX-License-Identifier: GPL-2.0-or-later
2/* Microchip Sparx5 Switch SerDes driver
3 *
4 * Copyright (c) 2020 Microchip Technology Inc. and its subsidiaries.
5 *
6 * The Sparx5 Chip Register Model can be browsed at this location:
7 * https://github.com/microchip-ung/sparx-5_reginfo
8 * and the datasheet is available here:
9 * https://ww1.microchip.com/downloads/en/DeviceDoc/SparX-5_Family_L2L3_Enterprise_10G_Ethernet_Switches_Datasheet_00003822B.pdf
10 */
11#include <linux/printk.h>
12#include <linux/module.h>
13#include <linux/device.h>
14#include <linux/netdevice.h>
15#include <linux/platform_device.h>
16#include <linux/of.h>
17#include <linux/io.h>
18#include <linux/clk.h>
19#include <linux/phy.h>
20#include <linux/phy/phy.h>
21
22#include "sparx5_serdes.h"
23
24#define SPX5_CMU_MAX 14
25
26#define SPX5_SERDES_10G_START 13
27#define SPX5_SERDES_25G_START 25
28#define SPX5_SERDES_6G10G_CNT SPX5_SERDES_25G_START
29
30/* Optimal power settings from GUC */
31#define SPX5_SERDES_QUIET_MODE_VAL 0x01ef4e0c
32
33enum sparx5_10g28cmu_mode {
34 SPX5_SD10G28_CMU_MAIN = 0,
35 SPX5_SD10G28_CMU_AUX1 = 1,
36 SPX5_SD10G28_CMU_AUX2 = 3,
37 SPX5_SD10G28_CMU_NONE = 4,
38 SPX5_SD10G28_CMU_MAX,
39};
40
41enum sparx5_sd25g28_mode_preset_type {
42 SPX5_SD25G28_MODE_PRESET_25000,
43 SPX5_SD25G28_MODE_PRESET_10000,
44 SPX5_SD25G28_MODE_PRESET_5000,
45 SPX5_SD25G28_MODE_PRESET_SD_2G5,
46 SPX5_SD25G28_MODE_PRESET_1000BASEX,
47};
48
49enum sparx5_sd10g28_mode_preset_type {
50 SPX5_SD10G28_MODE_PRESET_10000,
51 SPX5_SD10G28_MODE_PRESET_SFI_5000_6G,
52 SPX5_SD10G28_MODE_PRESET_SFI_5000_10G,
53 SPX5_SD10G28_MODE_PRESET_QSGMII,
54 SPX5_SD10G28_MODE_PRESET_SD_2G5,
55 SPX5_SD10G28_MODE_PRESET_1000BASEX,
56};
57
58struct sparx5_serdes_io_resource {
59 enum sparx5_serdes_target id;
60 phys_addr_t offset;
61};
62
63struct sparx5_sd25g28_mode_preset {
64 u8 bitwidth;
65 u8 tx_pre_div;
66 u8 fifo_ck_div;
67 u8 pre_divsel;
68 u8 vco_div_mode;
69 u8 sel_div;
70 u8 ck_bitwidth;
71 u8 subrate;
72 u8 com_txcal_en;
73 u8 com_tx_reserve_msb;
74 u8 com_tx_reserve_lsb;
75 u8 cfg_itx_ipcml_base;
76 u8 tx_reserve_lsb;
77 u8 tx_reserve_msb;
78 u8 bw;
79 u8 rxterm;
80 u8 dfe_tap;
81 u8 dfe_enable;
82 bool txmargin;
83 u8 cfg_ctle_rstn;
84 u8 r_dfe_rstn;
85 u8 cfg_pi_bw_3_0;
86 u8 tx_tap_dly;
87 u8 tx_tap_adv;
88};
89
90struct sparx5_sd25g28_media_preset {
91 u8 cfg_eq_c_force_3_0;
92 u8 cfg_vga_ctrl_byp_4_0;
93 u8 cfg_eq_r_force_3_0;
94 u8 cfg_en_adv;
95 u8 cfg_en_main;
96 u8 cfg_en_dly;
97 u8 cfg_tap_adv_3_0;
98 u8 cfg_tap_main;
99 u8 cfg_tap_dly_4_0;
100 u8 cfg_alos_thr_2_0;
101};
102
103struct sparx5_sd25g28_args {
104 u8 if_width; /* UDL if-width: 10/16/20/32/64 */
105 bool skip_cmu_cfg:1; /* Enable/disable CMU cfg */
106 enum sparx5_10g28cmu_mode cmu_sel; /* Device/Mode serdes uses */
107 bool no_pwrcycle:1; /* Omit initial power-cycle */
108 bool txinvert:1; /* Enable inversion of output data */
109 bool rxinvert:1; /* Enable inversion of input data */
110 u16 txswing; /* Set output level */
111 u8 rate; /* Rate of network interface */
112 u8 pi_bw_gen1;
113 u8 duty_cycle; /* Set output level to half/full */
114 bool mute:1; /* Mute Output Buffer */
115 bool reg_rst:1;
116 u8 com_pll_reserve;
117};
118
119struct sparx5_sd25g28_params {
120 u8 reg_rst;
121 u8 cfg_jc_byp;
122 u8 cfg_common_reserve_7_0;
123 u8 r_reg_manual;
124 u8 r_d_width_ctrl_from_hwt;
125 u8 r_d_width_ctrl_2_0;
126 u8 r_txfifo_ck_div_pmad_2_0;
127 u8 r_rxfifo_ck_div_pmad_2_0;
128 u8 cfg_pll_lol_set;
129 u8 cfg_vco_div_mode_1_0;
130 u8 cfg_pre_divsel_1_0;
131 u8 cfg_sel_div_3_0;
132 u8 cfg_vco_start_code_3_0;
133 u8 cfg_pma_tx_ck_bitwidth_2_0;
134 u8 cfg_tx_prediv_1_0;
135 u8 cfg_rxdiv_sel_2_0;
136 u8 cfg_tx_subrate_2_0;
137 u8 cfg_rx_subrate_2_0;
138 u8 r_multi_lane_mode;
139 u8 cfg_cdrck_en;
140 u8 cfg_dfeck_en;
141 u8 cfg_dfe_pd;
142 u8 cfg_dfedmx_pd;
143 u8 cfg_dfetap_en_5_1;
144 u8 cfg_dmux_pd;
145 u8 cfg_dmux_clk_pd;
146 u8 cfg_erramp_pd;
147 u8 cfg_pi_dfe_en;
148 u8 cfg_pi_en;
149 u8 cfg_pd_ctle;
150 u8 cfg_summer_en;
151 u8 cfg_pmad_ck_pd;
152 u8 cfg_pd_clk;
153 u8 cfg_pd_cml;
154 u8 cfg_pd_driver;
155 u8 cfg_rx_reg_pu;
156 u8 cfg_pd_rms_det;
157 u8 cfg_dcdr_pd;
158 u8 cfg_ecdr_pd;
159 u8 cfg_pd_sq;
160 u8 cfg_itx_ipdriver_base_2_0;
161 u8 cfg_tap_dly_4_0;
162 u8 cfg_tap_main;
163 u8 cfg_en_main;
164 u8 cfg_tap_adv_3_0;
165 u8 cfg_en_adv;
166 u8 cfg_en_dly;
167 u8 cfg_iscan_en;
168 u8 l1_pcs_en_fast_iscan;
169 u8 l0_cfg_bw_1_0;
170 u8 l0_cfg_txcal_en;
171 u8 cfg_en_dummy;
172 u8 cfg_pll_reserve_3_0;
173 u8 l0_cfg_tx_reserve_15_8;
174 u8 l0_cfg_tx_reserve_7_0;
175 u8 cfg_tx_reserve_15_8;
176 u8 cfg_tx_reserve_7_0;
177 u8 cfg_bw_1_0;
178 u8 cfg_txcal_man_en;
179 u8 cfg_phase_man_4_0;
180 u8 cfg_quad_man_1_0;
181 u8 cfg_txcal_shift_code_5_0;
182 u8 cfg_txcal_valid_sel_3_0;
183 u8 cfg_txcal_en;
184 u8 cfg_cdr_kf_2_0;
185 u8 cfg_cdr_m_7_0;
186 u8 cfg_pi_bw_3_0;
187 u8 cfg_pi_steps_1_0;
188 u8 cfg_dis_2ndorder;
189 u8 cfg_ctle_rstn;
190 u8 r_dfe_rstn;
191 u8 cfg_alos_thr_2_0;
192 u8 cfg_itx_ipcml_base_1_0;
193 u8 cfg_rx_reserve_7_0;
194 u8 cfg_rx_reserve_15_8;
195 u8 cfg_rxterm_2_0;
196 u8 cfg_fom_selm;
197 u8 cfg_rx_sp_ctle_1_0;
198 u8 cfg_isel_ctle_1_0;
199 u8 cfg_vga_ctrl_byp_4_0;
200 u8 cfg_vga_byp;
201 u8 cfg_agc_adpt_byp;
202 u8 cfg_eqr_byp;
203 u8 cfg_eqr_force_3_0;
204 u8 cfg_eqc_force_3_0;
205 u8 cfg_sum_setcm_en;
206 u8 cfg_init_pos_iscan_6_0;
207 u8 cfg_init_pos_ipi_6_0;
208 u8 cfg_dfedig_m_2_0;
209 u8 cfg_en_dfedig;
210 u8 cfg_pi_DFE_en;
211 u8 cfg_tx2rx_lp_en;
212 u8 cfg_txlb_en;
213 u8 cfg_rx2tx_lp_en;
214 u8 cfg_rxlb_en;
215 u8 r_tx_pol_inv;
216 u8 r_rx_pol_inv;
217};
218
219struct sparx5_sd10g28_media_preset {
220 u8 cfg_en_adv;
221 u8 cfg_en_main;
222 u8 cfg_en_dly;
223 u8 cfg_tap_adv_3_0;
224 u8 cfg_tap_main;
225 u8 cfg_tap_dly_4_0;
226 u8 cfg_vga_ctrl_3_0;
227 u8 cfg_vga_cp_2_0;
228 u8 cfg_eq_res_3_0;
229 u8 cfg_eq_r_byp;
230 u8 cfg_eq_c_force_3_0;
231 u8 cfg_alos_thr_3_0;
232};
233
234struct sparx5_sd10g28_mode_preset {
235 u8 bwidth; /* interface width: 10/16/20/32/64 */
236 enum sparx5_10g28cmu_mode cmu_sel; /* Device/Mode serdes uses */
237 u8 rate; /* Rate of network interface */
238 u8 dfe_tap;
239 u8 dfe_enable;
240 u8 pi_bw_gen1;
241 u8 duty_cycle; /* Set output level to half/full */
242};
243
244struct sparx5_sd10g28_args {
245 bool skip_cmu_cfg:1; /* Enable/disable CMU cfg */
246 bool no_pwrcycle:1; /* Omit initial power-cycle */
247 bool txinvert:1; /* Enable inversion of output data */
248 bool rxinvert:1; /* Enable inversion of input data */
249 bool txmargin:1; /* Set output level to half/full */
250 u16 txswing; /* Set output level */
251 bool mute:1; /* Mute Output Buffer */
252 bool is_6g:1;
253 bool reg_rst:1;
254};
255
256struct sparx5_sd10g28_params {
257 u8 cmu_sel;
258 u8 is_6g;
259 u8 skip_cmu_cfg;
260 u8 cfg_lane_reserve_7_0;
261 u8 cfg_ssc_rtl_clk_sel;
262 u8 cfg_lane_reserve_15_8;
263 u8 cfg_txrate_1_0;
264 u8 cfg_rxrate_1_0;
265 u8 r_d_width_ctrl_2_0;
266 u8 cfg_pma_tx_ck_bitwidth_2_0;
267 u8 cfg_rxdiv_sel_2_0;
268 u8 r_pcs2pma_phymode_4_0;
269 u8 cfg_lane_id_2_0;
270 u8 cfg_cdrck_en;
271 u8 cfg_dfeck_en;
272 u8 cfg_dfe_pd;
273 u8 cfg_dfetap_en_5_1;
274 u8 cfg_erramp_pd;
275 u8 cfg_pi_DFE_en;
276 u8 cfg_pi_en;
277 u8 cfg_pd_ctle;
278 u8 cfg_summer_en;
279 u8 cfg_pd_rx_cktree;
280 u8 cfg_pd_clk;
281 u8 cfg_pd_cml;
282 u8 cfg_pd_driver;
283 u8 cfg_rx_reg_pu;
284 u8 cfg_d_cdr_pd;
285 u8 cfg_pd_sq;
286 u8 cfg_rxdet_en;
287 u8 cfg_rxdet_str;
288 u8 r_multi_lane_mode;
289 u8 cfg_en_adv;
290 u8 cfg_en_main;
291 u8 cfg_en_dly;
292 u8 cfg_tap_adv_3_0;
293 u8 cfg_tap_main;
294 u8 cfg_tap_dly_4_0;
295 u8 cfg_vga_ctrl_3_0;
296 u8 cfg_vga_cp_2_0;
297 u8 cfg_eq_res_3_0;
298 u8 cfg_eq_r_byp;
299 u8 cfg_eq_c_force_3_0;
300 u8 cfg_en_dfedig;
301 u8 cfg_sum_setcm_en;
302 u8 cfg_en_preemph;
303 u8 cfg_itx_ippreemp_base_1_0;
304 u8 cfg_itx_ipdriver_base_2_0;
305 u8 cfg_ibias_tune_reserve_5_0;
306 u8 cfg_txswing_half;
307 u8 cfg_dis_2nd_order;
308 u8 cfg_rx_ssc_lh;
309 u8 cfg_pi_floop_steps_1_0;
310 u8 cfg_pi_ext_dac_23_16;
311 u8 cfg_pi_ext_dac_15_8;
312 u8 cfg_iscan_ext_dac_7_0;
313 u8 cfg_cdr_kf_gen1_2_0;
314 u8 cfg_cdr_kf_gen2_2_0;
315 u8 cfg_cdr_kf_gen3_2_0;
316 u8 cfg_cdr_kf_gen4_2_0;
317 u8 r_cdr_m_gen1_7_0;
318 u8 cfg_pi_bw_gen1_3_0;
319 u8 cfg_pi_bw_gen2;
320 u8 cfg_pi_bw_gen3;
321 u8 cfg_pi_bw_gen4;
322 u8 cfg_pi_ext_dac_7_0;
323 u8 cfg_pi_steps;
324 u8 cfg_mp_max_3_0;
325 u8 cfg_rstn_dfedig;
326 u8 cfg_alos_thr_3_0;
327 u8 cfg_predrv_slewrate_1_0;
328 u8 cfg_itx_ipcml_base_1_0;
329 u8 cfg_ip_pre_base_1_0;
330 u8 r_cdr_m_gen2_7_0;
331 u8 r_cdr_m_gen3_7_0;
332 u8 r_cdr_m_gen4_7_0;
333 u8 r_en_auto_cdr_rstn;
334 u8 cfg_oscal_afe;
335 u8 cfg_pd_osdac_afe;
336 u8 cfg_resetb_oscal_afe[2];
337 u8 cfg_center_spreading;
338 u8 cfg_m_cnt_maxval_4_0;
339 u8 cfg_ncnt_maxval_7_0;
340 u8 cfg_ncnt_maxval_10_8;
341 u8 cfg_ssc_en;
342 u8 cfg_tx2rx_lp_en;
343 u8 cfg_txlb_en;
344 u8 cfg_rx2tx_lp_en;
345 u8 cfg_rxlb_en;
346 u8 r_tx_pol_inv;
347 u8 r_rx_pol_inv;
348 u8 fx_100;
349};
350
351static struct sparx5_sd25g28_media_preset media_presets_25g[] = {
352 { /* ETH_MEDIA_DEFAULT */
353 .cfg_en_adv = 0,
354 .cfg_en_main = 1,
355 .cfg_en_dly = 0,
356 .cfg_tap_adv_3_0 = 0,
357 .cfg_tap_main = 1,
358 .cfg_tap_dly_4_0 = 0,
359 .cfg_eq_c_force_3_0 = 0xf,
360 .cfg_vga_ctrl_byp_4_0 = 4,
361 .cfg_eq_r_force_3_0 = 12,
362 .cfg_alos_thr_2_0 = 7,
363 },
364 { /* ETH_MEDIA_SR */
365 .cfg_en_adv = 1,
366 .cfg_en_main = 1,
367 .cfg_en_dly = 1,
368 .cfg_tap_adv_3_0 = 0,
369 .cfg_tap_main = 1,
370 .cfg_tap_dly_4_0 = 0x10,
371 .cfg_eq_c_force_3_0 = 0xf,
372 .cfg_vga_ctrl_byp_4_0 = 8,
373 .cfg_eq_r_force_3_0 = 4,
374 .cfg_alos_thr_2_0 = 0,
375 },
376 { /* ETH_MEDIA_DAC */
377 .cfg_en_adv = 0,
378 .cfg_en_main = 1,
379 .cfg_en_dly = 0,
380 .cfg_tap_adv_3_0 = 0,
381 .cfg_tap_main = 1,
382 .cfg_tap_dly_4_0 = 0,
383 .cfg_eq_c_force_3_0 = 0xf,
384 .cfg_vga_ctrl_byp_4_0 = 8,
385 .cfg_eq_r_force_3_0 = 0xc,
386 .cfg_alos_thr_2_0 = 0,
387 },
388};
389
390static struct sparx5_sd25g28_mode_preset mode_presets_25g[] = {
391 { /* SPX5_SD25G28_MODE_PRESET_25000 */
392 .bitwidth = 40,
393 .tx_pre_div = 0,
394 .fifo_ck_div = 0,
395 .pre_divsel = 1,
396 .vco_div_mode = 0,
397 .sel_div = 15,
398 .ck_bitwidth = 3,
399 .subrate = 0,
400 .com_txcal_en = 0,
401 .com_tx_reserve_msb = (0x26 << 1),
402 .com_tx_reserve_lsb = 0xf0,
403 .cfg_itx_ipcml_base = 0,
404 .tx_reserve_msb = 0xcc,
405 .tx_reserve_lsb = 0xfe,
406 .bw = 3,
407 .rxterm = 0,
408 .dfe_enable = 1,
409 .dfe_tap = 0x1f,
410 .txmargin = 1,
411 .cfg_ctle_rstn = 1,
412 .r_dfe_rstn = 1,
413 .cfg_pi_bw_3_0 = 0,
414 .tx_tap_dly = 8,
415 .tx_tap_adv = 0xc,
416 },
417 { /* SPX5_SD25G28_MODE_PRESET_10000 */
418 .bitwidth = 64,
419 .tx_pre_div = 0,
420 .fifo_ck_div = 2,
421 .pre_divsel = 0,
422 .vco_div_mode = 1,
423 .sel_div = 9,
424 .ck_bitwidth = 0,
425 .subrate = 0,
426 .com_txcal_en = 1,
427 .com_tx_reserve_msb = (0x20 << 1),
428 .com_tx_reserve_lsb = 0x40,
429 .cfg_itx_ipcml_base = 0,
430 .tx_reserve_msb = 0x4c,
431 .tx_reserve_lsb = 0x44,
432 .bw = 3,
433 .cfg_pi_bw_3_0 = 0,
434 .rxterm = 3,
435 .dfe_enable = 1,
436 .dfe_tap = 0x1f,
437 .txmargin = 0,
438 .cfg_ctle_rstn = 1,
439 .r_dfe_rstn = 1,
440 .tx_tap_dly = 0,
441 .tx_tap_adv = 0,
442 },
443 { /* SPX5_SD25G28_MODE_PRESET_5000 */
444 .bitwidth = 64,
445 .tx_pre_div = 0,
446 .fifo_ck_div = 2,
447 .pre_divsel = 0,
448 .vco_div_mode = 2,
449 .sel_div = 9,
450 .ck_bitwidth = 0,
451 .subrate = 0,
452 .com_txcal_en = 1,
453 .com_tx_reserve_msb = (0x20 << 1),
454 .com_tx_reserve_lsb = 0,
455 .cfg_itx_ipcml_base = 0,
456 .tx_reserve_msb = 0xe,
457 .tx_reserve_lsb = 0x80,
458 .bw = 0,
459 .rxterm = 0,
460 .cfg_pi_bw_3_0 = 6,
461 .dfe_enable = 0,
462 .dfe_tap = 0,
463 .tx_tap_dly = 0,
464 .tx_tap_adv = 0,
465 },
466 { /* SPX5_SD25G28_MODE_PRESET_SD_2G5 */
467 .bitwidth = 10,
468 .tx_pre_div = 0,
469 .fifo_ck_div = 0,
470 .pre_divsel = 0,
471 .vco_div_mode = 1,
472 .sel_div = 6,
473 .ck_bitwidth = 3,
474 .subrate = 2,
475 .com_txcal_en = 1,
476 .com_tx_reserve_msb = (0x26 << 1),
477 .com_tx_reserve_lsb = (0xf << 4),
478 .cfg_itx_ipcml_base = 2,
479 .tx_reserve_msb = 0x8,
480 .tx_reserve_lsb = 0x8a,
481 .bw = 0,
482 .cfg_pi_bw_3_0 = 0,
483 .rxterm = (1 << 2),
484 .dfe_enable = 0,
485 .dfe_tap = 0,
486 .tx_tap_dly = 0,
487 .tx_tap_adv = 0,
488 },
489 { /* SPX5_SD25G28_MODE_PRESET_1000BASEX */
490 .bitwidth = 10,
491 .tx_pre_div = 0,
492 .fifo_ck_div = 1,
493 .pre_divsel = 0,
494 .vco_div_mode = 1,
495 .sel_div = 8,
496 .ck_bitwidth = 3,
497 .subrate = 3,
498 .com_txcal_en = 1,
499 .com_tx_reserve_msb = (0x26 << 1),
500 .com_tx_reserve_lsb = 0xf0,
501 .cfg_itx_ipcml_base = 0,
502 .tx_reserve_msb = 0x8,
503 .tx_reserve_lsb = 0xce,
504 .bw = 0,
505 .rxterm = 0,
506 .cfg_pi_bw_3_0 = 0,
507 .dfe_enable = 0,
508 .dfe_tap = 0,
509 .tx_tap_dly = 0,
510 .tx_tap_adv = 0,
511 },
512};
513
514static struct sparx5_sd10g28_media_preset media_presets_10g[] = {
515 { /* ETH_MEDIA_DEFAULT */
516 .cfg_en_adv = 0,
517 .cfg_en_main = 1,
518 .cfg_en_dly = 0,
519 .cfg_tap_adv_3_0 = 0,
520 .cfg_tap_main = 1,
521 .cfg_tap_dly_4_0 = 0,
522 .cfg_vga_ctrl_3_0 = 5,
523 .cfg_vga_cp_2_0 = 0,
524 .cfg_eq_res_3_0 = 0xa,
525 .cfg_eq_r_byp = 1,
526 .cfg_eq_c_force_3_0 = 0x8,
527 .cfg_alos_thr_3_0 = 0x3,
528 },
529 { /* ETH_MEDIA_SR */
530 .cfg_en_adv = 1,
531 .cfg_en_main = 1,
532 .cfg_en_dly = 1,
533 .cfg_tap_adv_3_0 = 0,
534 .cfg_tap_main = 1,
535 .cfg_tap_dly_4_0 = 0xc,
536 .cfg_vga_ctrl_3_0 = 0xa,
537 .cfg_vga_cp_2_0 = 0x4,
538 .cfg_eq_res_3_0 = 0xa,
539 .cfg_eq_r_byp = 1,
540 .cfg_eq_c_force_3_0 = 0xF,
541 .cfg_alos_thr_3_0 = 0x3,
542 },
543 { /* ETH_MEDIA_DAC */
544 .cfg_en_adv = 1,
545 .cfg_en_main = 1,
546 .cfg_en_dly = 1,
547 .cfg_tap_adv_3_0 = 12,
548 .cfg_tap_main = 1,
549 .cfg_tap_dly_4_0 = 8,
550 .cfg_vga_ctrl_3_0 = 0xa,
551 .cfg_vga_cp_2_0 = 4,
552 .cfg_eq_res_3_0 = 0xa,
553 .cfg_eq_r_byp = 1,
554 .cfg_eq_c_force_3_0 = 0xf,
555 .cfg_alos_thr_3_0 = 0x0,
556 }
557};
558
559static struct sparx5_sd10g28_mode_preset mode_presets_10g[] = {
560 { /* SPX5_SD10G28_MODE_PRESET_10000 */
561 .bwidth = 64,
562 .cmu_sel = SPX5_SD10G28_CMU_MAIN,
563 .rate = 0x0,
564 .dfe_enable = 1,
565 .dfe_tap = 0x1f,
566 .pi_bw_gen1 = 0x0,
567 .duty_cycle = 0x2,
568 },
569 { /* SPX5_SD10G28_MODE_PRESET_SFI_5000_6G */
570 .bwidth = 16,
571 .cmu_sel = SPX5_SD10G28_CMU_MAIN,
572 .rate = 0x1,
573 .dfe_enable = 0,
574 .dfe_tap = 0,
575 .pi_bw_gen1 = 0x5,
576 .duty_cycle = 0x0,
577 },
578 { /* SPX5_SD10G28_MODE_PRESET_SFI_5000_10G */
579 .bwidth = 64,
580 .cmu_sel = SPX5_SD10G28_CMU_MAIN,
581 .rate = 0x1,
582 .dfe_enable = 0,
583 .dfe_tap = 0,
584 .pi_bw_gen1 = 0x5,
585 .duty_cycle = 0x0,
586 },
587 { /* SPX5_SD10G28_MODE_PRESET_QSGMII */
588 .bwidth = 20,
589 .cmu_sel = SPX5_SD10G28_CMU_AUX1,
590 .rate = 0x1,
591 .dfe_enable = 0,
592 .dfe_tap = 0,
593 .pi_bw_gen1 = 0x5,
594 .duty_cycle = 0x0,
595 },
596 { /* SPX5_SD10G28_MODE_PRESET_SD_2G5 */
597 .bwidth = 10,
598 .cmu_sel = SPX5_SD10G28_CMU_AUX2,
599 .rate = 0x2,
600 .dfe_enable = 0,
601 .dfe_tap = 0,
602 .pi_bw_gen1 = 0x7,
603 .duty_cycle = 0x0,
604 },
605 { /* SPX5_SD10G28_MODE_PRESET_1000BASEX */
606 .bwidth = 10,
607 .cmu_sel = SPX5_SD10G28_CMU_AUX1,
608 .rate = 0x3,
609 .dfe_enable = 0,
610 .dfe_tap = 0,
611 .pi_bw_gen1 = 0x7,
612 .duty_cycle = 0x0,
613 },
614};
615
616/* map from SD25G28 interface width to configuration value */
617static u8 sd25g28_get_iw_setting(struct device *dev, const u8 interface_width)
618{
619 switch (interface_width) {
620 case 10: return 0;
621 case 16: return 1;
622 case 32: return 3;
623 case 40: return 4;
624 case 64: return 5;
625 default:
626 dev_err(dev, "%s: Illegal value %d for interface width\n",
627 __func__, interface_width);
628 }
629 return 0;
630}
631
632/* map from SD10G28 interface width to configuration value */
633static u8 sd10g28_get_iw_setting(struct device *dev, const u8 interface_width)
634{
635 switch (interface_width) {
636 case 10: return 0;
637 case 16: return 1;
638 case 20: return 2;
639 case 32: return 3;
640 case 40: return 4;
641 case 64: return 7;
642 default:
643 dev_err(dev, "%s: Illegal value %d for interface width\n", __func__,
644 interface_width);
645 return 0;
646 }
647}
648
649static int sparx5_sd10g25_get_mode_preset(struct sparx5_serdes_macro *macro,
650 struct sparx5_sd25g28_mode_preset *mode)
651{
652 switch (macro->serdesmode) {
653 case SPX5_SD_MODE_SFI:
654 if (macro->speed == SPEED_25000)
655 *mode = mode_presets_25g[SPX5_SD25G28_MODE_PRESET_25000];
656 else if (macro->speed == SPEED_10000)
657 *mode = mode_presets_25g[SPX5_SD25G28_MODE_PRESET_10000];
658 else if (macro->speed == SPEED_5000)
659 *mode = mode_presets_25g[SPX5_SD25G28_MODE_PRESET_5000];
660 break;
661 case SPX5_SD_MODE_2G5:
662 *mode = mode_presets_25g[SPX5_SD25G28_MODE_PRESET_SD_2G5];
663 break;
664 case SPX5_SD_MODE_1000BASEX:
665 *mode = mode_presets_25g[SPX5_SD25G28_MODE_PRESET_1000BASEX];
666 break;
667 case SPX5_SD_MODE_100FX:
668 /* Not supported */
669 return -EINVAL;
670 default:
671 *mode = mode_presets_25g[SPX5_SD25G28_MODE_PRESET_25000];
672 break;
673 }
674 return 0;
675}
676
677static int sparx5_sd10g28_get_mode_preset(struct sparx5_serdes_macro *macro,
678 struct sparx5_sd10g28_mode_preset *mode,
679 struct sparx5_sd10g28_args *args)
680{
681 switch (macro->serdesmode) {
682 case SPX5_SD_MODE_SFI:
683 if (macro->speed == SPEED_10000) {
684 *mode = mode_presets_10g[SPX5_SD10G28_MODE_PRESET_10000];
685 } else if (macro->speed == SPEED_5000) {
686 if (args->is_6g)
687 *mode = mode_presets_10g[SPX5_SD10G28_MODE_PRESET_SFI_5000_6G];
688 else
689 *mode = mode_presets_10g[SPX5_SD10G28_MODE_PRESET_SFI_5000_10G];
690 } else {
691 dev_err(macro->priv->dev, "%s: Illegal speed: %02u, sidx: %02u, mode (%u)",
692 __func__, macro->speed, macro->sidx,
693 macro->serdesmode);
694 return -EINVAL;
695 }
696 break;
697 case SPX5_SD_MODE_QSGMII:
698 *mode = mode_presets_10g[SPX5_SD10G28_MODE_PRESET_QSGMII];
699 break;
700 case SPX5_SD_MODE_2G5:
701 *mode = mode_presets_10g[SPX5_SD10G28_MODE_PRESET_SD_2G5];
702 break;
703 case SPX5_SD_MODE_100FX:
704 case SPX5_SD_MODE_1000BASEX:
705 *mode = mode_presets_10g[SPX5_SD10G28_MODE_PRESET_1000BASEX];
706 break;
707 default:
708 *mode = mode_presets_10g[SPX5_SD10G28_MODE_PRESET_10000];
709 break;
710 }
711 return 0;
712}
713
714static void sparx5_sd25g28_get_params(struct sparx5_serdes_macro *macro,
715 struct sparx5_sd25g28_media_preset *media,
716 struct sparx5_sd25g28_mode_preset *mode,
717 struct sparx5_sd25g28_args *args,
718 struct sparx5_sd25g28_params *params)
719{
720 u8 iw = sd25g28_get_iw_setting(macro->priv->dev, mode->bitwidth);
721 struct sparx5_sd25g28_params init = {
722 .r_d_width_ctrl_2_0 = iw,
723 .r_txfifo_ck_div_pmad_2_0 = mode->fifo_ck_div,
724 .r_rxfifo_ck_div_pmad_2_0 = mode->fifo_ck_div,
725 .cfg_vco_div_mode_1_0 = mode->vco_div_mode,
726 .cfg_pre_divsel_1_0 = mode->pre_divsel,
727 .cfg_sel_div_3_0 = mode->sel_div,
728 .cfg_vco_start_code_3_0 = 0,
729 .cfg_pma_tx_ck_bitwidth_2_0 = mode->ck_bitwidth,
730 .cfg_tx_prediv_1_0 = mode->tx_pre_div,
731 .cfg_rxdiv_sel_2_0 = mode->ck_bitwidth,
732 .cfg_tx_subrate_2_0 = mode->subrate,
733 .cfg_rx_subrate_2_0 = mode->subrate,
734 .r_multi_lane_mode = 0,
735 .cfg_cdrck_en = 1,
736 .cfg_dfeck_en = mode->dfe_enable,
737 .cfg_dfe_pd = mode->dfe_enable == 1 ? 0 : 1,
738 .cfg_dfedmx_pd = 1,
739 .cfg_dfetap_en_5_1 = mode->dfe_tap,
740 .cfg_dmux_pd = 0,
741 .cfg_dmux_clk_pd = 1,
742 .cfg_erramp_pd = mode->dfe_enable == 1 ? 0 : 1,
743 .cfg_pi_DFE_en = mode->dfe_enable,
744 .cfg_pi_en = 1,
745 .cfg_pd_ctle = 0,
746 .cfg_summer_en = 1,
747 .cfg_pmad_ck_pd = 0,
748 .cfg_pd_clk = 0,
749 .cfg_pd_cml = 0,
750 .cfg_pd_driver = 0,
751 .cfg_rx_reg_pu = 1,
752 .cfg_pd_rms_det = 1,
753 .cfg_dcdr_pd = 0,
754 .cfg_ecdr_pd = 1,
755 .cfg_pd_sq = 1,
756 .cfg_itx_ipdriver_base_2_0 = mode->txmargin,
757 .cfg_tap_dly_4_0 = media->cfg_tap_dly_4_0,
758 .cfg_tap_main = media->cfg_tap_main,
759 .cfg_en_main = media->cfg_en_main,
760 .cfg_tap_adv_3_0 = media->cfg_tap_adv_3_0,
761 .cfg_en_adv = media->cfg_en_adv,
762 .cfg_en_dly = media->cfg_en_dly,
763 .cfg_iscan_en = 0,
764 .l1_pcs_en_fast_iscan = 0,
765 .l0_cfg_bw_1_0 = 0,
766 .cfg_en_dummy = 0,
767 .cfg_pll_reserve_3_0 = args->com_pll_reserve,
768 .l0_cfg_txcal_en = mode->com_txcal_en,
769 .l0_cfg_tx_reserve_15_8 = mode->com_tx_reserve_msb,
770 .l0_cfg_tx_reserve_7_0 = mode->com_tx_reserve_lsb,
771 .cfg_tx_reserve_15_8 = mode->tx_reserve_msb,
772 .cfg_tx_reserve_7_0 = mode->tx_reserve_lsb,
773 .cfg_bw_1_0 = mode->bw,
774 .cfg_txcal_man_en = 1,
775 .cfg_phase_man_4_0 = 0,
776 .cfg_quad_man_1_0 = 0,
777 .cfg_txcal_shift_code_5_0 = 2,
778 .cfg_txcal_valid_sel_3_0 = 4,
779 .cfg_txcal_en = 0,
780 .cfg_cdr_kf_2_0 = 1,
781 .cfg_cdr_m_7_0 = 6,
782 .cfg_pi_bw_3_0 = mode->cfg_pi_bw_3_0,
783 .cfg_pi_steps_1_0 = 0,
784 .cfg_dis_2ndorder = 1,
785 .cfg_ctle_rstn = mode->cfg_ctle_rstn,
786 .r_dfe_rstn = mode->r_dfe_rstn,
787 .cfg_alos_thr_2_0 = media->cfg_alos_thr_2_0,
788 .cfg_itx_ipcml_base_1_0 = mode->cfg_itx_ipcml_base,
789 .cfg_rx_reserve_7_0 = 0xbf,
790 .cfg_rx_reserve_15_8 = 0x61,
791 .cfg_rxterm_2_0 = mode->rxterm,
792 .cfg_fom_selm = 0,
793 .cfg_rx_sp_ctle_1_0 = 0,
794 .cfg_isel_ctle_1_0 = 0,
795 .cfg_vga_ctrl_byp_4_0 = media->cfg_vga_ctrl_byp_4_0,
796 .cfg_vga_byp = 1,
797 .cfg_agc_adpt_byp = 1,
798 .cfg_eqr_byp = 1,
799 .cfg_eqr_force_3_0 = media->cfg_eq_r_force_3_0,
800 .cfg_eqc_force_3_0 = media->cfg_eq_c_force_3_0,
801 .cfg_sum_setcm_en = 1,
802 .cfg_pi_dfe_en = 1,
803 .cfg_init_pos_iscan_6_0 = 6,
804 .cfg_init_pos_ipi_6_0 = 9,
805 .cfg_dfedig_m_2_0 = 6,
806 .cfg_en_dfedig = mode->dfe_enable,
807 .r_d_width_ctrl_from_hwt = 0,
808 .r_reg_manual = 1,
809 .reg_rst = args->reg_rst,
810 .cfg_jc_byp = 1,
811 .cfg_common_reserve_7_0 = 1,
812 .cfg_pll_lol_set = 1,
813 .cfg_tx2rx_lp_en = 0,
814 .cfg_txlb_en = 0,
815 .cfg_rx2tx_lp_en = 0,
816 .cfg_rxlb_en = 0,
817 .r_tx_pol_inv = args->txinvert,
818 .r_rx_pol_inv = args->rxinvert,
819 };
820
821 *params = init;
822}
823
824static void sparx5_sd10g28_get_params(struct sparx5_serdes_macro *macro,
825 struct sparx5_sd10g28_media_preset *media,
826 struct sparx5_sd10g28_mode_preset *mode,
827 struct sparx5_sd10g28_args *args,
828 struct sparx5_sd10g28_params *params)
829{
830 u8 iw = sd10g28_get_iw_setting(macro->priv->dev, mode->bwidth);
831 struct sparx5_sd10g28_params init = {
832 .skip_cmu_cfg = args->skip_cmu_cfg,
833 .is_6g = args->is_6g,
834 .cmu_sel = mode->cmu_sel,
835 .cfg_lane_reserve_7_0 = (mode->cmu_sel % 2) << 6,
836 .cfg_ssc_rtl_clk_sel = (mode->cmu_sel / 2),
837 .cfg_lane_reserve_15_8 = mode->duty_cycle,
838 .cfg_txrate_1_0 = mode->rate,
839 .cfg_rxrate_1_0 = mode->rate,
840 .fx_100 = macro->serdesmode == SPX5_SD_MODE_100FX,
841 .r_d_width_ctrl_2_0 = iw,
842 .cfg_pma_tx_ck_bitwidth_2_0 = iw,
843 .cfg_rxdiv_sel_2_0 = iw,
844 .r_pcs2pma_phymode_4_0 = 0,
845 .cfg_lane_id_2_0 = 0,
846 .cfg_cdrck_en = 1,
847 .cfg_dfeck_en = mode->dfe_enable,
848 .cfg_dfe_pd = (mode->dfe_enable == 1) ? 0 : 1,
849 .cfg_dfetap_en_5_1 = mode->dfe_tap,
850 .cfg_erramp_pd = (mode->dfe_enable == 1) ? 0 : 1,
851 .cfg_pi_DFE_en = mode->dfe_enable,
852 .cfg_pi_en = 1,
853 .cfg_pd_ctle = 0,
854 .cfg_summer_en = 1,
855 .cfg_pd_rx_cktree = 0,
856 .cfg_pd_clk = 0,
857 .cfg_pd_cml = 0,
858 .cfg_pd_driver = 0,
859 .cfg_rx_reg_pu = 1,
860 .cfg_d_cdr_pd = 0,
861 .cfg_pd_sq = mode->dfe_enable,
862 .cfg_rxdet_en = 0,
863 .cfg_rxdet_str = 0,
864 .r_multi_lane_mode = 0,
865 .cfg_en_adv = media->cfg_en_adv,
866 .cfg_en_main = 1,
867 .cfg_en_dly = media->cfg_en_dly,
868 .cfg_tap_adv_3_0 = media->cfg_tap_adv_3_0,
869 .cfg_tap_main = media->cfg_tap_main,
870 .cfg_tap_dly_4_0 = media->cfg_tap_dly_4_0,
871 .cfg_vga_ctrl_3_0 = media->cfg_vga_ctrl_3_0,
872 .cfg_vga_cp_2_0 = media->cfg_vga_cp_2_0,
873 .cfg_eq_res_3_0 = media->cfg_eq_res_3_0,
874 .cfg_eq_r_byp = media->cfg_eq_r_byp,
875 .cfg_eq_c_force_3_0 = media->cfg_eq_c_force_3_0,
876 .cfg_en_dfedig = mode->dfe_enable,
877 .cfg_sum_setcm_en = 1,
878 .cfg_en_preemph = 0,
879 .cfg_itx_ippreemp_base_1_0 = 0,
880 .cfg_itx_ipdriver_base_2_0 = (args->txswing >> 6),
881 .cfg_ibias_tune_reserve_5_0 = (args->txswing & 63),
882 .cfg_txswing_half = (args->txmargin),
883 .cfg_dis_2nd_order = 0x1,
884 .cfg_rx_ssc_lh = 0x0,
885 .cfg_pi_floop_steps_1_0 = 0x0,
886 .cfg_pi_ext_dac_23_16 = (1 << 5),
887 .cfg_pi_ext_dac_15_8 = (0 << 6),
888 .cfg_iscan_ext_dac_7_0 = (1 << 7) + 9,
889 .cfg_cdr_kf_gen1_2_0 = 1,
890 .cfg_cdr_kf_gen2_2_0 = 1,
891 .cfg_cdr_kf_gen3_2_0 = 1,
892 .cfg_cdr_kf_gen4_2_0 = 1,
893 .r_cdr_m_gen1_7_0 = 4,
894 .cfg_pi_bw_gen1_3_0 = mode->pi_bw_gen1,
895 .cfg_pi_bw_gen2 = mode->pi_bw_gen1,
896 .cfg_pi_bw_gen3 = mode->pi_bw_gen1,
897 .cfg_pi_bw_gen4 = mode->pi_bw_gen1,
898 .cfg_pi_ext_dac_7_0 = 3,
899 .cfg_pi_steps = 0,
900 .cfg_mp_max_3_0 = 1,
901 .cfg_rstn_dfedig = mode->dfe_enable,
902 .cfg_alos_thr_3_0 = media->cfg_alos_thr_3_0,
903 .cfg_predrv_slewrate_1_0 = 3,
904 .cfg_itx_ipcml_base_1_0 = 0,
905 .cfg_ip_pre_base_1_0 = 0,
906 .r_cdr_m_gen2_7_0 = 2,
907 .r_cdr_m_gen3_7_0 = 2,
908 .r_cdr_m_gen4_7_0 = 2,
909 .r_en_auto_cdr_rstn = 0,
910 .cfg_oscal_afe = 1,
911 .cfg_pd_osdac_afe = 0,
912 .cfg_resetb_oscal_afe[0] = 0,
913 .cfg_resetb_oscal_afe[1] = 1,
914 .cfg_center_spreading = 0,
915 .cfg_m_cnt_maxval_4_0 = 15,
916 .cfg_ncnt_maxval_7_0 = 32,
917 .cfg_ncnt_maxval_10_8 = 6,
918 .cfg_ssc_en = 1,
919 .cfg_tx2rx_lp_en = 0,
920 .cfg_txlb_en = 0,
921 .cfg_rx2tx_lp_en = 0,
922 .cfg_rxlb_en = 0,
923 .r_tx_pol_inv = args->txinvert,
924 .r_rx_pol_inv = args->rxinvert,
925 };
926
927 *params = init;
928}
929
930static int sparx5_cmu_apply_cfg(struct sparx5_serdes_private *priv,
931 u32 cmu_idx,
932 void __iomem *cmu_tgt,
933 void __iomem *cmu_cfg_tgt,
934 u32 spd10g)
935{
936 void __iomem **regs = priv->regs;
937 struct device *dev = priv->dev;
938 int value;
939
940 cmu_tgt = sdx5_inst_get(priv, TARGET_SD_CMU, cmu_idx);
941 cmu_cfg_tgt = sdx5_inst_get(priv, TARGET_SD_CMU_CFG, cmu_idx);
942
943 if (cmu_idx == 1 || cmu_idx == 4 || cmu_idx == 7 ||
944 cmu_idx == 10 || cmu_idx == 13) {
945 spd10g = 0;
946 }
947
948 sdx5_inst_rmw(SD_CMU_CFG_SD_CMU_CFG_EXT_CFG_RST_SET(1),
949 SD_CMU_CFG_SD_CMU_CFG_EXT_CFG_RST,
950 cmu_cfg_tgt,
951 SD_CMU_CFG_SD_CMU_CFG(cmu_idx));
952
953 sdx5_inst_rmw(SD_CMU_CFG_SD_CMU_CFG_EXT_CFG_RST_SET(0),
954 SD_CMU_CFG_SD_CMU_CFG_EXT_CFG_RST,
955 cmu_cfg_tgt,
956 SD_CMU_CFG_SD_CMU_CFG(cmu_idx));
957
958 sdx5_inst_rmw(SD_CMU_CFG_SD_CMU_CFG_CMU_RST_SET(1),
959 SD_CMU_CFG_SD_CMU_CFG_CMU_RST,
960 cmu_cfg_tgt,
961 SD_CMU_CFG_SD_CMU_CFG(cmu_idx));
962
963 sdx5_inst_rmw(SD_CMU_CMU_45_R_DWIDTHCTRL_FROM_HWT_SET(0x1) |
964 SD_CMU_CMU_45_R_REFCK_SSC_EN_FROM_HWT_SET(0x1) |
965 SD_CMU_CMU_45_R_LINK_BUF_EN_FROM_HWT_SET(0x1) |
966 SD_CMU_CMU_45_R_BIAS_EN_FROM_HWT_SET(0x1) |
967 SD_CMU_CMU_45_R_EN_RATECHG_CTRL_SET(0x0),
968 SD_CMU_CMU_45_R_DWIDTHCTRL_FROM_HWT |
969 SD_CMU_CMU_45_R_REFCK_SSC_EN_FROM_HWT |
970 SD_CMU_CMU_45_R_LINK_BUF_EN_FROM_HWT |
971 SD_CMU_CMU_45_R_BIAS_EN_FROM_HWT |
972 SD_CMU_CMU_45_R_EN_RATECHG_CTRL,
973 cmu_tgt,
974 SD_CMU_CMU_45(cmu_idx));
975
976 sdx5_inst_rmw(SD_CMU_CMU_47_R_PCS2PMA_PHYMODE_4_0_SET(0),
977 SD_CMU_CMU_47_R_PCS2PMA_PHYMODE_4_0,
978 cmu_tgt,
979 SD_CMU_CMU_47(cmu_idx));
980
981 sdx5_inst_rmw(SD_CMU_CMU_1B_CFG_RESERVE_7_0_SET(0),
982 SD_CMU_CMU_1B_CFG_RESERVE_7_0,
983 cmu_tgt,
984 SD_CMU_CMU_1B(cmu_idx));
985
986 sdx5_inst_rmw(SD_CMU_CMU_0D_CFG_JC_BYP_SET(0x1),
987 SD_CMU_CMU_0D_CFG_JC_BYP,
988 cmu_tgt,
989 SD_CMU_CMU_0D(cmu_idx));
990
991 sdx5_inst_rmw(SD_CMU_CMU_1F_CFG_VTUNE_SEL_SET(1),
992 SD_CMU_CMU_1F_CFG_VTUNE_SEL,
993 cmu_tgt,
994 SD_CMU_CMU_1F(cmu_idx));
995
996 sdx5_inst_rmw(SD_CMU_CMU_00_CFG_PLL_TP_SEL_1_0_SET(3),
997 SD_CMU_CMU_00_CFG_PLL_TP_SEL_1_0,
998 cmu_tgt,
999 SD_CMU_CMU_00(cmu_idx));
1000
1001 sdx5_inst_rmw(SD_CMU_CMU_05_CFG_BIAS_TP_SEL_1_0_SET(3),
1002 SD_CMU_CMU_05_CFG_BIAS_TP_SEL_1_0,
1003 cmu_tgt,
1004 SD_CMU_CMU_05(cmu_idx));
1005
1006 sdx5_inst_rmw(SD_CMU_CMU_30_R_PLL_DLOL_EN_SET(1),
1007 SD_CMU_CMU_30_R_PLL_DLOL_EN,
1008 cmu_tgt,
1009 SD_CMU_CMU_30(cmu_idx));
1010
1011 sdx5_inst_rmw(SD_CMU_CMU_09_CFG_SW_10G_SET(spd10g),
1012 SD_CMU_CMU_09_CFG_SW_10G,
1013 cmu_tgt,
1014 SD_CMU_CMU_09(cmu_idx));
1015
1016 sdx5_inst_rmw(SD_CMU_CFG_SD_CMU_CFG_CMU_RST_SET(0),
1017 SD_CMU_CFG_SD_CMU_CFG_CMU_RST,
1018 cmu_cfg_tgt,
1019 SD_CMU_CFG_SD_CMU_CFG(cmu_idx));
1020
1021 msleep(20);
1022
1023 sdx5_inst_rmw(SD_CMU_CMU_44_R_PLL_RSTN_SET(0),
1024 SD_CMU_CMU_44_R_PLL_RSTN,
1025 cmu_tgt,
1026 SD_CMU_CMU_44(cmu_idx));
1027
1028 sdx5_inst_rmw(SD_CMU_CMU_44_R_PLL_RSTN_SET(1),
1029 SD_CMU_CMU_44_R_PLL_RSTN,
1030 cmu_tgt,
1031 SD_CMU_CMU_44(cmu_idx));
1032
1033 msleep(20);
1034
1035 value = readl(sdx5_addr(regs, SD_CMU_CMU_E0(cmu_idx)));
1036 value = SD_CMU_CMU_E0_PLL_LOL_UDL_GET(value);
1037
1038 if (value) {
1039 dev_err(dev, "CMU PLL Loss of Lock: 0x%x\n", value);
1040 return -EINVAL;
1041 }
1042 sdx5_inst_rmw(SD_CMU_CMU_0D_CFG_PMA_TX_CK_PD_SET(0),
1043 SD_CMU_CMU_0D_CFG_PMA_TX_CK_PD,
1044 cmu_tgt,
1045 SD_CMU_CMU_0D(cmu_idx));
1046 return 0;
1047}
1048
1049static int sparx5_cmu_cfg(struct sparx5_serdes_private *priv, u32 cmu_idx)
1050{
1051 void __iomem *cmu_tgt, *cmu_cfg_tgt;
1052 u32 spd10g = 1;
1053
1054 if (cmu_idx == 1 || cmu_idx == 4 || cmu_idx == 7 ||
1055 cmu_idx == 10 || cmu_idx == 13) {
1056 spd10g = 0;
1057 }
1058
1059 cmu_tgt = sdx5_inst_get(priv, TARGET_SD_CMU, cmu_idx);
1060 cmu_cfg_tgt = sdx5_inst_get(priv, TARGET_SD_CMU_CFG, cmu_idx);
1061
1062 return sparx5_cmu_apply_cfg(priv, cmu_idx, cmu_tgt, cmu_cfg_tgt, spd10g);
1063}
1064
1065/* Map of 6G/10G serdes mode and index to CMU index. */
1066static const int
1067sparx5_serdes_cmu_map[SPX5_SD10G28_CMU_MAX][SPX5_SERDES_6G10G_CNT] = {
1068 [SPX5_SD10G28_CMU_MAIN] = { 2, 2, 2, 2, 2,
1069 2, 2, 2, 5, 5,
1070 5, 5, 5, 5, 5,
1071 5, 8, 11, 11, 11,
1072 11, 11, 11, 11, 11 },
1073 [SPX5_SD10G28_CMU_AUX1] = { 0, 0, 3, 3, 3,
1074 3, 3, 3, 3, 3,
1075 6, 6, 6, 6, 6,
1076 6, 6, 9, 9, 12,
1077 12, 12, 12, 12, 12 },
1078 [SPX5_SD10G28_CMU_AUX2] = { 1, 1, 1, 1, 4,
1079 4, 4, 4, 4, 4,
1080 4, 4, 7, 7, 7,
1081 7, 7, 10, 10, 10,
1082 10, 13, 13, 13, 13 },
1083 [SPX5_SD10G28_CMU_NONE] = { 1, 1, 1, 1, 4,
1084 4, 4, 4, 4, 4,
1085 4, 4, 7, 7, 7,
1086 7, 7, 10, 10, 10,
1087 10, 13, 13, 13, 13 },
1088};
1089
1090/* Get the index of the CMU which provides the clock for the specified serdes
1091 * mode and index.
1092 */
1093static int sparx5_serdes_cmu_get(enum sparx5_10g28cmu_mode mode, int sd_index)
1094{
1095 return sparx5_serdes_cmu_map[mode][sd_index];
1096}
1097
1098static void sparx5_serdes_cmu_power_off(struct sparx5_serdes_private *priv)
1099{
1100 void __iomem *cmu_inst, *cmu_cfg_inst;
1101 int i;
1102
1103 /* Power down each CMU */
1104 for (i = 0; i < SPX5_CMU_MAX; i++) {
1105 cmu_inst = sdx5_inst_get(priv, TARGET_SD_CMU, i);
1106 cmu_cfg_inst = sdx5_inst_get(priv, TARGET_SD_CMU_CFG, i);
1107
1108 sdx5_inst_rmw(SD_CMU_CFG_SD_CMU_CFG_EXT_CFG_RST_SET(0),
1109 SD_CMU_CFG_SD_CMU_CFG_EXT_CFG_RST, cmu_cfg_inst,
1110 SD_CMU_CFG_SD_CMU_CFG(0));
1111
1112 sdx5_inst_rmw(SD_CMU_CMU_05_CFG_REFCK_TERM_EN_SET(0),
1113 SD_CMU_CMU_05_CFG_REFCK_TERM_EN, cmu_inst,
1114 SD_CMU_CMU_05(0));
1115
1116 sdx5_inst_rmw(SD_CMU_CMU_09_CFG_EN_TX_CK_DN_SET(0),
1117 SD_CMU_CMU_09_CFG_EN_TX_CK_DN, cmu_inst,
1118 SD_CMU_CMU_09(0));
1119
1120 sdx5_inst_rmw(SD_CMU_CMU_06_CFG_VCO_PD_SET(1),
1121 SD_CMU_CMU_06_CFG_VCO_PD, cmu_inst,
1122 SD_CMU_CMU_06(0));
1123
1124 sdx5_inst_rmw(SD_CMU_CMU_09_CFG_EN_TX_CK_UP_SET(0),
1125 SD_CMU_CMU_09_CFG_EN_TX_CK_UP, cmu_inst,
1126 SD_CMU_CMU_09(0));
1127
1128 sdx5_inst_rmw(SD_CMU_CMU_08_CFG_CK_TREE_PD_SET(1),
1129 SD_CMU_CMU_08_CFG_CK_TREE_PD, cmu_inst,
1130 SD_CMU_CMU_08(0));
1131
1132 sdx5_inst_rmw(SD_CMU_CMU_0D_CFG_REFCK_PD_SET(1) |
1133 SD_CMU_CMU_0D_CFG_PD_DIV64_SET(1) |
1134 SD_CMU_CMU_0D_CFG_PD_DIV66_SET(1),
1135 SD_CMU_CMU_0D_CFG_REFCK_PD |
1136 SD_CMU_CMU_0D_CFG_PD_DIV64 |
1137 SD_CMU_CMU_0D_CFG_PD_DIV66, cmu_inst,
1138 SD_CMU_CMU_0D(0));
1139
1140 sdx5_inst_rmw(SD_CMU_CMU_06_CFG_CTRL_LOGIC_PD_SET(1),
1141 SD_CMU_CMU_06_CFG_CTRL_LOGIC_PD, cmu_inst,
1142 SD_CMU_CMU_06(0));
1143 }
1144}
1145
1146static void sparx5_sd25g28_reset(void __iomem *regs[],
1147 struct sparx5_sd25g28_params *params,
1148 u32 sd_index)
1149{
1150 if (params->reg_rst == 1) {
1151 sdx5_rmw_addr(SD_LANE_25G_SD_LANE_CFG_EXT_CFG_RST_SET(1),
1152 SD_LANE_25G_SD_LANE_CFG_EXT_CFG_RST,
1153 sdx5_addr(regs, SD_LANE_25G_SD_LANE_CFG(sd_index)));
1154
1155 usleep_range(1000, 2000);
1156
1157 sdx5_rmw_addr(SD_LANE_25G_SD_LANE_CFG_EXT_CFG_RST_SET(0),
1158 SD_LANE_25G_SD_LANE_CFG_EXT_CFG_RST,
1159 sdx5_addr(regs, SD_LANE_25G_SD_LANE_CFG(sd_index)));
1160 }
1161}
1162
1163static int sparx5_sd25g28_apply_params(struct sparx5_serdes_macro *macro,
1164 struct sparx5_sd25g28_params *params)
1165{
1166 struct sparx5_serdes_private *priv = macro->priv;
1167 void __iomem **regs = priv->regs;
1168 struct device *dev = priv->dev;
1169 u32 sd_index = macro->stpidx;
1170 u32 value;
1171
1172 sdx5_rmw(SD_LANE_25G_SD_LANE_CFG_MACRO_RST_SET(1),
1173 SD_LANE_25G_SD_LANE_CFG_MACRO_RST,
1174 priv,
1175 SD_LANE_25G_SD_LANE_CFG(sd_index));
1176
1177 sdx5_rmw(SD25G_LANE_CMU_FF_REGISTER_TABLE_INDEX_SET(0xFF),
1178 SD25G_LANE_CMU_FF_REGISTER_TABLE_INDEX,
1179 priv,
1180 SD25G_LANE_CMU_FF(sd_index));
1181
1182 sdx5_rmw(SD25G_LANE_CMU_1A_R_DWIDTHCTRL_FROM_HWT_SET
1183 (params->r_d_width_ctrl_from_hwt) |
1184 SD25G_LANE_CMU_1A_R_REG_MANUAL_SET(params->r_reg_manual),
1185 SD25G_LANE_CMU_1A_R_DWIDTHCTRL_FROM_HWT |
1186 SD25G_LANE_CMU_1A_R_REG_MANUAL,
1187 priv,
1188 SD25G_LANE_CMU_1A(sd_index));
1189
1190 sdx5_rmw(SD25G_LANE_CMU_31_CFG_COMMON_RESERVE_7_0_SET
1191 (params->cfg_common_reserve_7_0),
1192 SD25G_LANE_CMU_31_CFG_COMMON_RESERVE_7_0,
1193 priv,
1194 SD25G_LANE_CMU_31(sd_index));
1195
1196 sdx5_rmw(SD25G_LANE_CMU_09_CFG_EN_DUMMY_SET(params->cfg_en_dummy),
1197 SD25G_LANE_CMU_09_CFG_EN_DUMMY,
1198 priv,
1199 SD25G_LANE_CMU_09(sd_index));
1200
1201 sdx5_rmw(SD25G_LANE_CMU_13_CFG_PLL_RESERVE_3_0_SET
1202 (params->cfg_pll_reserve_3_0),
1203 SD25G_LANE_CMU_13_CFG_PLL_RESERVE_3_0,
1204 priv,
1205 SD25G_LANE_CMU_13(sd_index));
1206
1207 sdx5_rmw(SD25G_LANE_CMU_40_L0_CFG_TXCAL_EN_SET(params->l0_cfg_txcal_en),
1208 SD25G_LANE_CMU_40_L0_CFG_TXCAL_EN,
1209 priv,
1210 SD25G_LANE_CMU_40(sd_index));
1211
1212 sdx5_rmw(SD25G_LANE_CMU_46_L0_CFG_TX_RESERVE_15_8_SET
1213 (params->l0_cfg_tx_reserve_15_8),
1214 SD25G_LANE_CMU_46_L0_CFG_TX_RESERVE_15_8,
1215 priv,
1216 SD25G_LANE_CMU_46(sd_index));
1217
1218 sdx5_rmw(SD25G_LANE_CMU_45_L0_CFG_TX_RESERVE_7_0_SET
1219 (params->l0_cfg_tx_reserve_7_0),
1220 SD25G_LANE_CMU_45_L0_CFG_TX_RESERVE_7_0,
1221 priv,
1222 SD25G_LANE_CMU_45(sd_index));
1223
1224 sdx5_rmw(SD25G_LANE_CMU_0B_CFG_VCO_CAL_RESETN_SET(0),
1225 SD25G_LANE_CMU_0B_CFG_VCO_CAL_RESETN,
1226 priv,
1227 SD25G_LANE_CMU_0B(sd_index));
1228
1229 sdx5_rmw(SD25G_LANE_CMU_0B_CFG_VCO_CAL_RESETN_SET(1),
1230 SD25G_LANE_CMU_0B_CFG_VCO_CAL_RESETN,
1231 priv,
1232 SD25G_LANE_CMU_0B(sd_index));
1233
1234 sdx5_rmw(SD25G_LANE_CMU_19_R_CK_RESETB_SET(0),
1235 SD25G_LANE_CMU_19_R_CK_RESETB,
1236 priv,
1237 SD25G_LANE_CMU_19(sd_index));
1238
1239 sdx5_rmw(SD25G_LANE_CMU_19_R_CK_RESETB_SET(1),
1240 SD25G_LANE_CMU_19_R_CK_RESETB,
1241 priv,
1242 SD25G_LANE_CMU_19(sd_index));
1243
1244 sdx5_rmw(SD25G_LANE_CMU_18_R_PLL_RSTN_SET(0),
1245 SD25G_LANE_CMU_18_R_PLL_RSTN,
1246 priv,
1247 SD25G_LANE_CMU_18(sd_index));
1248
1249 sdx5_rmw(SD25G_LANE_CMU_18_R_PLL_RSTN_SET(1),
1250 SD25G_LANE_CMU_18_R_PLL_RSTN,
1251 priv,
1252 SD25G_LANE_CMU_18(sd_index));
1253
1254 sdx5_rmw(SD25G_LANE_CMU_1A_R_DWIDTHCTRL_2_0_SET(params->r_d_width_ctrl_2_0),
1255 SD25G_LANE_CMU_1A_R_DWIDTHCTRL_2_0,
1256 priv,
1257 SD25G_LANE_CMU_1A(sd_index));
1258
1259 sdx5_rmw(SD25G_LANE_CMU_30_R_TXFIFO_CK_DIV_PMAD_2_0_SET
1260 (params->r_txfifo_ck_div_pmad_2_0) |
1261 SD25G_LANE_CMU_30_R_RXFIFO_CK_DIV_PMAD_2_0_SET
1262 (params->r_rxfifo_ck_div_pmad_2_0),
1263 SD25G_LANE_CMU_30_R_TXFIFO_CK_DIV_PMAD_2_0 |
1264 SD25G_LANE_CMU_30_R_RXFIFO_CK_DIV_PMAD_2_0,
1265 priv,
1266 SD25G_LANE_CMU_30(sd_index));
1267
1268 sdx5_rmw(SD25G_LANE_CMU_0C_CFG_PLL_LOL_SET_SET(params->cfg_pll_lol_set) |
1269 SD25G_LANE_CMU_0C_CFG_VCO_DIV_MODE_1_0_SET
1270 (params->cfg_vco_div_mode_1_0),
1271 SD25G_LANE_CMU_0C_CFG_PLL_LOL_SET |
1272 SD25G_LANE_CMU_0C_CFG_VCO_DIV_MODE_1_0,
1273 priv,
1274 SD25G_LANE_CMU_0C(sd_index));
1275
1276 sdx5_rmw(SD25G_LANE_CMU_0D_CFG_PRE_DIVSEL_1_0_SET
1277 (params->cfg_pre_divsel_1_0),
1278 SD25G_LANE_CMU_0D_CFG_PRE_DIVSEL_1_0,
1279 priv,
1280 SD25G_LANE_CMU_0D(sd_index));
1281
1282 sdx5_rmw(SD25G_LANE_CMU_0E_CFG_SEL_DIV_3_0_SET(params->cfg_sel_div_3_0),
1283 SD25G_LANE_CMU_0E_CFG_SEL_DIV_3_0,
1284 priv,
1285 SD25G_LANE_CMU_0E(sd_index));
1286
1287 sdx5_rmw(SD25G_LANE_CMU_FF_REGISTER_TABLE_INDEX_SET(0x00),
1288 SD25G_LANE_CMU_FF_REGISTER_TABLE_INDEX,
1289 priv,
1290 SD25G_LANE_CMU_FF(sd_index));
1291
1292 sdx5_rmw(SD25G_LANE_LANE_0C_LN_CFG_PMA_TX_CK_BITWIDTH_2_0_SET
1293 (params->cfg_pma_tx_ck_bitwidth_2_0),
1294 SD25G_LANE_LANE_0C_LN_CFG_PMA_TX_CK_BITWIDTH_2_0,
1295 priv,
1296 SD25G_LANE_LANE_0C(sd_index));
1297
1298 sdx5_rmw(SD25G_LANE_LANE_01_LN_CFG_TX_PREDIV_1_0_SET
1299 (params->cfg_tx_prediv_1_0),
1300 SD25G_LANE_LANE_01_LN_CFG_TX_PREDIV_1_0,
1301 priv,
1302 SD25G_LANE_LANE_01(sd_index));
1303
1304 sdx5_rmw(SD25G_LANE_LANE_18_LN_CFG_RXDIV_SEL_2_0_SET
1305 (params->cfg_rxdiv_sel_2_0),
1306 SD25G_LANE_LANE_18_LN_CFG_RXDIV_SEL_2_0,
1307 priv,
1308 SD25G_LANE_LANE_18(sd_index));
1309
1310 sdx5_rmw(SD25G_LANE_LANE_2C_LN_CFG_TX_SUBRATE_2_0_SET
1311 (params->cfg_tx_subrate_2_0),
1312 SD25G_LANE_LANE_2C_LN_CFG_TX_SUBRATE_2_0,
1313 priv,
1314 SD25G_LANE_LANE_2C(sd_index));
1315
1316 sdx5_rmw(SD25G_LANE_LANE_28_LN_CFG_RX_SUBRATE_2_0_SET
1317 (params->cfg_rx_subrate_2_0),
1318 SD25G_LANE_LANE_28_LN_CFG_RX_SUBRATE_2_0,
1319 priv,
1320 SD25G_LANE_LANE_28(sd_index));
1321
1322 sdx5_rmw(SD25G_LANE_LANE_18_LN_CFG_CDRCK_EN_SET(params->cfg_cdrck_en),
1323 SD25G_LANE_LANE_18_LN_CFG_CDRCK_EN,
1324 priv,
1325 SD25G_LANE_LANE_18(sd_index));
1326
1327 sdx5_rmw(SD25G_LANE_LANE_0F_LN_CFG_DFETAP_EN_5_1_SET
1328 (params->cfg_dfetap_en_5_1),
1329 SD25G_LANE_LANE_0F_LN_CFG_DFETAP_EN_5_1,
1330 priv,
1331 SD25G_LANE_LANE_0F(sd_index));
1332
1333 sdx5_rmw(SD25G_LANE_LANE_18_LN_CFG_ERRAMP_PD_SET(params->cfg_erramp_pd),
1334 SD25G_LANE_LANE_18_LN_CFG_ERRAMP_PD,
1335 priv,
1336 SD25G_LANE_LANE_18(sd_index));
1337
1338 sdx5_rmw(SD25G_LANE_LANE_1D_LN_CFG_PI_DFE_EN_SET(params->cfg_pi_dfe_en),
1339 SD25G_LANE_LANE_1D_LN_CFG_PI_DFE_EN,
1340 priv,
1341 SD25G_LANE_LANE_1D(sd_index));
1342
1343 sdx5_rmw(SD25G_LANE_LANE_19_LN_CFG_ECDR_PD_SET(params->cfg_ecdr_pd),
1344 SD25G_LANE_LANE_19_LN_CFG_ECDR_PD,
1345 priv,
1346 SD25G_LANE_LANE_19(sd_index));
1347
1348 sdx5_rmw(SD25G_LANE_LANE_01_LN_CFG_ITX_IPDRIVER_BASE_2_0_SET
1349 (params->cfg_itx_ipdriver_base_2_0),
1350 SD25G_LANE_LANE_01_LN_CFG_ITX_IPDRIVER_BASE_2_0,
1351 priv,
1352 SD25G_LANE_LANE_01(sd_index));
1353
1354 sdx5_rmw(SD25G_LANE_LANE_03_LN_CFG_TAP_DLY_4_0_SET(params->cfg_tap_dly_4_0),
1355 SD25G_LANE_LANE_03_LN_CFG_TAP_DLY_4_0,
1356 priv,
1357 SD25G_LANE_LANE_03(sd_index));
1358
1359 sdx5_rmw(SD25G_LANE_LANE_06_LN_CFG_TAP_ADV_3_0_SET(params->cfg_tap_adv_3_0),
1360 SD25G_LANE_LANE_06_LN_CFG_TAP_ADV_3_0,
1361 priv,
1362 SD25G_LANE_LANE_06(sd_index));
1363
1364 sdx5_rmw(SD25G_LANE_LANE_07_LN_CFG_EN_ADV_SET(params->cfg_en_adv) |
1365 SD25G_LANE_LANE_07_LN_CFG_EN_DLY_SET(params->cfg_en_dly),
1366 SD25G_LANE_LANE_07_LN_CFG_EN_ADV |
1367 SD25G_LANE_LANE_07_LN_CFG_EN_DLY,
1368 priv,
1369 SD25G_LANE_LANE_07(sd_index));
1370
1371 sdx5_rmw(SD25G_LANE_LANE_43_LN_CFG_TX_RESERVE_15_8_SET
1372 (params->cfg_tx_reserve_15_8),
1373 SD25G_LANE_LANE_43_LN_CFG_TX_RESERVE_15_8,
1374 priv,
1375 SD25G_LANE_LANE_43(sd_index));
1376
1377 sdx5_rmw(SD25G_LANE_LANE_42_LN_CFG_TX_RESERVE_7_0_SET
1378 (params->cfg_tx_reserve_7_0),
1379 SD25G_LANE_LANE_42_LN_CFG_TX_RESERVE_7_0,
1380 priv,
1381 SD25G_LANE_LANE_42(sd_index));
1382
1383 sdx5_rmw(SD25G_LANE_LANE_05_LN_CFG_BW_1_0_SET(params->cfg_bw_1_0),
1384 SD25G_LANE_LANE_05_LN_CFG_BW_1_0,
1385 priv,
1386 SD25G_LANE_LANE_05(sd_index));
1387
1388 sdx5_rmw(SD25G_LANE_LANE_0B_LN_CFG_TXCAL_MAN_EN_SET
1389 (params->cfg_txcal_man_en),
1390 SD25G_LANE_LANE_0B_LN_CFG_TXCAL_MAN_EN,
1391 priv,
1392 SD25G_LANE_LANE_0B(sd_index));
1393
1394 sdx5_rmw(SD25G_LANE_LANE_0A_LN_CFG_TXCAL_SHIFT_CODE_5_0_SET
1395 (params->cfg_txcal_shift_code_5_0),
1396 SD25G_LANE_LANE_0A_LN_CFG_TXCAL_SHIFT_CODE_5_0,
1397 priv,
1398 SD25G_LANE_LANE_0A(sd_index));
1399
1400 sdx5_rmw(SD25G_LANE_LANE_09_LN_CFG_TXCAL_VALID_SEL_3_0_SET
1401 (params->cfg_txcal_valid_sel_3_0),
1402 SD25G_LANE_LANE_09_LN_CFG_TXCAL_VALID_SEL_3_0,
1403 priv,
1404 SD25G_LANE_LANE_09(sd_index));
1405
1406 sdx5_rmw(SD25G_LANE_LANE_1A_LN_CFG_CDR_KF_2_0_SET(params->cfg_cdr_kf_2_0),
1407 SD25G_LANE_LANE_1A_LN_CFG_CDR_KF_2_0,
1408 priv,
1409 SD25G_LANE_LANE_1A(sd_index));
1410
1411 sdx5_rmw(SD25G_LANE_LANE_1B_LN_CFG_CDR_M_7_0_SET(params->cfg_cdr_m_7_0),
1412 SD25G_LANE_LANE_1B_LN_CFG_CDR_M_7_0,
1413 priv,
1414 SD25G_LANE_LANE_1B(sd_index));
1415
1416 sdx5_rmw(SD25G_LANE_LANE_2B_LN_CFG_PI_BW_3_0_SET(params->cfg_pi_bw_3_0),
1417 SD25G_LANE_LANE_2B_LN_CFG_PI_BW_3_0,
1418 priv,
1419 SD25G_LANE_LANE_2B(sd_index));
1420
1421 sdx5_rmw(SD25G_LANE_LANE_2C_LN_CFG_DIS_2NDORDER_SET
1422 (params->cfg_dis_2ndorder),
1423 SD25G_LANE_LANE_2C_LN_CFG_DIS_2NDORDER,
1424 priv,
1425 SD25G_LANE_LANE_2C(sd_index));
1426
1427 sdx5_rmw(SD25G_LANE_LANE_2E_LN_CFG_CTLE_RSTN_SET(params->cfg_ctle_rstn),
1428 SD25G_LANE_LANE_2E_LN_CFG_CTLE_RSTN,
1429 priv,
1430 SD25G_LANE_LANE_2E(sd_index));
1431
1432 sdx5_rmw(SD25G_LANE_LANE_00_LN_CFG_ITX_IPCML_BASE_1_0_SET
1433 (params->cfg_itx_ipcml_base_1_0),
1434 SD25G_LANE_LANE_00_LN_CFG_ITX_IPCML_BASE_1_0,
1435 priv,
1436 SD25G_LANE_LANE_00(sd_index));
1437
1438 sdx5_rmw(SD25G_LANE_LANE_44_LN_CFG_RX_RESERVE_7_0_SET
1439 (params->cfg_rx_reserve_7_0),
1440 SD25G_LANE_LANE_44_LN_CFG_RX_RESERVE_7_0,
1441 priv,
1442 SD25G_LANE_LANE_44(sd_index));
1443
1444 sdx5_rmw(SD25G_LANE_LANE_45_LN_CFG_RX_RESERVE_15_8_SET
1445 (params->cfg_rx_reserve_15_8),
1446 SD25G_LANE_LANE_45_LN_CFG_RX_RESERVE_15_8,
1447 priv,
1448 SD25G_LANE_LANE_45(sd_index));
1449
1450 sdx5_rmw(SD25G_LANE_LANE_0D_LN_CFG_DFECK_EN_SET(params->cfg_dfeck_en) |
1451 SD25G_LANE_LANE_0D_LN_CFG_RXTERM_2_0_SET(params->cfg_rxterm_2_0),
1452 SD25G_LANE_LANE_0D_LN_CFG_DFECK_EN |
1453 SD25G_LANE_LANE_0D_LN_CFG_RXTERM_2_0,
1454 priv,
1455 SD25G_LANE_LANE_0D(sd_index));
1456
1457 sdx5_rmw(SD25G_LANE_LANE_21_LN_CFG_VGA_CTRL_BYP_4_0_SET
1458 (params->cfg_vga_ctrl_byp_4_0),
1459 SD25G_LANE_LANE_21_LN_CFG_VGA_CTRL_BYP_4_0,
1460 priv,
1461 SD25G_LANE_LANE_21(sd_index));
1462
1463 sdx5_rmw(SD25G_LANE_LANE_22_LN_CFG_EQR_FORCE_3_0_SET
1464 (params->cfg_eqr_force_3_0),
1465 SD25G_LANE_LANE_22_LN_CFG_EQR_FORCE_3_0,
1466 priv,
1467 SD25G_LANE_LANE_22(sd_index));
1468
1469 sdx5_rmw(SD25G_LANE_LANE_1C_LN_CFG_EQC_FORCE_3_0_SET
1470 (params->cfg_eqc_force_3_0) |
1471 SD25G_LANE_LANE_1C_LN_CFG_DFE_PD_SET(params->cfg_dfe_pd),
1472 SD25G_LANE_LANE_1C_LN_CFG_EQC_FORCE_3_0 |
1473 SD25G_LANE_LANE_1C_LN_CFG_DFE_PD,
1474 priv,
1475 SD25G_LANE_LANE_1C(sd_index));
1476
1477 sdx5_rmw(SD25G_LANE_LANE_1E_LN_CFG_SUM_SETCM_EN_SET
1478 (params->cfg_sum_setcm_en),
1479 SD25G_LANE_LANE_1E_LN_CFG_SUM_SETCM_EN,
1480 priv,
1481 SD25G_LANE_LANE_1E(sd_index));
1482
1483 sdx5_rmw(SD25G_LANE_LANE_25_LN_CFG_INIT_POS_ISCAN_6_0_SET
1484 (params->cfg_init_pos_iscan_6_0),
1485 SD25G_LANE_LANE_25_LN_CFG_INIT_POS_ISCAN_6_0,
1486 priv,
1487 SD25G_LANE_LANE_25(sd_index));
1488
1489 sdx5_rmw(SD25G_LANE_LANE_26_LN_CFG_INIT_POS_IPI_6_0_SET
1490 (params->cfg_init_pos_ipi_6_0),
1491 SD25G_LANE_LANE_26_LN_CFG_INIT_POS_IPI_6_0,
1492 priv,
1493 SD25G_LANE_LANE_26(sd_index));
1494
1495 sdx5_rmw(SD25G_LANE_LANE_18_LN_CFG_ERRAMP_PD_SET(params->cfg_erramp_pd),
1496 SD25G_LANE_LANE_18_LN_CFG_ERRAMP_PD,
1497 priv,
1498 SD25G_LANE_LANE_18(sd_index));
1499
1500 sdx5_rmw(SD25G_LANE_LANE_0E_LN_CFG_DFEDIG_M_2_0_SET
1501 (params->cfg_dfedig_m_2_0),
1502 SD25G_LANE_LANE_0E_LN_CFG_DFEDIG_M_2_0,
1503 priv,
1504 SD25G_LANE_LANE_0E(sd_index));
1505
1506 sdx5_rmw(SD25G_LANE_LANE_0E_LN_CFG_EN_DFEDIG_SET(params->cfg_en_dfedig),
1507 SD25G_LANE_LANE_0E_LN_CFG_EN_DFEDIG,
1508 priv,
1509 SD25G_LANE_LANE_0E(sd_index));
1510
1511 sdx5_rmw(SD25G_LANE_LANE_40_LN_R_TX_POL_INV_SET(params->r_tx_pol_inv) |
1512 SD25G_LANE_LANE_40_LN_R_RX_POL_INV_SET(params->r_rx_pol_inv),
1513 SD25G_LANE_LANE_40_LN_R_TX_POL_INV |
1514 SD25G_LANE_LANE_40_LN_R_RX_POL_INV,
1515 priv,
1516 SD25G_LANE_LANE_40(sd_index));
1517
1518 sdx5_rmw(SD25G_LANE_LANE_04_LN_CFG_RX2TX_LP_EN_SET(params->cfg_rx2tx_lp_en) |
1519 SD25G_LANE_LANE_04_LN_CFG_TX2RX_LP_EN_SET(params->cfg_tx2rx_lp_en),
1520 SD25G_LANE_LANE_04_LN_CFG_RX2TX_LP_EN |
1521 SD25G_LANE_LANE_04_LN_CFG_TX2RX_LP_EN,
1522 priv,
1523 SD25G_LANE_LANE_04(sd_index));
1524
1525 sdx5_rmw(SD25G_LANE_LANE_1E_LN_CFG_RXLB_EN_SET(params->cfg_rxlb_en),
1526 SD25G_LANE_LANE_1E_LN_CFG_RXLB_EN,
1527 priv,
1528 SD25G_LANE_LANE_1E(sd_index));
1529
1530 sdx5_rmw(SD25G_LANE_LANE_19_LN_CFG_TXLB_EN_SET(params->cfg_txlb_en),
1531 SD25G_LANE_LANE_19_LN_CFG_TXLB_EN,
1532 priv,
1533 SD25G_LANE_LANE_19(sd_index));
1534
1535 sdx5_rmw(SD25G_LANE_LANE_2E_LN_CFG_RSTN_DFEDIG_SET(0),
1536 SD25G_LANE_LANE_2E_LN_CFG_RSTN_DFEDIG,
1537 priv,
1538 SD25G_LANE_LANE_2E(sd_index));
1539
1540 sdx5_rmw(SD25G_LANE_LANE_2E_LN_CFG_RSTN_DFEDIG_SET(1),
1541 SD25G_LANE_LANE_2E_LN_CFG_RSTN_DFEDIG,
1542 priv,
1543 SD25G_LANE_LANE_2E(sd_index));
1544
1545 sdx5_rmw(SD_LANE_25G_SD_LANE_CFG_MACRO_RST_SET(0),
1546 SD_LANE_25G_SD_LANE_CFG_MACRO_RST,
1547 priv,
1548 SD_LANE_25G_SD_LANE_CFG(sd_index));
1549
1550 sdx5_rmw(SD25G_LANE_LANE_1C_LN_CFG_CDR_RSTN_SET(0),
1551 SD25G_LANE_LANE_1C_LN_CFG_CDR_RSTN,
1552 priv,
1553 SD25G_LANE_LANE_1C(sd_index));
1554
1555 usleep_range(1000, 2000);
1556
1557 sdx5_rmw(SD25G_LANE_LANE_1C_LN_CFG_CDR_RSTN_SET(1),
1558 SD25G_LANE_LANE_1C_LN_CFG_CDR_RSTN,
1559 priv,
1560 SD25G_LANE_LANE_1C(sd_index));
1561
1562 usleep_range(10000, 20000);
1563
1564 sdx5_rmw(SD25G_LANE_CMU_FF_REGISTER_TABLE_INDEX_SET(0xff),
1565 SD25G_LANE_CMU_FF_REGISTER_TABLE_INDEX,
1566 priv,
1567 SD25G_LANE_CMU_FF(sd_index));
1568
1569 value = readl(sdx5_addr(regs, SD25G_LANE_CMU_C0(sd_index)));
1570 value = SD25G_LANE_CMU_C0_PLL_LOL_UDL_GET(value);
1571
1572 if (value) {
1573 dev_err(dev, "25G PLL Loss of Lock: 0x%x\n", value);
1574 return -EINVAL;
1575 }
1576
1577 value = readl(sdx5_addr(regs, SD_LANE_25G_SD_LANE_STAT(sd_index)));
1578 value = SD_LANE_25G_SD_LANE_STAT_PMA_RST_DONE_GET(value);
1579
1580 if (value != 0x1) {
1581 dev_err(dev, "25G PMA Reset failed: 0x%x\n", value);
1582 return -EINVAL;
1583 }
1584 sdx5_rmw(SD25G_LANE_CMU_2A_R_DBG_LOL_STATUS_SET(0x1),
1585 SD25G_LANE_CMU_2A_R_DBG_LOL_STATUS,
1586 priv,
1587 SD25G_LANE_CMU_2A(sd_index));
1588
1589 sdx5_rmw(SD_LANE_25G_SD_SER_RST_SER_RST_SET(0x0),
1590 SD_LANE_25G_SD_SER_RST_SER_RST,
1591 priv,
1592 SD_LANE_25G_SD_SER_RST(sd_index));
1593
1594 sdx5_rmw(SD_LANE_25G_SD_DES_RST_DES_RST_SET(0x0),
1595 SD_LANE_25G_SD_DES_RST_DES_RST,
1596 priv,
1597 SD_LANE_25G_SD_DES_RST(sd_index));
1598
1599 sdx5_rmw(SD25G_LANE_CMU_FF_REGISTER_TABLE_INDEX_SET(0),
1600 SD25G_LANE_CMU_FF_REGISTER_TABLE_INDEX,
1601 priv,
1602 SD25G_LANE_CMU_FF(sd_index));
1603
1604 sdx5_rmw(SD25G_LANE_LANE_2D_LN_CFG_ALOS_THR_2_0_SET
1605 (params->cfg_alos_thr_2_0),
1606 SD25G_LANE_LANE_2D_LN_CFG_ALOS_THR_2_0,
1607 priv,
1608 SD25G_LANE_LANE_2D(sd_index));
1609
1610 sdx5_rmw(SD25G_LANE_LANE_2E_LN_CFG_DIS_SQ_SET(0),
1611 SD25G_LANE_LANE_2E_LN_CFG_DIS_SQ,
1612 priv,
1613 SD25G_LANE_LANE_2E(sd_index));
1614
1615 sdx5_rmw(SD25G_LANE_LANE_2E_LN_CFG_PD_SQ_SET(0),
1616 SD25G_LANE_LANE_2E_LN_CFG_PD_SQ,
1617 priv,
1618 SD25G_LANE_LANE_2E(sd_index));
1619
1620 return 0;
1621}
1622
1623static void sparx5_sd10g28_reset(void __iomem *regs[], u32 lane_index)
1624{
1625 /* Note: SerDes SD10G_LANE_1 is configured in 10G_LAN mode */
1626 sdx5_rmw_addr(SD_LANE_SD_LANE_CFG_EXT_CFG_RST_SET(1),
1627 SD_LANE_SD_LANE_CFG_EXT_CFG_RST,
1628 sdx5_addr(regs, SD_LANE_SD_LANE_CFG(lane_index)));
1629
1630 usleep_range(1000, 2000);
1631
1632 sdx5_rmw_addr(SD_LANE_SD_LANE_CFG_EXT_CFG_RST_SET(0),
1633 SD_LANE_SD_LANE_CFG_EXT_CFG_RST,
1634 sdx5_addr(regs, SD_LANE_SD_LANE_CFG(lane_index)));
1635}
1636
1637static int sparx5_sd10g28_apply_params(struct sparx5_serdes_macro *macro,
1638 struct sparx5_sd10g28_params *params)
1639{
1640 struct sparx5_serdes_private *priv = macro->priv;
1641 void __iomem **regs = priv->regs;
1642 struct device *dev = priv->dev;
1643 u32 lane_index = macro->sidx;
1644 u32 sd_index = macro->stpidx;
1645 void __iomem *sd_inst;
1646 u32 value, cmu_idx;
1647 int err;
1648
1649 /* Do not configure serdes if CMU is not to be configured too */
1650 if (params->skip_cmu_cfg)
1651 return 0;
1652
1653 cmu_idx = sparx5_serdes_cmu_get(params->cmu_sel, lane_index);
1654 err = sparx5_cmu_cfg(priv, cmu_idx);
1655 if (err)
1656 return err;
1657
1658 if (params->is_6g)
1659 sd_inst = sdx5_inst_get(priv, TARGET_SD6G_LANE, sd_index);
1660 else
1661 sd_inst = sdx5_inst_get(priv, TARGET_SD10G_LANE, sd_index);
1662
1663 sdx5_rmw(SD_LANE_SD_LANE_CFG_MACRO_RST_SET(1),
1664 SD_LANE_SD_LANE_CFG_MACRO_RST,
1665 priv,
1666 SD_LANE_SD_LANE_CFG(lane_index));
1667
1668 sdx5_inst_rmw(SD10G_LANE_LANE_93_R_DWIDTHCTRL_FROM_HWT_SET(0x0) |
1669 SD10G_LANE_LANE_93_R_REG_MANUAL_SET(0x1) |
1670 SD10G_LANE_LANE_93_R_AUXCKSEL_FROM_HWT_SET(0x1) |
1671 SD10G_LANE_LANE_93_R_LANE_ID_FROM_HWT_SET(0x1) |
1672 SD10G_LANE_LANE_93_R_EN_RATECHG_CTRL_SET(0x0),
1673 SD10G_LANE_LANE_93_R_DWIDTHCTRL_FROM_HWT |
1674 SD10G_LANE_LANE_93_R_REG_MANUAL |
1675 SD10G_LANE_LANE_93_R_AUXCKSEL_FROM_HWT |
1676 SD10G_LANE_LANE_93_R_LANE_ID_FROM_HWT |
1677 SD10G_LANE_LANE_93_R_EN_RATECHG_CTRL,
1678 sd_inst,
1679 SD10G_LANE_LANE_93(sd_index));
1680
1681 sdx5_inst_rmw(SD10G_LANE_LANE_94_R_ISCAN_REG_SET(0x1) |
1682 SD10G_LANE_LANE_94_R_TXEQ_REG_SET(0x1) |
1683 SD10G_LANE_LANE_94_R_MISC_REG_SET(0x1) |
1684 SD10G_LANE_LANE_94_R_SWING_REG_SET(0x1),
1685 SD10G_LANE_LANE_94_R_ISCAN_REG |
1686 SD10G_LANE_LANE_94_R_TXEQ_REG |
1687 SD10G_LANE_LANE_94_R_MISC_REG |
1688 SD10G_LANE_LANE_94_R_SWING_REG,
1689 sd_inst,
1690 SD10G_LANE_LANE_94(sd_index));
1691
1692 sdx5_inst_rmw(SD10G_LANE_LANE_9E_R_RXEQ_REG_SET(0x1),
1693 SD10G_LANE_LANE_9E_R_RXEQ_REG,
1694 sd_inst,
1695 SD10G_LANE_LANE_9E(sd_index));
1696
1697 sdx5_inst_rmw(SD10G_LANE_LANE_A1_R_SSC_FROM_HWT_SET(0x0) |
1698 SD10G_LANE_LANE_A1_R_CDR_FROM_HWT_SET(0x0) |
1699 SD10G_LANE_LANE_A1_R_PCLK_GATING_FROM_HWT_SET(0x1),
1700 SD10G_LANE_LANE_A1_R_SSC_FROM_HWT |
1701 SD10G_LANE_LANE_A1_R_CDR_FROM_HWT |
1702 SD10G_LANE_LANE_A1_R_PCLK_GATING_FROM_HWT,
1703 sd_inst,
1704 SD10G_LANE_LANE_A1(sd_index));
1705
1706 sdx5_rmw(SD_LANE_SD_LANE_CFG_RX_REF_SEL_SET(params->cmu_sel) |
1707 SD_LANE_SD_LANE_CFG_TX_REF_SEL_SET(params->cmu_sel),
1708 SD_LANE_SD_LANE_CFG_RX_REF_SEL |
1709 SD_LANE_SD_LANE_CFG_TX_REF_SEL,
1710 priv,
1711 SD_LANE_SD_LANE_CFG(lane_index));
1712
1713 sdx5_inst_rmw(SD10G_LANE_LANE_40_CFG_LANE_RESERVE_7_0_SET
1714 (params->cfg_lane_reserve_7_0),
1715 SD10G_LANE_LANE_40_CFG_LANE_RESERVE_7_0,
1716 sd_inst,
1717 SD10G_LANE_LANE_40(sd_index));
1718
1719 sdx5_inst_rmw(SD10G_LANE_LANE_50_CFG_SSC_RTL_CLK_SEL_SET
1720 (params->cfg_ssc_rtl_clk_sel),
1721 SD10G_LANE_LANE_50_CFG_SSC_RTL_CLK_SEL,
1722 sd_inst,
1723 SD10G_LANE_LANE_50(sd_index));
1724
1725 sdx5_inst_rmw(SD10G_LANE_LANE_35_CFG_TXRATE_1_0_SET
1726 (params->cfg_txrate_1_0) |
1727 SD10G_LANE_LANE_35_CFG_RXRATE_1_0_SET
1728 (params->cfg_rxrate_1_0),
1729 SD10G_LANE_LANE_35_CFG_TXRATE_1_0 |
1730 SD10G_LANE_LANE_35_CFG_RXRATE_1_0,
1731 sd_inst,
1732 SD10G_LANE_LANE_35(sd_index));
1733
1734 sdx5_inst_rmw(SD10G_LANE_LANE_94_R_DWIDTHCTRL_2_0_SET
1735 (params->r_d_width_ctrl_2_0),
1736 SD10G_LANE_LANE_94_R_DWIDTHCTRL_2_0,
1737 sd_inst,
1738 SD10G_LANE_LANE_94(sd_index));
1739
1740 sdx5_inst_rmw(SD10G_LANE_LANE_01_CFG_PMA_TX_CK_BITWIDTH_2_0_SET
1741 (params->cfg_pma_tx_ck_bitwidth_2_0),
1742 SD10G_LANE_LANE_01_CFG_PMA_TX_CK_BITWIDTH_2_0,
1743 sd_inst,
1744 SD10G_LANE_LANE_01(sd_index));
1745
1746 sdx5_inst_rmw(SD10G_LANE_LANE_30_CFG_RXDIV_SEL_2_0_SET
1747 (params->cfg_rxdiv_sel_2_0),
1748 SD10G_LANE_LANE_30_CFG_RXDIV_SEL_2_0,
1749 sd_inst,
1750 SD10G_LANE_LANE_30(sd_index));
1751
1752 sdx5_inst_rmw(SD10G_LANE_LANE_A2_R_PCS2PMA_PHYMODE_4_0_SET
1753 (params->r_pcs2pma_phymode_4_0),
1754 SD10G_LANE_LANE_A2_R_PCS2PMA_PHYMODE_4_0,
1755 sd_inst,
1756 SD10G_LANE_LANE_A2(sd_index));
1757
1758 sdx5_inst_rmw(SD10G_LANE_LANE_13_CFG_CDRCK_EN_SET(params->cfg_cdrck_en),
1759 SD10G_LANE_LANE_13_CFG_CDRCK_EN,
1760 sd_inst,
1761 SD10G_LANE_LANE_13(sd_index));
1762
1763 sdx5_inst_rmw(SD10G_LANE_LANE_23_CFG_DFECK_EN_SET
1764 (params->cfg_dfeck_en) |
1765 SD10G_LANE_LANE_23_CFG_DFE_PD_SET(params->cfg_dfe_pd) |
1766 SD10G_LANE_LANE_23_CFG_ERRAMP_PD_SET
1767 (params->cfg_erramp_pd),
1768 SD10G_LANE_LANE_23_CFG_DFECK_EN |
1769 SD10G_LANE_LANE_23_CFG_DFE_PD |
1770 SD10G_LANE_LANE_23_CFG_ERRAMP_PD,
1771 sd_inst,
1772 SD10G_LANE_LANE_23(sd_index));
1773
1774 sdx5_inst_rmw(SD10G_LANE_LANE_22_CFG_DFETAP_EN_5_1_SET
1775 (params->cfg_dfetap_en_5_1),
1776 SD10G_LANE_LANE_22_CFG_DFETAP_EN_5_1,
1777 sd_inst,
1778 SD10G_LANE_LANE_22(sd_index));
1779
1780 sdx5_inst_rmw(SD10G_LANE_LANE_1A_CFG_PI_DFE_EN_SET
1781 (params->cfg_pi_DFE_en),
1782 SD10G_LANE_LANE_1A_CFG_PI_DFE_EN,
1783 sd_inst,
1784 SD10G_LANE_LANE_1A(sd_index));
1785
1786 sdx5_inst_rmw(SD10G_LANE_LANE_02_CFG_EN_ADV_SET(params->cfg_en_adv) |
1787 SD10G_LANE_LANE_02_CFG_EN_MAIN_SET(params->cfg_en_main) |
1788 SD10G_LANE_LANE_02_CFG_EN_DLY_SET(params->cfg_en_dly) |
1789 SD10G_LANE_LANE_02_CFG_TAP_ADV_3_0_SET
1790 (params->cfg_tap_adv_3_0),
1791 SD10G_LANE_LANE_02_CFG_EN_ADV |
1792 SD10G_LANE_LANE_02_CFG_EN_MAIN |
1793 SD10G_LANE_LANE_02_CFG_EN_DLY |
1794 SD10G_LANE_LANE_02_CFG_TAP_ADV_3_0,
1795 sd_inst,
1796 SD10G_LANE_LANE_02(sd_index));
1797
1798 sdx5_inst_rmw(SD10G_LANE_LANE_03_CFG_TAP_MAIN_SET(params->cfg_tap_main),
1799 SD10G_LANE_LANE_03_CFG_TAP_MAIN,
1800 sd_inst,
1801 SD10G_LANE_LANE_03(sd_index));
1802
1803 sdx5_inst_rmw(SD10G_LANE_LANE_04_CFG_TAP_DLY_4_0_SET
1804 (params->cfg_tap_dly_4_0),
1805 SD10G_LANE_LANE_04_CFG_TAP_DLY_4_0,
1806 sd_inst,
1807 SD10G_LANE_LANE_04(sd_index));
1808
1809 sdx5_inst_rmw(SD10G_LANE_LANE_2F_CFG_VGA_CTRL_3_0_SET
1810 (params->cfg_vga_ctrl_3_0),
1811 SD10G_LANE_LANE_2F_CFG_VGA_CTRL_3_0,
1812 sd_inst,
1813 SD10G_LANE_LANE_2F(sd_index));
1814
1815 sdx5_inst_rmw(SD10G_LANE_LANE_2F_CFG_VGA_CP_2_0_SET
1816 (params->cfg_vga_cp_2_0),
1817 SD10G_LANE_LANE_2F_CFG_VGA_CP_2_0,
1818 sd_inst,
1819 SD10G_LANE_LANE_2F(sd_index));
1820
1821 sdx5_inst_rmw(SD10G_LANE_LANE_0B_CFG_EQ_RES_3_0_SET
1822 (params->cfg_eq_res_3_0),
1823 SD10G_LANE_LANE_0B_CFG_EQ_RES_3_0,
1824 sd_inst,
1825 SD10G_LANE_LANE_0B(sd_index));
1826
1827 sdx5_inst_rmw(SD10G_LANE_LANE_0D_CFG_EQR_BYP_SET(params->cfg_eq_r_byp),
1828 SD10G_LANE_LANE_0D_CFG_EQR_BYP,
1829 sd_inst,
1830 SD10G_LANE_LANE_0D(sd_index));
1831
1832 sdx5_inst_rmw(SD10G_LANE_LANE_0E_CFG_EQC_FORCE_3_0_SET
1833 (params->cfg_eq_c_force_3_0) |
1834 SD10G_LANE_LANE_0E_CFG_SUM_SETCM_EN_SET
1835 (params->cfg_sum_setcm_en),
1836 SD10G_LANE_LANE_0E_CFG_EQC_FORCE_3_0 |
1837 SD10G_LANE_LANE_0E_CFG_SUM_SETCM_EN,
1838 sd_inst,
1839 SD10G_LANE_LANE_0E(sd_index));
1840
1841 sdx5_inst_rmw(SD10G_LANE_LANE_23_CFG_EN_DFEDIG_SET
1842 (params->cfg_en_dfedig),
1843 SD10G_LANE_LANE_23_CFG_EN_DFEDIG,
1844 sd_inst,
1845 SD10G_LANE_LANE_23(sd_index));
1846
1847 sdx5_inst_rmw(SD10G_LANE_LANE_06_CFG_EN_PREEMPH_SET
1848 (params->cfg_en_preemph),
1849 SD10G_LANE_LANE_06_CFG_EN_PREEMPH,
1850 sd_inst,
1851 SD10G_LANE_LANE_06(sd_index));
1852
1853 sdx5_inst_rmw(SD10G_LANE_LANE_33_CFG_ITX_IPPREEMP_BASE_1_0_SET
1854 (params->cfg_itx_ippreemp_base_1_0) |
1855 SD10G_LANE_LANE_33_CFG_ITX_IPDRIVER_BASE_2_0_SET
1856 (params->cfg_itx_ipdriver_base_2_0),
1857 SD10G_LANE_LANE_33_CFG_ITX_IPPREEMP_BASE_1_0 |
1858 SD10G_LANE_LANE_33_CFG_ITX_IPDRIVER_BASE_2_0,
1859 sd_inst,
1860 SD10G_LANE_LANE_33(sd_index));
1861
1862 sdx5_inst_rmw(SD10G_LANE_LANE_52_CFG_IBIAS_TUNE_RESERVE_5_0_SET
1863 (params->cfg_ibias_tune_reserve_5_0),
1864 SD10G_LANE_LANE_52_CFG_IBIAS_TUNE_RESERVE_5_0,
1865 sd_inst,
1866 SD10G_LANE_LANE_52(sd_index));
1867
1868 sdx5_inst_rmw(SD10G_LANE_LANE_37_CFG_TXSWING_HALF_SET
1869 (params->cfg_txswing_half),
1870 SD10G_LANE_LANE_37_CFG_TXSWING_HALF,
1871 sd_inst,
1872 SD10G_LANE_LANE_37(sd_index));
1873
1874 sdx5_inst_rmw(SD10G_LANE_LANE_3C_CFG_DIS_2NDORDER_SET
1875 (params->cfg_dis_2nd_order),
1876 SD10G_LANE_LANE_3C_CFG_DIS_2NDORDER,
1877 sd_inst,
1878 SD10G_LANE_LANE_3C(sd_index));
1879
1880 sdx5_inst_rmw(SD10G_LANE_LANE_39_CFG_RX_SSC_LH_SET
1881 (params->cfg_rx_ssc_lh),
1882 SD10G_LANE_LANE_39_CFG_RX_SSC_LH,
1883 sd_inst,
1884 SD10G_LANE_LANE_39(sd_index));
1885
1886 sdx5_inst_rmw(SD10G_LANE_LANE_1A_CFG_PI_FLOOP_STEPS_1_0_SET
1887 (params->cfg_pi_floop_steps_1_0),
1888 SD10G_LANE_LANE_1A_CFG_PI_FLOOP_STEPS_1_0,
1889 sd_inst,
1890 SD10G_LANE_LANE_1A(sd_index));
1891
1892 sdx5_inst_rmw(SD10G_LANE_LANE_16_CFG_PI_EXT_DAC_23_16_SET
1893 (params->cfg_pi_ext_dac_23_16),
1894 SD10G_LANE_LANE_16_CFG_PI_EXT_DAC_23_16,
1895 sd_inst,
1896 SD10G_LANE_LANE_16(sd_index));
1897
1898 sdx5_inst_rmw(SD10G_LANE_LANE_15_CFG_PI_EXT_DAC_15_8_SET
1899 (params->cfg_pi_ext_dac_15_8),
1900 SD10G_LANE_LANE_15_CFG_PI_EXT_DAC_15_8,
1901 sd_inst,
1902 SD10G_LANE_LANE_15(sd_index));
1903
1904 sdx5_inst_rmw(SD10G_LANE_LANE_26_CFG_ISCAN_EXT_DAC_7_0_SET
1905 (params->cfg_iscan_ext_dac_7_0),
1906 SD10G_LANE_LANE_26_CFG_ISCAN_EXT_DAC_7_0,
1907 sd_inst,
1908 SD10G_LANE_LANE_26(sd_index));
1909
1910 sdx5_inst_rmw(SD10G_LANE_LANE_42_CFG_CDR_KF_GEN1_2_0_SET
1911 (params->cfg_cdr_kf_gen1_2_0),
1912 SD10G_LANE_LANE_42_CFG_CDR_KF_GEN1_2_0,
1913 sd_inst,
1914 SD10G_LANE_LANE_42(sd_index));
1915
1916 sdx5_inst_rmw(SD10G_LANE_LANE_0F_R_CDR_M_GEN1_7_0_SET
1917 (params->r_cdr_m_gen1_7_0),
1918 SD10G_LANE_LANE_0F_R_CDR_M_GEN1_7_0,
1919 sd_inst,
1920 SD10G_LANE_LANE_0F(sd_index));
1921
1922 sdx5_inst_rmw(SD10G_LANE_LANE_24_CFG_PI_BW_GEN1_3_0_SET
1923 (params->cfg_pi_bw_gen1_3_0),
1924 SD10G_LANE_LANE_24_CFG_PI_BW_GEN1_3_0,
1925 sd_inst,
1926 SD10G_LANE_LANE_24(sd_index));
1927
1928 sdx5_inst_rmw(SD10G_LANE_LANE_14_CFG_PI_EXT_DAC_7_0_SET
1929 (params->cfg_pi_ext_dac_7_0),
1930 SD10G_LANE_LANE_14_CFG_PI_EXT_DAC_7_0,
1931 sd_inst,
1932 SD10G_LANE_LANE_14(sd_index));
1933
1934 sdx5_inst_rmw(SD10G_LANE_LANE_1A_CFG_PI_STEPS_SET(params->cfg_pi_steps),
1935 SD10G_LANE_LANE_1A_CFG_PI_STEPS,
1936 sd_inst,
1937 SD10G_LANE_LANE_1A(sd_index));
1938
1939 sdx5_inst_rmw(SD10G_LANE_LANE_3A_CFG_MP_MAX_3_0_SET
1940 (params->cfg_mp_max_3_0),
1941 SD10G_LANE_LANE_3A_CFG_MP_MAX_3_0,
1942 sd_inst,
1943 SD10G_LANE_LANE_3A(sd_index));
1944
1945 sdx5_inst_rmw(SD10G_LANE_LANE_31_CFG_RSTN_DFEDIG_SET
1946 (params->cfg_rstn_dfedig),
1947 SD10G_LANE_LANE_31_CFG_RSTN_DFEDIG,
1948 sd_inst,
1949 SD10G_LANE_LANE_31(sd_index));
1950
1951 sdx5_inst_rmw(SD10G_LANE_LANE_48_CFG_ALOS_THR_3_0_SET
1952 (params->cfg_alos_thr_3_0),
1953 SD10G_LANE_LANE_48_CFG_ALOS_THR_3_0,
1954 sd_inst,
1955 SD10G_LANE_LANE_48(sd_index));
1956
1957 sdx5_inst_rmw(SD10G_LANE_LANE_36_CFG_PREDRV_SLEWRATE_1_0_SET
1958 (params->cfg_predrv_slewrate_1_0),
1959 SD10G_LANE_LANE_36_CFG_PREDRV_SLEWRATE_1_0,
1960 sd_inst,
1961 SD10G_LANE_LANE_36(sd_index));
1962
1963 sdx5_inst_rmw(SD10G_LANE_LANE_32_CFG_ITX_IPCML_BASE_1_0_SET
1964 (params->cfg_itx_ipcml_base_1_0),
1965 SD10G_LANE_LANE_32_CFG_ITX_IPCML_BASE_1_0,
1966 sd_inst,
1967 SD10G_LANE_LANE_32(sd_index));
1968
1969 sdx5_inst_rmw(SD10G_LANE_LANE_37_CFG_IP_PRE_BASE_1_0_SET
1970 (params->cfg_ip_pre_base_1_0),
1971 SD10G_LANE_LANE_37_CFG_IP_PRE_BASE_1_0,
1972 sd_inst,
1973 SD10G_LANE_LANE_37(sd_index));
1974
1975 sdx5_inst_rmw(SD10G_LANE_LANE_41_CFG_LANE_RESERVE_15_8_SET
1976 (params->cfg_lane_reserve_15_8),
1977 SD10G_LANE_LANE_41_CFG_LANE_RESERVE_15_8,
1978 sd_inst,
1979 SD10G_LANE_LANE_41(sd_index));
1980
1981 sdx5_inst_rmw(SD10G_LANE_LANE_9E_R_EN_AUTO_CDR_RSTN_SET
1982 (params->r_en_auto_cdr_rstn),
1983 SD10G_LANE_LANE_9E_R_EN_AUTO_CDR_RSTN,
1984 sd_inst,
1985 SD10G_LANE_LANE_9E(sd_index));
1986
1987 sdx5_inst_rmw(SD10G_LANE_LANE_0C_CFG_OSCAL_AFE_SET
1988 (params->cfg_oscal_afe) |
1989 SD10G_LANE_LANE_0C_CFG_PD_OSDAC_AFE_SET
1990 (params->cfg_pd_osdac_afe),
1991 SD10G_LANE_LANE_0C_CFG_OSCAL_AFE |
1992 SD10G_LANE_LANE_0C_CFG_PD_OSDAC_AFE,
1993 sd_inst,
1994 SD10G_LANE_LANE_0C(sd_index));
1995
1996 sdx5_inst_rmw(SD10G_LANE_LANE_0B_CFG_RESETB_OSCAL_AFE_SET
1997 (params->cfg_resetb_oscal_afe[0]),
1998 SD10G_LANE_LANE_0B_CFG_RESETB_OSCAL_AFE,
1999 sd_inst,
2000 SD10G_LANE_LANE_0B(sd_index));
2001
2002 sdx5_inst_rmw(SD10G_LANE_LANE_0B_CFG_RESETB_OSCAL_AFE_SET
2003 (params->cfg_resetb_oscal_afe[1]),
2004 SD10G_LANE_LANE_0B_CFG_RESETB_OSCAL_AFE,
2005 sd_inst,
2006 SD10G_LANE_LANE_0B(sd_index));
2007
2008 sdx5_inst_rmw(SD10G_LANE_LANE_83_R_TX_POL_INV_SET
2009 (params->r_tx_pol_inv) |
2010 SD10G_LANE_LANE_83_R_RX_POL_INV_SET
2011 (params->r_rx_pol_inv),
2012 SD10G_LANE_LANE_83_R_TX_POL_INV |
2013 SD10G_LANE_LANE_83_R_RX_POL_INV,
2014 sd_inst,
2015 SD10G_LANE_LANE_83(sd_index));
2016
2017 sdx5_inst_rmw(SD10G_LANE_LANE_06_CFG_RX2TX_LP_EN_SET
2018 (params->cfg_rx2tx_lp_en) |
2019 SD10G_LANE_LANE_06_CFG_TX2RX_LP_EN_SET
2020 (params->cfg_tx2rx_lp_en),
2021 SD10G_LANE_LANE_06_CFG_RX2TX_LP_EN |
2022 SD10G_LANE_LANE_06_CFG_TX2RX_LP_EN,
2023 sd_inst,
2024 SD10G_LANE_LANE_06(sd_index));
2025
2026 sdx5_inst_rmw(SD10G_LANE_LANE_0E_CFG_RXLB_EN_SET(params->cfg_rxlb_en) |
2027 SD10G_LANE_LANE_0E_CFG_TXLB_EN_SET(params->cfg_txlb_en),
2028 SD10G_LANE_LANE_0E_CFG_RXLB_EN |
2029 SD10G_LANE_LANE_0E_CFG_TXLB_EN,
2030 sd_inst,
2031 SD10G_LANE_LANE_0E(sd_index));
2032
2033 sdx5_rmw(SD_LANE_SD_LANE_CFG_MACRO_RST_SET(0),
2034 SD_LANE_SD_LANE_CFG_MACRO_RST,
2035 priv,
2036 SD_LANE_SD_LANE_CFG(lane_index));
2037
2038 sdx5_inst_rmw(SD10G_LANE_LANE_50_CFG_SSC_RESETB_SET(1),
2039 SD10G_LANE_LANE_50_CFG_SSC_RESETB,
2040 sd_inst,
2041 SD10G_LANE_LANE_50(sd_index));
2042
2043 sdx5_rmw(SD10G_LANE_LANE_50_CFG_SSC_RESETB_SET(1),
2044 SD10G_LANE_LANE_50_CFG_SSC_RESETB,
2045 priv,
2046 SD10G_LANE_LANE_50(sd_index));
2047
2048 sdx5_rmw(SD_LANE_MISC_SD_125_RST_DIS_SET(params->fx_100),
2049 SD_LANE_MISC_SD_125_RST_DIS,
2050 priv,
2051 SD_LANE_MISC(lane_index));
2052
2053 sdx5_rmw(SD_LANE_MISC_RX_ENA_SET(params->fx_100),
2054 SD_LANE_MISC_RX_ENA,
2055 priv,
2056 SD_LANE_MISC(lane_index));
2057
2058 sdx5_rmw(SD_LANE_MISC_MUX_ENA_SET(params->fx_100),
2059 SD_LANE_MISC_MUX_ENA,
2060 priv,
2061 SD_LANE_MISC(lane_index));
2062
2063 usleep_range(3000, 6000);
2064
2065 value = readl(sdx5_addr(regs, SD_LANE_SD_LANE_STAT(lane_index)));
2066 value = SD_LANE_SD_LANE_STAT_PMA_RST_DONE_GET(value);
2067 if (value != 1) {
2068 dev_err(dev, "10G PMA Reset failed: 0x%x\n", value);
2069 return -EINVAL;
2070 }
2071
2072 sdx5_rmw(SD_LANE_SD_SER_RST_SER_RST_SET(0x0),
2073 SD_LANE_SD_SER_RST_SER_RST,
2074 priv,
2075 SD_LANE_SD_SER_RST(lane_index));
2076
2077 sdx5_rmw(SD_LANE_SD_DES_RST_DES_RST_SET(0x0),
2078 SD_LANE_SD_DES_RST_DES_RST,
2079 priv,
2080 SD_LANE_SD_DES_RST(lane_index));
2081
2082 return 0;
2083}
2084
2085static int sparx5_sd25g28_config(struct sparx5_serdes_macro *macro, bool reset)
2086{
2087 struct sparx5_sd25g28_media_preset media = media_presets_25g[macro->media];
2088 struct sparx5_sd25g28_mode_preset mode;
2089 struct sparx5_sd25g28_args args = {
2090 .rxinvert = 1,
2091 .txinvert = 0,
2092 .txswing = 240,
2093 .com_pll_reserve = 0xf,
2094 .reg_rst = reset,
2095 };
2096 struct sparx5_sd25g28_params params;
2097 int err;
2098
2099 err = sparx5_sd10g25_get_mode_preset(macro, &mode);
2100 if (err)
2101 return err;
2102 sparx5_sd25g28_get_params(macro, &media, &mode, &args, ¶ms);
2103 sparx5_sd25g28_reset(macro->priv->regs, ¶ms, macro->stpidx);
2104 return sparx5_sd25g28_apply_params(macro, ¶ms);
2105}
2106
2107static int sparx5_sd10g28_config(struct sparx5_serdes_macro *macro, bool reset)
2108{
2109 struct sparx5_sd10g28_media_preset media = media_presets_10g[macro->media];
2110 struct sparx5_sd10g28_mode_preset mode;
2111 struct sparx5_sd10g28_params params;
2112 struct sparx5_sd10g28_args args = {
2113 .is_6g = (macro->serdestype == SPX5_SDT_6G),
2114 .txinvert = 0,
2115 .rxinvert = 1,
2116 .txswing = 240,
2117 .reg_rst = reset,
2118 .skip_cmu_cfg = reset,
2119 };
2120 int err;
2121
2122 err = sparx5_sd10g28_get_mode_preset(macro, &mode, &args);
2123 if (err)
2124 return err;
2125 sparx5_sd10g28_get_params(macro, &media, &mode, &args, ¶ms);
2126 sparx5_sd10g28_reset(macro->priv->regs, macro->sidx);
2127 return sparx5_sd10g28_apply_params(macro, ¶ms);
2128}
2129
2130/* Power down serdes TX driver */
2131static int sparx5_serdes_power_save(struct sparx5_serdes_macro *macro, u32 pwdn)
2132{
2133 struct sparx5_serdes_private *priv = macro->priv;
2134 void __iomem *sd_inst, *sd_lane_inst;
2135
2136 if (macro->serdestype == SPX5_SDT_6G)
2137 sd_inst = sdx5_inst_get(priv, TARGET_SD6G_LANE, macro->stpidx);
2138 else if (macro->serdestype == SPX5_SDT_10G)
2139 sd_inst = sdx5_inst_get(priv, TARGET_SD10G_LANE, macro->stpidx);
2140 else
2141 sd_inst = sdx5_inst_get(priv, TARGET_SD25G_LANE, macro->stpidx);
2142
2143 if (macro->serdestype == SPX5_SDT_25G) {
2144 sd_lane_inst = sdx5_inst_get(priv, TARGET_SD_LANE_25G,
2145 macro->stpidx);
2146 /* Take serdes out of reset */
2147 sdx5_inst_rmw(SD_LANE_25G_SD_LANE_CFG_EXT_CFG_RST_SET(0),
2148 SD_LANE_25G_SD_LANE_CFG_EXT_CFG_RST, sd_lane_inst,
2149 SD_LANE_25G_SD_LANE_CFG(0));
2150
2151 /* Configure optimal settings for quiet mode */
2152 sdx5_inst_rmw(SD_LANE_25G_QUIET_MODE_6G_QUIET_MODE_SET(SPX5_SERDES_QUIET_MODE_VAL),
2153 SD_LANE_25G_QUIET_MODE_6G_QUIET_MODE,
2154 sd_lane_inst, SD_LANE_25G_QUIET_MODE_6G(0));
2155
2156 sdx5_inst_rmw(SD25G_LANE_LANE_04_LN_CFG_PD_DRIVER_SET(pwdn),
2157 SD25G_LANE_LANE_04_LN_CFG_PD_DRIVER,
2158 sd_inst,
2159 SD25G_LANE_LANE_04(0));
2160 } else {
2161 /* 6G and 10G */
2162 sd_lane_inst = sdx5_inst_get(priv, TARGET_SD_LANE, macro->sidx);
2163
2164 /* Take serdes out of reset */
2165 sdx5_inst_rmw(SD_LANE_SD_LANE_CFG_EXT_CFG_RST_SET(0),
2166 SD_LANE_SD_LANE_CFG_EXT_CFG_RST, sd_lane_inst,
2167 SD_LANE_SD_LANE_CFG(0));
2168
2169 /* Configure optimal settings for quiet mode */
2170 sdx5_inst_rmw(SD_LANE_QUIET_MODE_6G_QUIET_MODE_SET(SPX5_SERDES_QUIET_MODE_VAL),
2171 SD_LANE_QUIET_MODE_6G_QUIET_MODE, sd_lane_inst,
2172 SD_LANE_QUIET_MODE_6G(0));
2173
2174 sdx5_inst_rmw(SD10G_LANE_LANE_06_CFG_PD_DRIVER_SET(pwdn),
2175 SD10G_LANE_LANE_06_CFG_PD_DRIVER,
2176 sd_inst,
2177 SD10G_LANE_LANE_06(0));
2178 }
2179 return 0;
2180}
2181
2182static int sparx5_serdes_clock_config(struct sparx5_serdes_macro *macro)
2183{
2184 struct sparx5_serdes_private *priv = macro->priv;
2185
2186 if (macro->serdesmode == SPX5_SD_MODE_100FX) {
2187 u32 freq = priv->coreclock == 250000000 ? 2 :
2188 priv->coreclock == 500000000 ? 1 : 0;
2189
2190 sdx5_rmw(SD_LANE_MISC_CORE_CLK_FREQ_SET(freq),
2191 SD_LANE_MISC_CORE_CLK_FREQ,
2192 priv,
2193 SD_LANE_MISC(macro->sidx));
2194 }
2195 return 0;
2196}
2197
2198static int sparx5_serdes_get_serdesmode(phy_interface_t portmode, int speed)
2199{
2200 switch (portmode) {
2201 case PHY_INTERFACE_MODE_1000BASEX:
2202 case PHY_INTERFACE_MODE_2500BASEX:
2203 if (speed == SPEED_2500)
2204 return SPX5_SD_MODE_2G5;
2205 if (speed == SPEED_100)
2206 return SPX5_SD_MODE_100FX;
2207 return SPX5_SD_MODE_1000BASEX;
2208 case PHY_INTERFACE_MODE_SGMII:
2209 /* The same Serdes mode is used for both SGMII and 1000BaseX */
2210 return SPX5_SD_MODE_1000BASEX;
2211 case PHY_INTERFACE_MODE_QSGMII:
2212 return SPX5_SD_MODE_QSGMII;
2213 case PHY_INTERFACE_MODE_10GBASER:
2214 return SPX5_SD_MODE_SFI;
2215 default:
2216 return -EINVAL;
2217 }
2218}
2219
2220static int sparx5_serdes_config(struct sparx5_serdes_macro *macro)
2221{
2222 struct device *dev = macro->priv->dev;
2223 int serdesmode;
2224 int err;
2225
2226 serdesmode = sparx5_serdes_get_serdesmode(macro->portmode, macro->speed);
2227 if (serdesmode < 0) {
2228 dev_err(dev, "SerDes %u, interface not supported: %s\n",
2229 macro->sidx,
2230 phy_modes(macro->portmode));
2231 return serdesmode;
2232 }
2233 macro->serdesmode = serdesmode;
2234
2235 sparx5_serdes_clock_config(macro);
2236
2237 if (macro->serdestype == SPX5_SDT_25G)
2238 err = sparx5_sd25g28_config(macro, false);
2239 else
2240 err = sparx5_sd10g28_config(macro, false);
2241 if (err) {
2242 dev_err(dev, "SerDes %u, config error: %d\n",
2243 macro->sidx, err);
2244 }
2245 return err;
2246}
2247
2248static int sparx5_serdes_power_on(struct phy *phy)
2249{
2250 struct sparx5_serdes_macro *macro = phy_get_drvdata(phy);
2251
2252 return sparx5_serdes_power_save(macro, false);
2253}
2254
2255static int sparx5_serdes_power_off(struct phy *phy)
2256{
2257 struct sparx5_serdes_macro *macro = phy_get_drvdata(phy);
2258
2259 return sparx5_serdes_power_save(macro, true);
2260}
2261
2262static int sparx5_serdes_set_mode(struct phy *phy, enum phy_mode mode, int submode)
2263{
2264 struct sparx5_serdes_macro *macro;
2265
2266 if (mode != PHY_MODE_ETHERNET)
2267 return -EINVAL;
2268
2269 switch (submode) {
2270 case PHY_INTERFACE_MODE_1000BASEX:
2271 case PHY_INTERFACE_MODE_2500BASEX:
2272 case PHY_INTERFACE_MODE_SGMII:
2273 case PHY_INTERFACE_MODE_QSGMII:
2274 case PHY_INTERFACE_MODE_10GBASER:
2275 macro = phy_get_drvdata(phy);
2276 macro->portmode = submode;
2277 sparx5_serdes_config(macro);
2278 return 0;
2279 default:
2280 return -EINVAL;
2281 }
2282}
2283
2284static int sparx5_serdes_set_media(struct phy *phy, enum phy_media media)
2285{
2286 struct sparx5_serdes_macro *macro = phy_get_drvdata(phy);
2287
2288 if (media != macro->media) {
2289 macro->media = media;
2290 if (macro->serdesmode != SPX5_SD_MODE_NONE)
2291 sparx5_serdes_config(macro);
2292 }
2293 return 0;
2294}
2295
2296static int sparx5_serdes_set_speed(struct phy *phy, int speed)
2297{
2298 struct sparx5_serdes_macro *macro = phy_get_drvdata(phy);
2299
2300 if (macro->sidx < SPX5_SERDES_10G_START && speed > SPEED_5000)
2301 return -EINVAL;
2302 if (macro->sidx < SPX5_SERDES_25G_START && speed > SPEED_10000)
2303 return -EINVAL;
2304 if (speed != macro->speed) {
2305 macro->speed = speed;
2306 if (macro->serdesmode != SPX5_SD_MODE_NONE)
2307 sparx5_serdes_config(macro);
2308 }
2309 return 0;
2310}
2311
2312static int sparx5_serdes_reset(struct phy *phy)
2313{
2314 struct sparx5_serdes_macro *macro = phy_get_drvdata(phy);
2315 int err;
2316
2317 if (macro->serdestype == SPX5_SDT_25G)
2318 err = sparx5_sd25g28_config(macro, true);
2319 else
2320 err = sparx5_sd10g28_config(macro, true);
2321 if (err) {
2322 dev_err(&phy->dev, "SerDes %u, reset error: %d\n",
2323 macro->sidx, err);
2324 }
2325 return err;
2326}
2327
2328static int sparx5_serdes_validate(struct phy *phy, enum phy_mode mode,
2329 int submode,
2330 union phy_configure_opts *opts)
2331{
2332 struct sparx5_serdes_macro *macro = phy_get_drvdata(phy);
2333
2334 if (mode != PHY_MODE_ETHERNET)
2335 return -EINVAL;
2336
2337 if (macro->speed == 0)
2338 return -EINVAL;
2339
2340 if (macro->sidx < SPX5_SERDES_10G_START && macro->speed > SPEED_5000)
2341 return -EINVAL;
2342 if (macro->sidx < SPX5_SERDES_25G_START && macro->speed > SPEED_10000)
2343 return -EINVAL;
2344
2345 switch (submode) {
2346 case PHY_INTERFACE_MODE_1000BASEX:
2347 if (macro->speed != SPEED_100 && /* This is for 100BASE-FX */
2348 macro->speed != SPEED_1000)
2349 return -EINVAL;
2350 break;
2351 case PHY_INTERFACE_MODE_SGMII:
2352 case PHY_INTERFACE_MODE_2500BASEX:
2353 case PHY_INTERFACE_MODE_QSGMII:
2354 if (macro->speed >= SPEED_5000)
2355 return -EINVAL;
2356 break;
2357 case PHY_INTERFACE_MODE_10GBASER:
2358 if (macro->speed < SPEED_5000)
2359 return -EINVAL;
2360 break;
2361 default:
2362 return -EINVAL;
2363 }
2364 return 0;
2365}
2366
2367static const struct phy_ops sparx5_serdes_ops = {
2368 .power_on = sparx5_serdes_power_on,
2369 .power_off = sparx5_serdes_power_off,
2370 .set_mode = sparx5_serdes_set_mode,
2371 .set_media = sparx5_serdes_set_media,
2372 .set_speed = sparx5_serdes_set_speed,
2373 .reset = sparx5_serdes_reset,
2374 .validate = sparx5_serdes_validate,
2375 .owner = THIS_MODULE,
2376};
2377
2378static int sparx5_phy_create(struct sparx5_serdes_private *priv,
2379 int idx, struct phy **phy)
2380{
2381 struct sparx5_serdes_macro *macro;
2382
2383 *phy = devm_phy_create(priv->dev, NULL, &sparx5_serdes_ops);
2384 if (IS_ERR(*phy))
2385 return PTR_ERR(*phy);
2386
2387 macro = devm_kzalloc(priv->dev, sizeof(*macro), GFP_KERNEL);
2388 if (!macro)
2389 return -ENOMEM;
2390
2391 macro->sidx = idx;
2392 macro->priv = priv;
2393 macro->speed = SPEED_UNKNOWN;
2394 if (idx < SPX5_SERDES_10G_START) {
2395 macro->serdestype = SPX5_SDT_6G;
2396 macro->stpidx = macro->sidx;
2397 } else if (idx < SPX5_SERDES_25G_START) {
2398 macro->serdestype = SPX5_SDT_10G;
2399 macro->stpidx = macro->sidx - SPX5_SERDES_10G_START;
2400 } else {
2401 macro->serdestype = SPX5_SDT_25G;
2402 macro->stpidx = macro->sidx - SPX5_SERDES_25G_START;
2403 }
2404
2405 phy_set_drvdata(*phy, macro);
2406
2407 /* Power off serdes by default */
2408 sparx5_serdes_power_off(*phy);
2409
2410 return 0;
2411}
2412
2413static struct sparx5_serdes_io_resource sparx5_serdes_iomap[] = {
2414 { TARGET_SD_CMU, 0x0 }, /* 0x610808000: sd_cmu_0 */
2415 { TARGET_SD_CMU + 1, 0x8000 }, /* 0x610810000: sd_cmu_1 */
2416 { TARGET_SD_CMU + 2, 0x10000 }, /* 0x610818000: sd_cmu_2 */
2417 { TARGET_SD_CMU + 3, 0x18000 }, /* 0x610820000: sd_cmu_3 */
2418 { TARGET_SD_CMU + 4, 0x20000 }, /* 0x610828000: sd_cmu_4 */
2419 { TARGET_SD_CMU + 5, 0x28000 }, /* 0x610830000: sd_cmu_5 */
2420 { TARGET_SD_CMU + 6, 0x30000 }, /* 0x610838000: sd_cmu_6 */
2421 { TARGET_SD_CMU + 7, 0x38000 }, /* 0x610840000: sd_cmu_7 */
2422 { TARGET_SD_CMU + 8, 0x40000 }, /* 0x610848000: sd_cmu_8 */
2423 { TARGET_SD_CMU_CFG, 0x48000 }, /* 0x610850000: sd_cmu_cfg_0 */
2424 { TARGET_SD_CMU_CFG + 1, 0x50000 }, /* 0x610858000: sd_cmu_cfg_1 */
2425 { TARGET_SD_CMU_CFG + 2, 0x58000 }, /* 0x610860000: sd_cmu_cfg_2 */
2426 { TARGET_SD_CMU_CFG + 3, 0x60000 }, /* 0x610868000: sd_cmu_cfg_3 */
2427 { TARGET_SD_CMU_CFG + 4, 0x68000 }, /* 0x610870000: sd_cmu_cfg_4 */
2428 { TARGET_SD_CMU_CFG + 5, 0x70000 }, /* 0x610878000: sd_cmu_cfg_5 */
2429 { TARGET_SD_CMU_CFG + 6, 0x78000 }, /* 0x610880000: sd_cmu_cfg_6 */
2430 { TARGET_SD_CMU_CFG + 7, 0x80000 }, /* 0x610888000: sd_cmu_cfg_7 */
2431 { TARGET_SD_CMU_CFG + 8, 0x88000 }, /* 0x610890000: sd_cmu_cfg_8 */
2432 { TARGET_SD6G_LANE, 0x90000 }, /* 0x610898000: sd6g_lane_0 */
2433 { TARGET_SD6G_LANE + 1, 0x98000 }, /* 0x6108a0000: sd6g_lane_1 */
2434 { TARGET_SD6G_LANE + 2, 0xa0000 }, /* 0x6108a8000: sd6g_lane_2 */
2435 { TARGET_SD6G_LANE + 3, 0xa8000 }, /* 0x6108b0000: sd6g_lane_3 */
2436 { TARGET_SD6G_LANE + 4, 0xb0000 }, /* 0x6108b8000: sd6g_lane_4 */
2437 { TARGET_SD6G_LANE + 5, 0xb8000 }, /* 0x6108c0000: sd6g_lane_5 */
2438 { TARGET_SD6G_LANE + 6, 0xc0000 }, /* 0x6108c8000: sd6g_lane_6 */
2439 { TARGET_SD6G_LANE + 7, 0xc8000 }, /* 0x6108d0000: sd6g_lane_7 */
2440 { TARGET_SD6G_LANE + 8, 0xd0000 }, /* 0x6108d8000: sd6g_lane_8 */
2441 { TARGET_SD6G_LANE + 9, 0xd8000 }, /* 0x6108e0000: sd6g_lane_9 */
2442 { TARGET_SD6G_LANE + 10, 0xe0000 }, /* 0x6108e8000: sd6g_lane_10 */
2443 { TARGET_SD6G_LANE + 11, 0xe8000 }, /* 0x6108f0000: sd6g_lane_11 */
2444 { TARGET_SD6G_LANE + 12, 0xf0000 }, /* 0x6108f8000: sd6g_lane_12 */
2445 { TARGET_SD10G_LANE, 0xf8000 }, /* 0x610900000: sd10g_lane_0 */
2446 { TARGET_SD10G_LANE + 1, 0x100000 }, /* 0x610908000: sd10g_lane_1 */
2447 { TARGET_SD10G_LANE + 2, 0x108000 }, /* 0x610910000: sd10g_lane_2 */
2448 { TARGET_SD10G_LANE + 3, 0x110000 }, /* 0x610918000: sd10g_lane_3 */
2449 { TARGET_SD_LANE, 0x1a0000 }, /* 0x6109a8000: sd_lane_0 */
2450 { TARGET_SD_LANE + 1, 0x1a8000 }, /* 0x6109b0000: sd_lane_1 */
2451 { TARGET_SD_LANE + 2, 0x1b0000 }, /* 0x6109b8000: sd_lane_2 */
2452 { TARGET_SD_LANE + 3, 0x1b8000 }, /* 0x6109c0000: sd_lane_3 */
2453 { TARGET_SD_LANE + 4, 0x1c0000 }, /* 0x6109c8000: sd_lane_4 */
2454 { TARGET_SD_LANE + 5, 0x1c8000 }, /* 0x6109d0000: sd_lane_5 */
2455 { TARGET_SD_LANE + 6, 0x1d0000 }, /* 0x6109d8000: sd_lane_6 */
2456 { TARGET_SD_LANE + 7, 0x1d8000 }, /* 0x6109e0000: sd_lane_7 */
2457 { TARGET_SD_LANE + 8, 0x1e0000 }, /* 0x6109e8000: sd_lane_8 */
2458 { TARGET_SD_LANE + 9, 0x1e8000 }, /* 0x6109f0000: sd_lane_9 */
2459 { TARGET_SD_LANE + 10, 0x1f0000 }, /* 0x6109f8000: sd_lane_10 */
2460 { TARGET_SD_LANE + 11, 0x1f8000 }, /* 0x610a00000: sd_lane_11 */
2461 { TARGET_SD_LANE + 12, 0x200000 }, /* 0x610a08000: sd_lane_12 */
2462 { TARGET_SD_LANE + 13, 0x208000 }, /* 0x610a10000: sd_lane_13 */
2463 { TARGET_SD_LANE + 14, 0x210000 }, /* 0x610a18000: sd_lane_14 */
2464 { TARGET_SD_LANE + 15, 0x218000 }, /* 0x610a20000: sd_lane_15 */
2465 { TARGET_SD_LANE + 16, 0x220000 }, /* 0x610a28000: sd_lane_16 */
2466 { TARGET_SD_CMU + 9, 0x400000 }, /* 0x610c08000: sd_cmu_9 */
2467 { TARGET_SD_CMU + 10, 0x408000 }, /* 0x610c10000: sd_cmu_10 */
2468 { TARGET_SD_CMU + 11, 0x410000 }, /* 0x610c18000: sd_cmu_11 */
2469 { TARGET_SD_CMU + 12, 0x418000 }, /* 0x610c20000: sd_cmu_12 */
2470 { TARGET_SD_CMU + 13, 0x420000 }, /* 0x610c28000: sd_cmu_13 */
2471 { TARGET_SD_CMU_CFG + 9, 0x428000 }, /* 0x610c30000: sd_cmu_cfg_9 */
2472 { TARGET_SD_CMU_CFG + 10, 0x430000 }, /* 0x610c38000: sd_cmu_cfg_10 */
2473 { TARGET_SD_CMU_CFG + 11, 0x438000 }, /* 0x610c40000: sd_cmu_cfg_11 */
2474 { TARGET_SD_CMU_CFG + 12, 0x440000 }, /* 0x610c48000: sd_cmu_cfg_12 */
2475 { TARGET_SD_CMU_CFG + 13, 0x448000 }, /* 0x610c50000: sd_cmu_cfg_13 */
2476 { TARGET_SD10G_LANE + 4, 0x450000 }, /* 0x610c58000: sd10g_lane_4 */
2477 { TARGET_SD10G_LANE + 5, 0x458000 }, /* 0x610c60000: sd10g_lane_5 */
2478 { TARGET_SD10G_LANE + 6, 0x460000 }, /* 0x610c68000: sd10g_lane_6 */
2479 { TARGET_SD10G_LANE + 7, 0x468000 }, /* 0x610c70000: sd10g_lane_7 */
2480 { TARGET_SD10G_LANE + 8, 0x470000 }, /* 0x610c78000: sd10g_lane_8 */
2481 { TARGET_SD10G_LANE + 9, 0x478000 }, /* 0x610c80000: sd10g_lane_9 */
2482 { TARGET_SD10G_LANE + 10, 0x480000 }, /* 0x610c88000: sd10g_lane_10 */
2483 { TARGET_SD10G_LANE + 11, 0x488000 }, /* 0x610c90000: sd10g_lane_11 */
2484 { TARGET_SD25G_LANE, 0x490000 }, /* 0x610c98000: sd25g_lane_0 */
2485 { TARGET_SD25G_LANE + 1, 0x498000 }, /* 0x610ca0000: sd25g_lane_1 */
2486 { TARGET_SD25G_LANE + 2, 0x4a0000 }, /* 0x610ca8000: sd25g_lane_2 */
2487 { TARGET_SD25G_LANE + 3, 0x4a8000 }, /* 0x610cb0000: sd25g_lane_3 */
2488 { TARGET_SD25G_LANE + 4, 0x4b0000 }, /* 0x610cb8000: sd25g_lane_4 */
2489 { TARGET_SD25G_LANE + 5, 0x4b8000 }, /* 0x610cc0000: sd25g_lane_5 */
2490 { TARGET_SD25G_LANE + 6, 0x4c0000 }, /* 0x610cc8000: sd25g_lane_6 */
2491 { TARGET_SD25G_LANE + 7, 0x4c8000 }, /* 0x610cd0000: sd25g_lane_7 */
2492 { TARGET_SD_LANE + 17, 0x550000 }, /* 0x610d58000: sd_lane_17 */
2493 { TARGET_SD_LANE + 18, 0x558000 }, /* 0x610d60000: sd_lane_18 */
2494 { TARGET_SD_LANE + 19, 0x560000 }, /* 0x610d68000: sd_lane_19 */
2495 { TARGET_SD_LANE + 20, 0x568000 }, /* 0x610d70000: sd_lane_20 */
2496 { TARGET_SD_LANE + 21, 0x570000 }, /* 0x610d78000: sd_lane_21 */
2497 { TARGET_SD_LANE + 22, 0x578000 }, /* 0x610d80000: sd_lane_22 */
2498 { TARGET_SD_LANE + 23, 0x580000 }, /* 0x610d88000: sd_lane_23 */
2499 { TARGET_SD_LANE + 24, 0x588000 }, /* 0x610d90000: sd_lane_24 */
2500 { TARGET_SD_LANE_25G, 0x590000 }, /* 0x610d98000: sd_lane_25g_25 */
2501 { TARGET_SD_LANE_25G + 1, 0x598000 }, /* 0x610da0000: sd_lane_25g_26 */
2502 { TARGET_SD_LANE_25G + 2, 0x5a0000 }, /* 0x610da8000: sd_lane_25g_27 */
2503 { TARGET_SD_LANE_25G + 3, 0x5a8000 }, /* 0x610db0000: sd_lane_25g_28 */
2504 { TARGET_SD_LANE_25G + 4, 0x5b0000 }, /* 0x610db8000: sd_lane_25g_29 */
2505 { TARGET_SD_LANE_25G + 5, 0x5b8000 }, /* 0x610dc0000: sd_lane_25g_30 */
2506 { TARGET_SD_LANE_25G + 6, 0x5c0000 }, /* 0x610dc8000: sd_lane_25g_31 */
2507 { TARGET_SD_LANE_25G + 7, 0x5c8000 }, /* 0x610dd0000: sd_lane_25g_32 */
2508};
2509
2510/* Client lookup function, uses serdes index */
2511static struct phy *sparx5_serdes_xlate(struct device *dev,
2512 struct of_phandle_args *args)
2513{
2514 struct sparx5_serdes_private *priv = dev_get_drvdata(dev);
2515 int idx;
2516 unsigned int sidx;
2517
2518 if (args->args_count != 1)
2519 return ERR_PTR(-EINVAL);
2520
2521 sidx = args->args[0];
2522
2523 /* Check validity: ERR_PTR(-ENODEV) if not valid */
2524 for (idx = 0; idx < SPX5_SERDES_MAX; idx++) {
2525 struct sparx5_serdes_macro *macro =
2526 phy_get_drvdata(priv->phys[idx]);
2527
2528 if (sidx != macro->sidx)
2529 continue;
2530
2531 return priv->phys[idx];
2532 }
2533 return ERR_PTR(-ENODEV);
2534}
2535
2536static int sparx5_serdes_probe(struct platform_device *pdev)
2537{
2538 struct device_node *np = pdev->dev.of_node;
2539 struct sparx5_serdes_private *priv;
2540 struct phy_provider *provider;
2541 struct resource *iores;
2542 void __iomem *iomem;
2543 unsigned long clock;
2544 struct clk *clk;
2545 int idx;
2546 int err;
2547
2548 if (!np && !pdev->dev.platform_data)
2549 return -ENODEV;
2550
2551 priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
2552 if (!priv)
2553 return -ENOMEM;
2554
2555 platform_set_drvdata(pdev, priv);
2556 priv->dev = &pdev->dev;
2557
2558 /* Get coreclock */
2559 clk = devm_clk_get(priv->dev, NULL);
2560 if (IS_ERR(clk)) {
2561 dev_err(priv->dev, "Failed to get coreclock\n");
2562 return PTR_ERR(clk);
2563 }
2564 clock = clk_get_rate(clk);
2565 if (clock == 0) {
2566 dev_err(priv->dev, "Invalid coreclock %lu\n", clock);
2567 return -EINVAL;
2568 }
2569 priv->coreclock = clock;
2570
2571 iores = platform_get_resource(pdev, IORESOURCE_MEM, 0);
2572 if (!iores) {
2573 dev_err(priv->dev, "Invalid resource\n");
2574 return -EINVAL;
2575 }
2576 iomem = devm_ioremap(priv->dev, iores->start, resource_size(iores));
2577 if (!iomem) {
2578 dev_err(priv->dev, "Unable to get serdes registers: %s\n",
2579 iores->name);
2580 return -ENOMEM;
2581 }
2582 for (idx = 0; idx < ARRAY_SIZE(sparx5_serdes_iomap); idx++) {
2583 struct sparx5_serdes_io_resource *iomap = &sparx5_serdes_iomap[idx];
2584
2585 priv->regs[iomap->id] = iomem + iomap->offset;
2586 }
2587 for (idx = 0; idx < SPX5_SERDES_MAX; idx++) {
2588 err = sparx5_phy_create(priv, idx, &priv->phys[idx]);
2589 if (err)
2590 return err;
2591 }
2592
2593 /* Power down all CMUs by default */
2594 sparx5_serdes_cmu_power_off(priv);
2595
2596 provider = devm_of_phy_provider_register(priv->dev, sparx5_serdes_xlate);
2597
2598 return PTR_ERR_OR_ZERO(provider);
2599}
2600
2601static const struct of_device_id sparx5_serdes_match[] = {
2602 { .compatible = "microchip,sparx5-serdes" },
2603 { }
2604};
2605MODULE_DEVICE_TABLE(of, sparx5_serdes_match);
2606
2607static struct platform_driver sparx5_serdes_driver = {
2608 .probe = sparx5_serdes_probe,
2609 .driver = {
2610 .name = "sparx5-serdes",
2611 .of_match_table = sparx5_serdes_match,
2612 },
2613};
2614
2615module_platform_driver(sparx5_serdes_driver);
2616
2617MODULE_DESCRIPTION("Microchip Sparx5 switch serdes driver");
2618MODULE_AUTHOR("Steen Hegelund <steen.hegelund@microchip.com>");
2619MODULE_LICENSE("GPL v2");
1// SPDX-License-Identifier: GPL-2.0-or-later
2/* Microchip Sparx5 Switch SerDes driver
3 *
4 * Copyright (c) 2020 Microchip Technology Inc. and its subsidiaries.
5 *
6 * The Sparx5 Chip Register Model can be browsed at this location:
7 * https://github.com/microchip-ung/sparx-5_reginfo
8 * and the datasheet is available here:
9 * https://ww1.microchip.com/downloads/en/DeviceDoc/SparX-5_Family_L2L3_Enterprise_10G_Ethernet_Switches_Datasheet_00003822B.pdf
10 */
11#include <linux/printk.h>
12#include <linux/module.h>
13#include <linux/device.h>
14#include <linux/netdevice.h>
15#include <linux/platform_device.h>
16#include <linux/of.h>
17#include <linux/io.h>
18#include <linux/clk.h>
19#include <linux/phy.h>
20#include <linux/phy/phy.h>
21
22#include "sparx5_serdes.h"
23
24#define SPX5_SERDES_10G_START 13
25#define SPX5_SERDES_25G_START 25
26#define SPX5_SERDES_6G10G_CNT SPX5_SERDES_25G_START
27
28#define LAN969X_SERDES_10G_CNT 10
29
30/* Optimal power settings from GUC */
31#define SPX5_SERDES_QUIET_MODE_VAL 0x01ef4e0c
32
33/* Register target sizes */
34const unsigned int sparx5_serdes_tsize[TSIZE_LAST] = {
35 [TC_SD10G_LANE] = 12,
36 [TC_SD_CMU] = 14,
37 [TC_SD_CMU_CFG] = 14,
38 [TC_SD_LANE] = 25,
39};
40
41const unsigned int lan969x_serdes_tsize[TSIZE_LAST] = {
42 [TC_SD10G_LANE] = 10,
43 [TC_SD_CMU] = 6,
44 [TC_SD_CMU_CFG] = 6,
45 [TC_SD_LANE] = 10,
46};
47
48/* Pointer to the register target size table */
49const unsigned int *tsize;
50
51enum sparx5_sd25g28_mode_preset_type {
52 SPX5_SD25G28_MODE_PRESET_25000,
53 SPX5_SD25G28_MODE_PRESET_10000,
54 SPX5_SD25G28_MODE_PRESET_5000,
55 SPX5_SD25G28_MODE_PRESET_SD_2G5,
56 SPX5_SD25G28_MODE_PRESET_1000BASEX,
57};
58
59enum sparx5_sd10g28_mode_preset_type {
60 SPX5_SD10G28_MODE_PRESET_10000,
61 SPX5_SD10G28_MODE_PRESET_SFI_5000_6G,
62 SPX5_SD10G28_MODE_PRESET_SFI_5000_10G,
63 SPX5_SD10G28_MODE_PRESET_QSGMII,
64 SPX5_SD10G28_MODE_PRESET_SD_2G5,
65 SPX5_SD10G28_MODE_PRESET_1000BASEX,
66};
67
68struct sparx5_serdes_io_resource {
69 enum sparx5_serdes_target id;
70 phys_addr_t offset;
71};
72
73struct sparx5_sd25g28_mode_preset {
74 u8 bitwidth;
75 u8 tx_pre_div;
76 u8 fifo_ck_div;
77 u8 pre_divsel;
78 u8 vco_div_mode;
79 u8 sel_div;
80 u8 ck_bitwidth;
81 u8 subrate;
82 u8 com_txcal_en;
83 u8 com_tx_reserve_msb;
84 u8 com_tx_reserve_lsb;
85 u8 cfg_itx_ipcml_base;
86 u8 tx_reserve_lsb;
87 u8 tx_reserve_msb;
88 u8 bw;
89 u8 rxterm;
90 u8 dfe_tap;
91 u8 dfe_enable;
92 bool txmargin;
93 u8 cfg_ctle_rstn;
94 u8 r_dfe_rstn;
95 u8 cfg_pi_bw_3_0;
96 u8 tx_tap_dly;
97 u8 tx_tap_adv;
98};
99
100struct sparx5_sd25g28_media_preset {
101 u8 cfg_eq_c_force_3_0;
102 u8 cfg_vga_ctrl_byp_4_0;
103 u8 cfg_eq_r_force_3_0;
104 u8 cfg_en_adv;
105 u8 cfg_en_main;
106 u8 cfg_en_dly;
107 u8 cfg_tap_adv_3_0;
108 u8 cfg_tap_main;
109 u8 cfg_tap_dly_4_0;
110 u8 cfg_alos_thr_2_0;
111};
112
113struct sparx5_sd25g28_args {
114 u8 if_width; /* UDL if-width: 10/16/20/32/64 */
115 bool skip_cmu_cfg:1; /* Enable/disable CMU cfg */
116 enum sparx5_10g28cmu_mode cmu_sel; /* Device/Mode serdes uses */
117 bool no_pwrcycle:1; /* Omit initial power-cycle */
118 bool txinvert:1; /* Enable inversion of output data */
119 bool rxinvert:1; /* Enable inversion of input data */
120 u16 txswing; /* Set output level */
121 u8 rate; /* Rate of network interface */
122 u8 pi_bw_gen1;
123 u8 duty_cycle; /* Set output level to half/full */
124 bool mute:1; /* Mute Output Buffer */
125 bool reg_rst:1;
126 u8 com_pll_reserve;
127};
128
129struct sparx5_sd25g28_params {
130 u8 reg_rst;
131 u8 cfg_jc_byp;
132 u8 cfg_common_reserve_7_0;
133 u8 r_reg_manual;
134 u8 r_d_width_ctrl_from_hwt;
135 u8 r_d_width_ctrl_2_0;
136 u8 r_txfifo_ck_div_pmad_2_0;
137 u8 r_rxfifo_ck_div_pmad_2_0;
138 u8 cfg_pll_lol_set;
139 u8 cfg_vco_div_mode_1_0;
140 u8 cfg_pre_divsel_1_0;
141 u8 cfg_sel_div_3_0;
142 u8 cfg_vco_start_code_3_0;
143 u8 cfg_pma_tx_ck_bitwidth_2_0;
144 u8 cfg_tx_prediv_1_0;
145 u8 cfg_rxdiv_sel_2_0;
146 u8 cfg_tx_subrate_2_0;
147 u8 cfg_rx_subrate_2_0;
148 u8 r_multi_lane_mode;
149 u8 cfg_cdrck_en;
150 u8 cfg_dfeck_en;
151 u8 cfg_dfe_pd;
152 u8 cfg_dfedmx_pd;
153 u8 cfg_dfetap_en_5_1;
154 u8 cfg_dmux_pd;
155 u8 cfg_dmux_clk_pd;
156 u8 cfg_erramp_pd;
157 u8 cfg_pi_dfe_en;
158 u8 cfg_pi_en;
159 u8 cfg_pd_ctle;
160 u8 cfg_summer_en;
161 u8 cfg_pmad_ck_pd;
162 u8 cfg_pd_clk;
163 u8 cfg_pd_cml;
164 u8 cfg_pd_driver;
165 u8 cfg_rx_reg_pu;
166 u8 cfg_pd_rms_det;
167 u8 cfg_dcdr_pd;
168 u8 cfg_ecdr_pd;
169 u8 cfg_pd_sq;
170 u8 cfg_itx_ipdriver_base_2_0;
171 u8 cfg_tap_dly_4_0;
172 u8 cfg_tap_main;
173 u8 cfg_en_main;
174 u8 cfg_tap_adv_3_0;
175 u8 cfg_en_adv;
176 u8 cfg_en_dly;
177 u8 cfg_iscan_en;
178 u8 l1_pcs_en_fast_iscan;
179 u8 l0_cfg_bw_1_0;
180 u8 l0_cfg_txcal_en;
181 u8 cfg_en_dummy;
182 u8 cfg_pll_reserve_3_0;
183 u8 l0_cfg_tx_reserve_15_8;
184 u8 l0_cfg_tx_reserve_7_0;
185 u8 cfg_tx_reserve_15_8;
186 u8 cfg_tx_reserve_7_0;
187 u8 cfg_bw_1_0;
188 u8 cfg_txcal_man_en;
189 u8 cfg_phase_man_4_0;
190 u8 cfg_quad_man_1_0;
191 u8 cfg_txcal_shift_code_5_0;
192 u8 cfg_txcal_valid_sel_3_0;
193 u8 cfg_txcal_en;
194 u8 cfg_cdr_kf_2_0;
195 u8 cfg_cdr_m_7_0;
196 u8 cfg_pi_bw_3_0;
197 u8 cfg_pi_steps_1_0;
198 u8 cfg_dis_2ndorder;
199 u8 cfg_ctle_rstn;
200 u8 r_dfe_rstn;
201 u8 cfg_alos_thr_2_0;
202 u8 cfg_itx_ipcml_base_1_0;
203 u8 cfg_rx_reserve_7_0;
204 u8 cfg_rx_reserve_15_8;
205 u8 cfg_rxterm_2_0;
206 u8 cfg_fom_selm;
207 u8 cfg_rx_sp_ctle_1_0;
208 u8 cfg_isel_ctle_1_0;
209 u8 cfg_vga_ctrl_byp_4_0;
210 u8 cfg_vga_byp;
211 u8 cfg_agc_adpt_byp;
212 u8 cfg_eqr_byp;
213 u8 cfg_eqr_force_3_0;
214 u8 cfg_eqc_force_3_0;
215 u8 cfg_sum_setcm_en;
216 u8 cfg_init_pos_iscan_6_0;
217 u8 cfg_init_pos_ipi_6_0;
218 u8 cfg_dfedig_m_2_0;
219 u8 cfg_en_dfedig;
220 u8 cfg_pi_DFE_en;
221 u8 cfg_tx2rx_lp_en;
222 u8 cfg_txlb_en;
223 u8 cfg_rx2tx_lp_en;
224 u8 cfg_rxlb_en;
225 u8 r_tx_pol_inv;
226 u8 r_rx_pol_inv;
227};
228
229struct sparx5_sd10g28_media_preset {
230 u8 cfg_en_adv;
231 u8 cfg_en_main;
232 u8 cfg_en_dly;
233 u8 cfg_tap_adv_3_0;
234 u8 cfg_tap_main;
235 u8 cfg_tap_dly_4_0;
236 u8 cfg_vga_ctrl_3_0;
237 u8 cfg_vga_cp_2_0;
238 u8 cfg_eq_res_3_0;
239 u8 cfg_eq_r_byp;
240 u8 cfg_eq_c_force_3_0;
241 u8 cfg_alos_thr_3_0;
242};
243
244struct sparx5_sd10g28_mode_preset {
245 u8 bwidth; /* interface width: 10/16/20/32/64 */
246 enum sparx5_10g28cmu_mode cmu_sel; /* Device/Mode serdes uses */
247 u8 rate; /* Rate of network interface */
248 u8 dfe_tap;
249 u8 dfe_enable;
250 u8 pi_bw_gen1;
251 u8 duty_cycle; /* Set output level to half/full */
252};
253
254struct sparx5_sd10g28_args {
255 bool skip_cmu_cfg:1; /* Enable/disable CMU cfg */
256 bool no_pwrcycle:1; /* Omit initial power-cycle */
257 bool txinvert:1; /* Enable inversion of output data */
258 bool rxinvert:1; /* Enable inversion of input data */
259 bool txmargin:1; /* Set output level to half/full */
260 u16 txswing; /* Set output level */
261 bool mute:1; /* Mute Output Buffer */
262 bool is_6g:1;
263 bool reg_rst:1;
264};
265
266struct sparx5_sd10g28_params {
267 u8 cmu_sel;
268 u8 is_6g;
269 u8 skip_cmu_cfg;
270 u8 cfg_lane_reserve_7_0;
271 u8 cfg_ssc_rtl_clk_sel;
272 u8 cfg_lane_reserve_15_8;
273 u8 cfg_txrate_1_0;
274 u8 cfg_rxrate_1_0;
275 u8 r_d_width_ctrl_2_0;
276 u8 cfg_pma_tx_ck_bitwidth_2_0;
277 u8 cfg_rxdiv_sel_2_0;
278 u8 r_pcs2pma_phymode_4_0;
279 u8 cfg_lane_id_2_0;
280 u8 cfg_cdrck_en;
281 u8 cfg_dfeck_en;
282 u8 cfg_dfe_pd;
283 u8 cfg_dfetap_en_5_1;
284 u8 cfg_erramp_pd;
285 u8 cfg_pi_DFE_en;
286 u8 cfg_pi_en;
287 u8 cfg_pd_ctle;
288 u8 cfg_summer_en;
289 u8 cfg_pd_rx_cktree;
290 u8 cfg_pd_clk;
291 u8 cfg_pd_cml;
292 u8 cfg_pd_driver;
293 u8 cfg_rx_reg_pu;
294 u8 cfg_d_cdr_pd;
295 u8 cfg_pd_sq;
296 u8 cfg_rxdet_en;
297 u8 cfg_rxdet_str;
298 u8 r_multi_lane_mode;
299 u8 cfg_en_adv;
300 u8 cfg_en_main;
301 u8 cfg_en_dly;
302 u8 cfg_tap_adv_3_0;
303 u8 cfg_tap_main;
304 u8 cfg_tap_dly_4_0;
305 u8 cfg_vga_ctrl_3_0;
306 u8 cfg_vga_cp_2_0;
307 u8 cfg_eq_res_3_0;
308 u8 cfg_eq_r_byp;
309 u8 cfg_eq_c_force_3_0;
310 u8 cfg_en_dfedig;
311 u8 cfg_sum_setcm_en;
312 u8 cfg_en_preemph;
313 u8 cfg_itx_ippreemp_base_1_0;
314 u8 cfg_itx_ipdriver_base_2_0;
315 u8 cfg_ibias_tune_reserve_5_0;
316 u8 cfg_txswing_half;
317 u8 cfg_dis_2nd_order;
318 u8 cfg_rx_ssc_lh;
319 u8 cfg_pi_floop_steps_1_0;
320 u8 cfg_pi_ext_dac_23_16;
321 u8 cfg_pi_ext_dac_15_8;
322 u8 cfg_iscan_ext_dac_7_0;
323 u8 cfg_cdr_kf_gen1_2_0;
324 u8 cfg_cdr_kf_gen2_2_0;
325 u8 cfg_cdr_kf_gen3_2_0;
326 u8 cfg_cdr_kf_gen4_2_0;
327 u8 r_cdr_m_gen1_7_0;
328 u8 cfg_pi_bw_gen1_3_0;
329 u8 cfg_pi_bw_gen2;
330 u8 cfg_pi_bw_gen3;
331 u8 cfg_pi_bw_gen4;
332 u8 cfg_pi_ext_dac_7_0;
333 u8 cfg_pi_steps;
334 u8 cfg_mp_max_3_0;
335 u8 cfg_rstn_dfedig;
336 u8 cfg_alos_thr_3_0;
337 u8 cfg_predrv_slewrate_1_0;
338 u8 cfg_itx_ipcml_base_1_0;
339 u8 cfg_ip_pre_base_1_0;
340 u8 r_cdr_m_gen2_7_0;
341 u8 r_cdr_m_gen3_7_0;
342 u8 r_cdr_m_gen4_7_0;
343 u8 r_en_auto_cdr_rstn;
344 u8 cfg_oscal_afe;
345 u8 cfg_pd_osdac_afe;
346 u8 cfg_resetb_oscal_afe[2];
347 u8 cfg_center_spreading;
348 u8 cfg_m_cnt_maxval_4_0;
349 u8 cfg_ncnt_maxval_7_0;
350 u8 cfg_ncnt_maxval_10_8;
351 u8 cfg_ssc_en;
352 u8 cfg_tx2rx_lp_en;
353 u8 cfg_txlb_en;
354 u8 cfg_rx2tx_lp_en;
355 u8 cfg_rxlb_en;
356 u8 r_tx_pol_inv;
357 u8 r_rx_pol_inv;
358 u8 fx_100;
359};
360
361static struct sparx5_sd25g28_media_preset media_presets_25g[] = {
362 { /* ETH_MEDIA_DEFAULT */
363 .cfg_en_adv = 0,
364 .cfg_en_main = 1,
365 .cfg_en_dly = 0,
366 .cfg_tap_adv_3_0 = 0,
367 .cfg_tap_main = 1,
368 .cfg_tap_dly_4_0 = 0,
369 .cfg_eq_c_force_3_0 = 0xf,
370 .cfg_vga_ctrl_byp_4_0 = 4,
371 .cfg_eq_r_force_3_0 = 12,
372 .cfg_alos_thr_2_0 = 7,
373 },
374 { /* ETH_MEDIA_SR */
375 .cfg_en_adv = 1,
376 .cfg_en_main = 1,
377 .cfg_en_dly = 1,
378 .cfg_tap_adv_3_0 = 0,
379 .cfg_tap_main = 1,
380 .cfg_tap_dly_4_0 = 0x10,
381 .cfg_eq_c_force_3_0 = 0xf,
382 .cfg_vga_ctrl_byp_4_0 = 8,
383 .cfg_eq_r_force_3_0 = 4,
384 .cfg_alos_thr_2_0 = 0,
385 },
386 { /* ETH_MEDIA_DAC */
387 .cfg_en_adv = 0,
388 .cfg_en_main = 1,
389 .cfg_en_dly = 0,
390 .cfg_tap_adv_3_0 = 0,
391 .cfg_tap_main = 1,
392 .cfg_tap_dly_4_0 = 0,
393 .cfg_eq_c_force_3_0 = 0xf,
394 .cfg_vga_ctrl_byp_4_0 = 8,
395 .cfg_eq_r_force_3_0 = 0xc,
396 .cfg_alos_thr_2_0 = 0,
397 },
398};
399
400static struct sparx5_sd25g28_mode_preset mode_presets_25g[] = {
401 { /* SPX5_SD25G28_MODE_PRESET_25000 */
402 .bitwidth = 40,
403 .tx_pre_div = 0,
404 .fifo_ck_div = 0,
405 .pre_divsel = 1,
406 .vco_div_mode = 0,
407 .sel_div = 15,
408 .ck_bitwidth = 3,
409 .subrate = 0,
410 .com_txcal_en = 0,
411 .com_tx_reserve_msb = (0x26 << 1),
412 .com_tx_reserve_lsb = 0xf0,
413 .cfg_itx_ipcml_base = 0,
414 .tx_reserve_msb = 0xcc,
415 .tx_reserve_lsb = 0xfe,
416 .bw = 3,
417 .rxterm = 0,
418 .dfe_enable = 1,
419 .dfe_tap = 0x1f,
420 .txmargin = 1,
421 .cfg_ctle_rstn = 1,
422 .r_dfe_rstn = 1,
423 .cfg_pi_bw_3_0 = 0,
424 .tx_tap_dly = 8,
425 .tx_tap_adv = 0xc,
426 },
427 { /* SPX5_SD25G28_MODE_PRESET_10000 */
428 .bitwidth = 64,
429 .tx_pre_div = 0,
430 .fifo_ck_div = 2,
431 .pre_divsel = 0,
432 .vco_div_mode = 1,
433 .sel_div = 9,
434 .ck_bitwidth = 0,
435 .subrate = 0,
436 .com_txcal_en = 1,
437 .com_tx_reserve_msb = (0x20 << 1),
438 .com_tx_reserve_lsb = 0x40,
439 .cfg_itx_ipcml_base = 0,
440 .tx_reserve_msb = 0x4c,
441 .tx_reserve_lsb = 0x44,
442 .bw = 3,
443 .cfg_pi_bw_3_0 = 0,
444 .rxterm = 3,
445 .dfe_enable = 1,
446 .dfe_tap = 0x1f,
447 .txmargin = 0,
448 .cfg_ctle_rstn = 1,
449 .r_dfe_rstn = 1,
450 .tx_tap_dly = 0,
451 .tx_tap_adv = 0,
452 },
453 { /* SPX5_SD25G28_MODE_PRESET_5000 */
454 .bitwidth = 64,
455 .tx_pre_div = 0,
456 .fifo_ck_div = 2,
457 .pre_divsel = 0,
458 .vco_div_mode = 2,
459 .sel_div = 9,
460 .ck_bitwidth = 0,
461 .subrate = 0,
462 .com_txcal_en = 1,
463 .com_tx_reserve_msb = (0x20 << 1),
464 .com_tx_reserve_lsb = 0,
465 .cfg_itx_ipcml_base = 0,
466 .tx_reserve_msb = 0xe,
467 .tx_reserve_lsb = 0x80,
468 .bw = 0,
469 .rxterm = 0,
470 .cfg_pi_bw_3_0 = 6,
471 .dfe_enable = 0,
472 .dfe_tap = 0,
473 .tx_tap_dly = 0,
474 .tx_tap_adv = 0,
475 },
476 { /* SPX5_SD25G28_MODE_PRESET_SD_2G5 */
477 .bitwidth = 10,
478 .tx_pre_div = 0,
479 .fifo_ck_div = 0,
480 .pre_divsel = 0,
481 .vco_div_mode = 1,
482 .sel_div = 6,
483 .ck_bitwidth = 3,
484 .subrate = 2,
485 .com_txcal_en = 1,
486 .com_tx_reserve_msb = (0x26 << 1),
487 .com_tx_reserve_lsb = (0xf << 4),
488 .cfg_itx_ipcml_base = 2,
489 .tx_reserve_msb = 0x8,
490 .tx_reserve_lsb = 0x8a,
491 .bw = 0,
492 .cfg_pi_bw_3_0 = 0,
493 .rxterm = (1 << 2),
494 .dfe_enable = 0,
495 .dfe_tap = 0,
496 .tx_tap_dly = 0,
497 .tx_tap_adv = 0,
498 },
499 { /* SPX5_SD25G28_MODE_PRESET_1000BASEX */
500 .bitwidth = 10,
501 .tx_pre_div = 0,
502 .fifo_ck_div = 1,
503 .pre_divsel = 0,
504 .vco_div_mode = 1,
505 .sel_div = 8,
506 .ck_bitwidth = 3,
507 .subrate = 3,
508 .com_txcal_en = 1,
509 .com_tx_reserve_msb = (0x26 << 1),
510 .com_tx_reserve_lsb = 0xf0,
511 .cfg_itx_ipcml_base = 0,
512 .tx_reserve_msb = 0x8,
513 .tx_reserve_lsb = 0xce,
514 .bw = 0,
515 .rxterm = 0,
516 .cfg_pi_bw_3_0 = 0,
517 .dfe_enable = 0,
518 .dfe_tap = 0,
519 .tx_tap_dly = 0,
520 .tx_tap_adv = 0,
521 },
522};
523
524static struct sparx5_sd10g28_media_preset media_presets_10g[] = {
525 { /* ETH_MEDIA_DEFAULT */
526 .cfg_en_adv = 0,
527 .cfg_en_main = 1,
528 .cfg_en_dly = 0,
529 .cfg_tap_adv_3_0 = 0,
530 .cfg_tap_main = 1,
531 .cfg_tap_dly_4_0 = 0,
532 .cfg_vga_ctrl_3_0 = 5,
533 .cfg_vga_cp_2_0 = 0,
534 .cfg_eq_res_3_0 = 0xa,
535 .cfg_eq_r_byp = 1,
536 .cfg_eq_c_force_3_0 = 0x8,
537 .cfg_alos_thr_3_0 = 0x3,
538 },
539 { /* ETH_MEDIA_SR */
540 .cfg_en_adv = 1,
541 .cfg_en_main = 1,
542 .cfg_en_dly = 1,
543 .cfg_tap_adv_3_0 = 0,
544 .cfg_tap_main = 1,
545 .cfg_tap_dly_4_0 = 0xc,
546 .cfg_vga_ctrl_3_0 = 0xa,
547 .cfg_vga_cp_2_0 = 0x4,
548 .cfg_eq_res_3_0 = 0xa,
549 .cfg_eq_r_byp = 1,
550 .cfg_eq_c_force_3_0 = 0xF,
551 .cfg_alos_thr_3_0 = 0x3,
552 },
553 { /* ETH_MEDIA_DAC */
554 .cfg_en_adv = 1,
555 .cfg_en_main = 1,
556 .cfg_en_dly = 1,
557 .cfg_tap_adv_3_0 = 12,
558 .cfg_tap_main = 1,
559 .cfg_tap_dly_4_0 = 8,
560 .cfg_vga_ctrl_3_0 = 0xa,
561 .cfg_vga_cp_2_0 = 4,
562 .cfg_eq_res_3_0 = 0xa,
563 .cfg_eq_r_byp = 1,
564 .cfg_eq_c_force_3_0 = 0xf,
565 .cfg_alos_thr_3_0 = 0x0,
566 }
567};
568
569static struct sparx5_sd10g28_mode_preset mode_presets_10g[] = {
570 { /* SPX5_SD10G28_MODE_PRESET_10000 */
571 .bwidth = 64,
572 .cmu_sel = SPX5_SD10G28_CMU_MAIN,
573 .rate = 0x0,
574 .dfe_enable = 1,
575 .dfe_tap = 0x1f,
576 .pi_bw_gen1 = 0x0,
577 .duty_cycle = 0x2,
578 },
579 { /* SPX5_SD10G28_MODE_PRESET_SFI_5000_6G */
580 .bwidth = 16,
581 .cmu_sel = SPX5_SD10G28_CMU_MAIN,
582 .rate = 0x1,
583 .dfe_enable = 0,
584 .dfe_tap = 0,
585 .pi_bw_gen1 = 0x5,
586 .duty_cycle = 0x0,
587 },
588 { /* SPX5_SD10G28_MODE_PRESET_SFI_5000_10G */
589 .bwidth = 64,
590 .cmu_sel = SPX5_SD10G28_CMU_MAIN,
591 .rate = 0x1,
592 .dfe_enable = 0,
593 .dfe_tap = 0,
594 .pi_bw_gen1 = 0x5,
595 .duty_cycle = 0x0,
596 },
597 { /* SPX5_SD10G28_MODE_PRESET_QSGMII */
598 .bwidth = 20,
599 .cmu_sel = SPX5_SD10G28_CMU_AUX1,
600 .rate = 0x1,
601 .dfe_enable = 0,
602 .dfe_tap = 0,
603 .pi_bw_gen1 = 0x5,
604 .duty_cycle = 0x0,
605 },
606 { /* SPX5_SD10G28_MODE_PRESET_SD_2G5 */
607 .bwidth = 10,
608 .cmu_sel = SPX5_SD10G28_CMU_AUX2,
609 .rate = 0x2,
610 .dfe_enable = 0,
611 .dfe_tap = 0,
612 .pi_bw_gen1 = 0x7,
613 .duty_cycle = 0x0,
614 },
615 { /* SPX5_SD10G28_MODE_PRESET_1000BASEX */
616 .bwidth = 10,
617 .cmu_sel = SPX5_SD10G28_CMU_AUX1,
618 .rate = 0x3,
619 .dfe_enable = 0,
620 .dfe_tap = 0,
621 .pi_bw_gen1 = 0x7,
622 .duty_cycle = 0x0,
623 },
624};
625
626/* map from SD25G28 interface width to configuration value */
627static u8 sd25g28_get_iw_setting(struct device *dev, const u8 interface_width)
628{
629 switch (interface_width) {
630 case 10: return 0;
631 case 16: return 1;
632 case 32: return 3;
633 case 40: return 4;
634 case 64: return 5;
635 default:
636 dev_err(dev, "%s: Illegal value %d for interface width\n",
637 __func__, interface_width);
638 }
639 return 0;
640}
641
642/* map from SD10G28 interface width to configuration value */
643static u8 sd10g28_get_iw_setting(struct device *dev, const u8 interface_width)
644{
645 switch (interface_width) {
646 case 10: return 0;
647 case 16: return 1;
648 case 20: return 2;
649 case 32: return 3;
650 case 40: return 4;
651 case 64: return 7;
652 default:
653 dev_err(dev, "%s: Illegal value %d for interface width\n", __func__,
654 interface_width);
655 return 0;
656 }
657}
658
659static int sparx5_sd10g25_get_mode_preset(struct sparx5_serdes_macro *macro,
660 struct sparx5_sd25g28_mode_preset *mode)
661{
662 switch (macro->serdesmode) {
663 case SPX5_SD_MODE_SFI:
664 if (macro->speed == SPEED_25000)
665 *mode = mode_presets_25g[SPX5_SD25G28_MODE_PRESET_25000];
666 else if (macro->speed == SPEED_10000)
667 *mode = mode_presets_25g[SPX5_SD25G28_MODE_PRESET_10000];
668 else if (macro->speed == SPEED_5000)
669 *mode = mode_presets_25g[SPX5_SD25G28_MODE_PRESET_5000];
670 break;
671 case SPX5_SD_MODE_2G5:
672 *mode = mode_presets_25g[SPX5_SD25G28_MODE_PRESET_SD_2G5];
673 break;
674 case SPX5_SD_MODE_1000BASEX:
675 *mode = mode_presets_25g[SPX5_SD25G28_MODE_PRESET_1000BASEX];
676 break;
677 case SPX5_SD_MODE_100FX:
678 /* Not supported */
679 return -EINVAL;
680 default:
681 *mode = mode_presets_25g[SPX5_SD25G28_MODE_PRESET_25000];
682 break;
683 }
684 return 0;
685}
686
687static int sparx5_sd10g28_get_mode_preset(struct sparx5_serdes_macro *macro,
688 struct sparx5_sd10g28_mode_preset *mode,
689 struct sparx5_sd10g28_args *args)
690{
691 switch (macro->serdesmode) {
692 case SPX5_SD_MODE_SFI:
693 if (macro->speed == SPEED_10000) {
694 *mode = mode_presets_10g[SPX5_SD10G28_MODE_PRESET_10000];
695 } else if (macro->speed == SPEED_5000) {
696 if (args->is_6g)
697 *mode = mode_presets_10g[SPX5_SD10G28_MODE_PRESET_SFI_5000_6G];
698 else
699 *mode = mode_presets_10g[SPX5_SD10G28_MODE_PRESET_SFI_5000_10G];
700 } else {
701 dev_err(macro->priv->dev, "%s: Illegal speed: %02u, sidx: %02u, mode (%u)",
702 __func__, macro->speed, macro->sidx,
703 macro->serdesmode);
704 return -EINVAL;
705 }
706 break;
707 case SPX5_SD_MODE_QSGMII:
708 *mode = mode_presets_10g[SPX5_SD10G28_MODE_PRESET_QSGMII];
709 break;
710 case SPX5_SD_MODE_2G5:
711 *mode = mode_presets_10g[SPX5_SD10G28_MODE_PRESET_SD_2G5];
712 break;
713 case SPX5_SD_MODE_100FX:
714 case SPX5_SD_MODE_1000BASEX:
715 *mode = mode_presets_10g[SPX5_SD10G28_MODE_PRESET_1000BASEX];
716 break;
717 default:
718 *mode = mode_presets_10g[SPX5_SD10G28_MODE_PRESET_10000];
719 break;
720 }
721 return 0;
722}
723
724static void sparx5_sd25g28_get_params(struct sparx5_serdes_macro *macro,
725 struct sparx5_sd25g28_media_preset *media,
726 struct sparx5_sd25g28_mode_preset *mode,
727 struct sparx5_sd25g28_args *args,
728 struct sparx5_sd25g28_params *params)
729{
730 u8 iw = sd25g28_get_iw_setting(macro->priv->dev, mode->bitwidth);
731 struct sparx5_sd25g28_params init = {
732 .r_d_width_ctrl_2_0 = iw,
733 .r_txfifo_ck_div_pmad_2_0 = mode->fifo_ck_div,
734 .r_rxfifo_ck_div_pmad_2_0 = mode->fifo_ck_div,
735 .cfg_vco_div_mode_1_0 = mode->vco_div_mode,
736 .cfg_pre_divsel_1_0 = mode->pre_divsel,
737 .cfg_sel_div_3_0 = mode->sel_div,
738 .cfg_vco_start_code_3_0 = 0,
739 .cfg_pma_tx_ck_bitwidth_2_0 = mode->ck_bitwidth,
740 .cfg_tx_prediv_1_0 = mode->tx_pre_div,
741 .cfg_rxdiv_sel_2_0 = mode->ck_bitwidth,
742 .cfg_tx_subrate_2_0 = mode->subrate,
743 .cfg_rx_subrate_2_0 = mode->subrate,
744 .r_multi_lane_mode = 0,
745 .cfg_cdrck_en = 1,
746 .cfg_dfeck_en = mode->dfe_enable,
747 .cfg_dfe_pd = mode->dfe_enable == 1 ? 0 : 1,
748 .cfg_dfedmx_pd = 1,
749 .cfg_dfetap_en_5_1 = mode->dfe_tap,
750 .cfg_dmux_pd = 0,
751 .cfg_dmux_clk_pd = 1,
752 .cfg_erramp_pd = mode->dfe_enable == 1 ? 0 : 1,
753 .cfg_pi_DFE_en = mode->dfe_enable,
754 .cfg_pi_en = 1,
755 .cfg_pd_ctle = 0,
756 .cfg_summer_en = 1,
757 .cfg_pmad_ck_pd = 0,
758 .cfg_pd_clk = 0,
759 .cfg_pd_cml = 0,
760 .cfg_pd_driver = 0,
761 .cfg_rx_reg_pu = 1,
762 .cfg_pd_rms_det = 1,
763 .cfg_dcdr_pd = 0,
764 .cfg_ecdr_pd = 1,
765 .cfg_pd_sq = 1,
766 .cfg_itx_ipdriver_base_2_0 = mode->txmargin,
767 .cfg_tap_dly_4_0 = media->cfg_tap_dly_4_0,
768 .cfg_tap_main = media->cfg_tap_main,
769 .cfg_en_main = media->cfg_en_main,
770 .cfg_tap_adv_3_0 = media->cfg_tap_adv_3_0,
771 .cfg_en_adv = media->cfg_en_adv,
772 .cfg_en_dly = media->cfg_en_dly,
773 .cfg_iscan_en = 0,
774 .l1_pcs_en_fast_iscan = 0,
775 .l0_cfg_bw_1_0 = 0,
776 .cfg_en_dummy = 0,
777 .cfg_pll_reserve_3_0 = args->com_pll_reserve,
778 .l0_cfg_txcal_en = mode->com_txcal_en,
779 .l0_cfg_tx_reserve_15_8 = mode->com_tx_reserve_msb,
780 .l0_cfg_tx_reserve_7_0 = mode->com_tx_reserve_lsb,
781 .cfg_tx_reserve_15_8 = mode->tx_reserve_msb,
782 .cfg_tx_reserve_7_0 = mode->tx_reserve_lsb,
783 .cfg_bw_1_0 = mode->bw,
784 .cfg_txcal_man_en = 1,
785 .cfg_phase_man_4_0 = 0,
786 .cfg_quad_man_1_0 = 0,
787 .cfg_txcal_shift_code_5_0 = 2,
788 .cfg_txcal_valid_sel_3_0 = 4,
789 .cfg_txcal_en = 0,
790 .cfg_cdr_kf_2_0 = 1,
791 .cfg_cdr_m_7_0 = 6,
792 .cfg_pi_bw_3_0 = mode->cfg_pi_bw_3_0,
793 .cfg_pi_steps_1_0 = 0,
794 .cfg_dis_2ndorder = 1,
795 .cfg_ctle_rstn = mode->cfg_ctle_rstn,
796 .r_dfe_rstn = mode->r_dfe_rstn,
797 .cfg_alos_thr_2_0 = media->cfg_alos_thr_2_0,
798 .cfg_itx_ipcml_base_1_0 = mode->cfg_itx_ipcml_base,
799 .cfg_rx_reserve_7_0 = 0xbf,
800 .cfg_rx_reserve_15_8 = 0x61,
801 .cfg_rxterm_2_0 = mode->rxterm,
802 .cfg_fom_selm = 0,
803 .cfg_rx_sp_ctle_1_0 = 0,
804 .cfg_isel_ctle_1_0 = 0,
805 .cfg_vga_ctrl_byp_4_0 = media->cfg_vga_ctrl_byp_4_0,
806 .cfg_vga_byp = 1,
807 .cfg_agc_adpt_byp = 1,
808 .cfg_eqr_byp = 1,
809 .cfg_eqr_force_3_0 = media->cfg_eq_r_force_3_0,
810 .cfg_eqc_force_3_0 = media->cfg_eq_c_force_3_0,
811 .cfg_sum_setcm_en = 1,
812 .cfg_pi_dfe_en = 1,
813 .cfg_init_pos_iscan_6_0 = 6,
814 .cfg_init_pos_ipi_6_0 = 9,
815 .cfg_dfedig_m_2_0 = 6,
816 .cfg_en_dfedig = mode->dfe_enable,
817 .r_d_width_ctrl_from_hwt = 0,
818 .r_reg_manual = 1,
819 .reg_rst = args->reg_rst,
820 .cfg_jc_byp = 1,
821 .cfg_common_reserve_7_0 = 1,
822 .cfg_pll_lol_set = 1,
823 .cfg_tx2rx_lp_en = 0,
824 .cfg_txlb_en = 0,
825 .cfg_rx2tx_lp_en = 0,
826 .cfg_rxlb_en = 0,
827 .r_tx_pol_inv = args->txinvert,
828 .r_rx_pol_inv = args->rxinvert,
829 };
830
831 *params = init;
832}
833
834static void sparx5_sd10g28_get_params(struct sparx5_serdes_macro *macro,
835 struct sparx5_sd10g28_media_preset *media,
836 struct sparx5_sd10g28_mode_preset *mode,
837 struct sparx5_sd10g28_args *args,
838 struct sparx5_sd10g28_params *params)
839{
840 u8 iw = sd10g28_get_iw_setting(macro->priv->dev, mode->bwidth);
841 struct sparx5_sd10g28_params init = {
842 .skip_cmu_cfg = args->skip_cmu_cfg,
843 .is_6g = args->is_6g,
844 .cmu_sel = mode->cmu_sel,
845 .cfg_lane_reserve_7_0 = (mode->cmu_sel % 2) << 6,
846 .cfg_ssc_rtl_clk_sel = (mode->cmu_sel / 2),
847 .cfg_lane_reserve_15_8 = mode->duty_cycle,
848 .cfg_txrate_1_0 = mode->rate,
849 .cfg_rxrate_1_0 = mode->rate,
850 .fx_100 = macro->serdesmode == SPX5_SD_MODE_100FX,
851 .r_d_width_ctrl_2_0 = iw,
852 .cfg_pma_tx_ck_bitwidth_2_0 = iw,
853 .cfg_rxdiv_sel_2_0 = iw,
854 .r_pcs2pma_phymode_4_0 = 0,
855 .cfg_lane_id_2_0 = 0,
856 .cfg_cdrck_en = 1,
857 .cfg_dfeck_en = mode->dfe_enable,
858 .cfg_dfe_pd = (mode->dfe_enable == 1) ? 0 : 1,
859 .cfg_dfetap_en_5_1 = mode->dfe_tap,
860 .cfg_erramp_pd = (mode->dfe_enable == 1) ? 0 : 1,
861 .cfg_pi_DFE_en = mode->dfe_enable,
862 .cfg_pi_en = 1,
863 .cfg_pd_ctle = 0,
864 .cfg_summer_en = 1,
865 .cfg_pd_rx_cktree = 0,
866 .cfg_pd_clk = 0,
867 .cfg_pd_cml = 0,
868 .cfg_pd_driver = 0,
869 .cfg_rx_reg_pu = 1,
870 .cfg_d_cdr_pd = 0,
871 .cfg_pd_sq = mode->dfe_enable,
872 .cfg_rxdet_en = 0,
873 .cfg_rxdet_str = 0,
874 .r_multi_lane_mode = 0,
875 .cfg_en_adv = media->cfg_en_adv,
876 .cfg_en_main = 1,
877 .cfg_en_dly = media->cfg_en_dly,
878 .cfg_tap_adv_3_0 = media->cfg_tap_adv_3_0,
879 .cfg_tap_main = media->cfg_tap_main,
880 .cfg_tap_dly_4_0 = media->cfg_tap_dly_4_0,
881 .cfg_vga_ctrl_3_0 = media->cfg_vga_ctrl_3_0,
882 .cfg_vga_cp_2_0 = media->cfg_vga_cp_2_0,
883 .cfg_eq_res_3_0 = media->cfg_eq_res_3_0,
884 .cfg_eq_r_byp = media->cfg_eq_r_byp,
885 .cfg_eq_c_force_3_0 = media->cfg_eq_c_force_3_0,
886 .cfg_en_dfedig = mode->dfe_enable,
887 .cfg_sum_setcm_en = 1,
888 .cfg_en_preemph = 0,
889 .cfg_itx_ippreemp_base_1_0 = 0,
890 .cfg_itx_ipdriver_base_2_0 = (args->txswing >> 6),
891 .cfg_ibias_tune_reserve_5_0 = (args->txswing & 63),
892 .cfg_txswing_half = (args->txmargin),
893 .cfg_dis_2nd_order = 0x1,
894 .cfg_rx_ssc_lh = 0x0,
895 .cfg_pi_floop_steps_1_0 = 0x0,
896 .cfg_pi_ext_dac_23_16 = (1 << 5),
897 .cfg_pi_ext_dac_15_8 = (0 << 6),
898 .cfg_iscan_ext_dac_7_0 = (1 << 7) + 9,
899 .cfg_cdr_kf_gen1_2_0 = 1,
900 .cfg_cdr_kf_gen2_2_0 = 1,
901 .cfg_cdr_kf_gen3_2_0 = 1,
902 .cfg_cdr_kf_gen4_2_0 = 1,
903 .r_cdr_m_gen1_7_0 = 4,
904 .cfg_pi_bw_gen1_3_0 = mode->pi_bw_gen1,
905 .cfg_pi_bw_gen2 = mode->pi_bw_gen1,
906 .cfg_pi_bw_gen3 = mode->pi_bw_gen1,
907 .cfg_pi_bw_gen4 = mode->pi_bw_gen1,
908 .cfg_pi_ext_dac_7_0 = 3,
909 .cfg_pi_steps = 0,
910 .cfg_mp_max_3_0 = 1,
911 .cfg_rstn_dfedig = mode->dfe_enable,
912 .cfg_alos_thr_3_0 = media->cfg_alos_thr_3_0,
913 .cfg_predrv_slewrate_1_0 = 3,
914 .cfg_itx_ipcml_base_1_0 = 0,
915 .cfg_ip_pre_base_1_0 = 0,
916 .r_cdr_m_gen2_7_0 = 2,
917 .r_cdr_m_gen3_7_0 = 2,
918 .r_cdr_m_gen4_7_0 = 2,
919 .r_en_auto_cdr_rstn = 0,
920 .cfg_oscal_afe = 1,
921 .cfg_pd_osdac_afe = 0,
922 .cfg_resetb_oscal_afe[0] = 0,
923 .cfg_resetb_oscal_afe[1] = 1,
924 .cfg_center_spreading = 0,
925 .cfg_m_cnt_maxval_4_0 = 15,
926 .cfg_ncnt_maxval_7_0 = 32,
927 .cfg_ncnt_maxval_10_8 = 6,
928 .cfg_ssc_en = 1,
929 .cfg_tx2rx_lp_en = 0,
930 .cfg_txlb_en = 0,
931 .cfg_rx2tx_lp_en = 0,
932 .cfg_rxlb_en = 0,
933 .r_tx_pol_inv = args->txinvert,
934 .r_rx_pol_inv = args->rxinvert,
935 };
936
937 *params = init;
938}
939
940static int sparx5_cmu_apply_cfg(struct sparx5_serdes_private *priv,
941 u32 cmu_idx,
942 void __iomem *cmu_tgt,
943 void __iomem *cmu_cfg_tgt,
944 u32 spd10g)
945{
946 void __iomem **regs = priv->regs;
947 struct device *dev = priv->dev;
948 int value;
949
950 cmu_tgt = sdx5_inst_get(priv, TARGET_SD_CMU, cmu_idx);
951 cmu_cfg_tgt = sdx5_inst_get(priv, TARGET_SD_CMU_CFG, cmu_idx);
952
953 if (cmu_idx == 1 || cmu_idx == 4 || cmu_idx == 7 ||
954 cmu_idx == 10 || cmu_idx == 13) {
955 spd10g = 0;
956 }
957
958 sdx5_inst_rmw(SD_CMU_CFG_SD_CMU_CFG_EXT_CFG_RST_SET(1),
959 SD_CMU_CFG_SD_CMU_CFG_EXT_CFG_RST,
960 cmu_cfg_tgt,
961 SD_CMU_CFG_SD_CMU_CFG(cmu_idx));
962
963 sdx5_inst_rmw(SD_CMU_CFG_SD_CMU_CFG_EXT_CFG_RST_SET(0),
964 SD_CMU_CFG_SD_CMU_CFG_EXT_CFG_RST,
965 cmu_cfg_tgt,
966 SD_CMU_CFG_SD_CMU_CFG(cmu_idx));
967
968 sdx5_inst_rmw(SD_CMU_CFG_SD_CMU_CFG_CMU_RST_SET(1),
969 SD_CMU_CFG_SD_CMU_CFG_CMU_RST,
970 cmu_cfg_tgt,
971 SD_CMU_CFG_SD_CMU_CFG(cmu_idx));
972
973 sdx5_inst_rmw(SD_CMU_CMU_45_R_DWIDTHCTRL_FROM_HWT_SET(0x1) |
974 SD_CMU_CMU_45_R_REFCK_SSC_EN_FROM_HWT_SET(0x1) |
975 SD_CMU_CMU_45_R_LINK_BUF_EN_FROM_HWT_SET(0x1) |
976 SD_CMU_CMU_45_R_BIAS_EN_FROM_HWT_SET(0x1) |
977 SD_CMU_CMU_45_R_EN_RATECHG_CTRL_SET(0x0),
978 SD_CMU_CMU_45_R_DWIDTHCTRL_FROM_HWT |
979 SD_CMU_CMU_45_R_REFCK_SSC_EN_FROM_HWT |
980 SD_CMU_CMU_45_R_LINK_BUF_EN_FROM_HWT |
981 SD_CMU_CMU_45_R_BIAS_EN_FROM_HWT |
982 SD_CMU_CMU_45_R_EN_RATECHG_CTRL,
983 cmu_tgt,
984 SD_CMU_CMU_45(cmu_idx));
985
986 sdx5_inst_rmw(SD_CMU_CMU_47_R_PCS2PMA_PHYMODE_4_0_SET(0),
987 SD_CMU_CMU_47_R_PCS2PMA_PHYMODE_4_0,
988 cmu_tgt,
989 SD_CMU_CMU_47(cmu_idx));
990
991 sdx5_inst_rmw(SD_CMU_CMU_1B_CFG_RESERVE_7_0_SET(0),
992 SD_CMU_CMU_1B_CFG_RESERVE_7_0,
993 cmu_tgt,
994 SD_CMU_CMU_1B(cmu_idx));
995
996 sdx5_inst_rmw(SD_CMU_CMU_0D_CFG_JC_BYP_SET(0x1),
997 SD_CMU_CMU_0D_CFG_JC_BYP,
998 cmu_tgt,
999 SD_CMU_CMU_0D(cmu_idx));
1000
1001 sdx5_inst_rmw(SD_CMU_CMU_1F_CFG_VTUNE_SEL_SET(1),
1002 SD_CMU_CMU_1F_CFG_VTUNE_SEL,
1003 cmu_tgt,
1004 SD_CMU_CMU_1F(cmu_idx));
1005
1006 sdx5_inst_rmw(SD_CMU_CMU_00_CFG_PLL_TP_SEL_1_0_SET(3),
1007 SD_CMU_CMU_00_CFG_PLL_TP_SEL_1_0,
1008 cmu_tgt,
1009 SD_CMU_CMU_00(cmu_idx));
1010
1011 sdx5_inst_rmw(SD_CMU_CMU_05_CFG_BIAS_TP_SEL_1_0_SET(3),
1012 SD_CMU_CMU_05_CFG_BIAS_TP_SEL_1_0,
1013 cmu_tgt,
1014 SD_CMU_CMU_05(cmu_idx));
1015
1016 sdx5_inst_rmw(SD_CMU_CMU_30_R_PLL_DLOL_EN_SET(1),
1017 SD_CMU_CMU_30_R_PLL_DLOL_EN,
1018 cmu_tgt,
1019 SD_CMU_CMU_30(cmu_idx));
1020
1021 sdx5_inst_rmw(SD_CMU_CMU_09_CFG_SW_10G_SET(spd10g),
1022 SD_CMU_CMU_09_CFG_SW_10G,
1023 cmu_tgt,
1024 SD_CMU_CMU_09(cmu_idx));
1025
1026 sdx5_inst_rmw(SD_CMU_CFG_SD_CMU_CFG_CMU_RST_SET(0),
1027 SD_CMU_CFG_SD_CMU_CFG_CMU_RST,
1028 cmu_cfg_tgt,
1029 SD_CMU_CFG_SD_CMU_CFG(cmu_idx));
1030
1031 msleep(20);
1032
1033 sdx5_inst_rmw(SD_CMU_CMU_44_R_PLL_RSTN_SET(0),
1034 SD_CMU_CMU_44_R_PLL_RSTN,
1035 cmu_tgt,
1036 SD_CMU_CMU_44(cmu_idx));
1037
1038 sdx5_inst_rmw(SD_CMU_CMU_44_R_PLL_RSTN_SET(1),
1039 SD_CMU_CMU_44_R_PLL_RSTN,
1040 cmu_tgt,
1041 SD_CMU_CMU_44(cmu_idx));
1042
1043 msleep(20);
1044
1045 value = readl(sdx5_addr(regs, SD_CMU_CMU_E0(cmu_idx)));
1046 value = SD_CMU_CMU_E0_PLL_LOL_UDL_GET(value);
1047
1048 if (value) {
1049 dev_err(dev, "CMU PLL Loss of Lock: 0x%x\n", value);
1050 return -EINVAL;
1051 }
1052 sdx5_inst_rmw(SD_CMU_CMU_0D_CFG_PMA_TX_CK_PD_SET(0),
1053 SD_CMU_CMU_0D_CFG_PMA_TX_CK_PD,
1054 cmu_tgt,
1055 SD_CMU_CMU_0D(cmu_idx));
1056 return 0;
1057}
1058
1059static int sparx5_cmu_cfg(struct sparx5_serdes_private *priv, u32 cmu_idx)
1060{
1061 void __iomem *cmu_tgt, *cmu_cfg_tgt;
1062 u32 spd10g = 1;
1063
1064 if (cmu_idx == 1 || cmu_idx == 4 || cmu_idx == 7 ||
1065 cmu_idx == 10 || cmu_idx == 13) {
1066 spd10g = 0;
1067 }
1068
1069 cmu_tgt = sdx5_inst_get(priv, TARGET_SD_CMU, cmu_idx);
1070 cmu_cfg_tgt = sdx5_inst_get(priv, TARGET_SD_CMU_CFG, cmu_idx);
1071
1072 return sparx5_cmu_apply_cfg(priv, cmu_idx, cmu_tgt, cmu_cfg_tgt, spd10g);
1073}
1074
1075/* Map of 6G/10G serdes mode and index to CMU index. */
1076static const int
1077sparx5_serdes_cmu_map[SPX5_SD10G28_CMU_MAX][SPX5_SERDES_6G10G_CNT] = {
1078 [SPX5_SD10G28_CMU_MAIN] = { 2, 2, 2, 2, 2,
1079 2, 2, 2, 5, 5,
1080 5, 5, 5, 5, 5,
1081 5, 8, 11, 11, 11,
1082 11, 11, 11, 11, 11 },
1083 [SPX5_SD10G28_CMU_AUX1] = { 0, 0, 3, 3, 3,
1084 3, 3, 3, 3, 3,
1085 6, 6, 6, 6, 6,
1086 6, 6, 9, 9, 12,
1087 12, 12, 12, 12, 12 },
1088 [SPX5_SD10G28_CMU_AUX2] = { 1, 1, 1, 1, 4,
1089 4, 4, 4, 4, 4,
1090 4, 4, 7, 7, 7,
1091 7, 7, 10, 10, 10,
1092 10, 13, 13, 13, 13 },
1093 [SPX5_SD10G28_CMU_NONE] = { 1, 1, 1, 1, 4,
1094 4, 4, 4, 4, 4,
1095 4, 4, 7, 7, 7,
1096 7, 7, 10, 10, 10,
1097 10, 13, 13, 13, 13 },
1098};
1099
1100/* Get the index of the CMU which provides the clock for the specified serdes
1101 * mode and index.
1102 */
1103static int sparx5_serdes_cmu_get(enum sparx5_10g28cmu_mode mode, int sd_index)
1104{
1105 return sparx5_serdes_cmu_map[mode][sd_index];
1106}
1107
1108/* Map of 6G/10G serdes mode and index to CMU index. */
1109static const int
1110lan969x_serdes_cmu_map[SPX5_SD10G28_CMU_MAX][LAN969X_SERDES_10G_CNT] = {
1111 [SPX5_SD10G28_CMU_MAIN] = { 2, 2, 2, 2, 2,
1112 2, 2, 2, 5, 5 },
1113 [SPX5_SD10G28_CMU_AUX1] = { 0, 0, 3, 3, 3,
1114 3, 3, 3, 3, 3 },
1115 [SPX5_SD10G28_CMU_AUX2] = { 1, 1, 1, 1, 4,
1116 4, 4, 4, 4, 4 },
1117 [SPX5_SD10G28_CMU_NONE] = { 1, 1, 1, 1, 4,
1118 4, 4, 4, 4, 4 },
1119};
1120
1121static int lan969x_serdes_cmu_get(enum sparx5_10g28cmu_mode mode, int sd_index)
1122{
1123 return lan969x_serdes_cmu_map[mode][sd_index];
1124}
1125
1126static void sparx5_serdes_cmu_power_off(struct sparx5_serdes_private *priv)
1127{
1128 void __iomem *cmu_inst, *cmu_cfg_inst;
1129 int i;
1130
1131 /* Power down each CMU */
1132 for (i = 0; i < priv->data->consts.cmu_max; i++) {
1133 cmu_inst = sdx5_inst_get(priv, TARGET_SD_CMU, i);
1134 cmu_cfg_inst = sdx5_inst_get(priv, TARGET_SD_CMU_CFG, i);
1135
1136 sdx5_inst_rmw(SD_CMU_CFG_SD_CMU_CFG_EXT_CFG_RST_SET(0),
1137 SD_CMU_CFG_SD_CMU_CFG_EXT_CFG_RST, cmu_cfg_inst,
1138 SD_CMU_CFG_SD_CMU_CFG(0));
1139
1140 sdx5_inst_rmw(SD_CMU_CMU_05_CFG_REFCK_TERM_EN_SET(0),
1141 SD_CMU_CMU_05_CFG_REFCK_TERM_EN, cmu_inst,
1142 SD_CMU_CMU_05(0));
1143
1144 sdx5_inst_rmw(SD_CMU_CMU_09_CFG_EN_TX_CK_DN_SET(0),
1145 SD_CMU_CMU_09_CFG_EN_TX_CK_DN, cmu_inst,
1146 SD_CMU_CMU_09(0));
1147
1148 sdx5_inst_rmw(SD_CMU_CMU_06_CFG_VCO_PD_SET(1),
1149 SD_CMU_CMU_06_CFG_VCO_PD, cmu_inst,
1150 SD_CMU_CMU_06(0));
1151
1152 sdx5_inst_rmw(SD_CMU_CMU_09_CFG_EN_TX_CK_UP_SET(0),
1153 SD_CMU_CMU_09_CFG_EN_TX_CK_UP, cmu_inst,
1154 SD_CMU_CMU_09(0));
1155
1156 sdx5_inst_rmw(SD_CMU_CMU_08_CFG_CK_TREE_PD_SET(1),
1157 SD_CMU_CMU_08_CFG_CK_TREE_PD, cmu_inst,
1158 SD_CMU_CMU_08(0));
1159
1160 sdx5_inst_rmw(SD_CMU_CMU_0D_CFG_REFCK_PD_SET(1) |
1161 SD_CMU_CMU_0D_CFG_PD_DIV64_SET(1) |
1162 SD_CMU_CMU_0D_CFG_PD_DIV66_SET(1),
1163 SD_CMU_CMU_0D_CFG_REFCK_PD |
1164 SD_CMU_CMU_0D_CFG_PD_DIV64 |
1165 SD_CMU_CMU_0D_CFG_PD_DIV66, cmu_inst,
1166 SD_CMU_CMU_0D(0));
1167
1168 sdx5_inst_rmw(SD_CMU_CMU_06_CFG_CTRL_LOGIC_PD_SET(1),
1169 SD_CMU_CMU_06_CFG_CTRL_LOGIC_PD, cmu_inst,
1170 SD_CMU_CMU_06(0));
1171 }
1172}
1173
1174static void sparx5_sd25g28_reset(void __iomem *regs[],
1175 struct sparx5_sd25g28_params *params,
1176 u32 sd_index)
1177{
1178 if (params->reg_rst == 1) {
1179 sdx5_rmw_addr(SD_LANE_25G_SD_LANE_CFG_EXT_CFG_RST_SET(1),
1180 SD_LANE_25G_SD_LANE_CFG_EXT_CFG_RST,
1181 sdx5_addr(regs, SD_LANE_25G_SD_LANE_CFG(sd_index)));
1182
1183 usleep_range(1000, 2000);
1184
1185 sdx5_rmw_addr(SD_LANE_25G_SD_LANE_CFG_EXT_CFG_RST_SET(0),
1186 SD_LANE_25G_SD_LANE_CFG_EXT_CFG_RST,
1187 sdx5_addr(regs, SD_LANE_25G_SD_LANE_CFG(sd_index)));
1188 }
1189}
1190
1191static int sparx5_sd25g28_apply_params(struct sparx5_serdes_macro *macro,
1192 struct sparx5_sd25g28_params *params)
1193{
1194 struct sparx5_serdes_private *priv = macro->priv;
1195 void __iomem **regs = priv->regs;
1196 struct device *dev = priv->dev;
1197 u32 sd_index = macro->stpidx;
1198 u32 value;
1199
1200 sdx5_rmw(SD_LANE_25G_SD_LANE_CFG_MACRO_RST_SET(1),
1201 SD_LANE_25G_SD_LANE_CFG_MACRO_RST,
1202 priv,
1203 SD_LANE_25G_SD_LANE_CFG(sd_index));
1204
1205 sdx5_rmw(SD25G_LANE_CMU_FF_REGISTER_TABLE_INDEX_SET(0xFF),
1206 SD25G_LANE_CMU_FF_REGISTER_TABLE_INDEX,
1207 priv,
1208 SD25G_LANE_CMU_FF(sd_index));
1209
1210 sdx5_rmw(SD25G_LANE_CMU_1A_R_DWIDTHCTRL_FROM_HWT_SET
1211 (params->r_d_width_ctrl_from_hwt) |
1212 SD25G_LANE_CMU_1A_R_REG_MANUAL_SET(params->r_reg_manual),
1213 SD25G_LANE_CMU_1A_R_DWIDTHCTRL_FROM_HWT |
1214 SD25G_LANE_CMU_1A_R_REG_MANUAL,
1215 priv,
1216 SD25G_LANE_CMU_1A(sd_index));
1217
1218 sdx5_rmw(SD25G_LANE_CMU_31_CFG_COMMON_RESERVE_7_0_SET
1219 (params->cfg_common_reserve_7_0),
1220 SD25G_LANE_CMU_31_CFG_COMMON_RESERVE_7_0,
1221 priv,
1222 SD25G_LANE_CMU_31(sd_index));
1223
1224 sdx5_rmw(SD25G_LANE_CMU_09_CFG_EN_DUMMY_SET(params->cfg_en_dummy),
1225 SD25G_LANE_CMU_09_CFG_EN_DUMMY,
1226 priv,
1227 SD25G_LANE_CMU_09(sd_index));
1228
1229 sdx5_rmw(SD25G_LANE_CMU_13_CFG_PLL_RESERVE_3_0_SET
1230 (params->cfg_pll_reserve_3_0),
1231 SD25G_LANE_CMU_13_CFG_PLL_RESERVE_3_0,
1232 priv,
1233 SD25G_LANE_CMU_13(sd_index));
1234
1235 sdx5_rmw(SD25G_LANE_CMU_40_L0_CFG_TXCAL_EN_SET(params->l0_cfg_txcal_en),
1236 SD25G_LANE_CMU_40_L0_CFG_TXCAL_EN,
1237 priv,
1238 SD25G_LANE_CMU_40(sd_index));
1239
1240 sdx5_rmw(SD25G_LANE_CMU_46_L0_CFG_TX_RESERVE_15_8_SET
1241 (params->l0_cfg_tx_reserve_15_8),
1242 SD25G_LANE_CMU_46_L0_CFG_TX_RESERVE_15_8,
1243 priv,
1244 SD25G_LANE_CMU_46(sd_index));
1245
1246 sdx5_rmw(SD25G_LANE_CMU_45_L0_CFG_TX_RESERVE_7_0_SET
1247 (params->l0_cfg_tx_reserve_7_0),
1248 SD25G_LANE_CMU_45_L0_CFG_TX_RESERVE_7_0,
1249 priv,
1250 SD25G_LANE_CMU_45(sd_index));
1251
1252 sdx5_rmw(SD25G_LANE_CMU_0B_CFG_VCO_CAL_RESETN_SET(0),
1253 SD25G_LANE_CMU_0B_CFG_VCO_CAL_RESETN,
1254 priv,
1255 SD25G_LANE_CMU_0B(sd_index));
1256
1257 sdx5_rmw(SD25G_LANE_CMU_0B_CFG_VCO_CAL_RESETN_SET(1),
1258 SD25G_LANE_CMU_0B_CFG_VCO_CAL_RESETN,
1259 priv,
1260 SD25G_LANE_CMU_0B(sd_index));
1261
1262 sdx5_rmw(SD25G_LANE_CMU_19_R_CK_RESETB_SET(0),
1263 SD25G_LANE_CMU_19_R_CK_RESETB,
1264 priv,
1265 SD25G_LANE_CMU_19(sd_index));
1266
1267 sdx5_rmw(SD25G_LANE_CMU_19_R_CK_RESETB_SET(1),
1268 SD25G_LANE_CMU_19_R_CK_RESETB,
1269 priv,
1270 SD25G_LANE_CMU_19(sd_index));
1271
1272 sdx5_rmw(SD25G_LANE_CMU_18_R_PLL_RSTN_SET(0),
1273 SD25G_LANE_CMU_18_R_PLL_RSTN,
1274 priv,
1275 SD25G_LANE_CMU_18(sd_index));
1276
1277 sdx5_rmw(SD25G_LANE_CMU_18_R_PLL_RSTN_SET(1),
1278 SD25G_LANE_CMU_18_R_PLL_RSTN,
1279 priv,
1280 SD25G_LANE_CMU_18(sd_index));
1281
1282 sdx5_rmw(SD25G_LANE_CMU_1A_R_DWIDTHCTRL_2_0_SET(params->r_d_width_ctrl_2_0),
1283 SD25G_LANE_CMU_1A_R_DWIDTHCTRL_2_0,
1284 priv,
1285 SD25G_LANE_CMU_1A(sd_index));
1286
1287 sdx5_rmw(SD25G_LANE_CMU_30_R_TXFIFO_CK_DIV_PMAD_2_0_SET
1288 (params->r_txfifo_ck_div_pmad_2_0) |
1289 SD25G_LANE_CMU_30_R_RXFIFO_CK_DIV_PMAD_2_0_SET
1290 (params->r_rxfifo_ck_div_pmad_2_0),
1291 SD25G_LANE_CMU_30_R_TXFIFO_CK_DIV_PMAD_2_0 |
1292 SD25G_LANE_CMU_30_R_RXFIFO_CK_DIV_PMAD_2_0,
1293 priv,
1294 SD25G_LANE_CMU_30(sd_index));
1295
1296 sdx5_rmw(SD25G_LANE_CMU_0C_CFG_PLL_LOL_SET_SET(params->cfg_pll_lol_set) |
1297 SD25G_LANE_CMU_0C_CFG_VCO_DIV_MODE_1_0_SET
1298 (params->cfg_vco_div_mode_1_0),
1299 SD25G_LANE_CMU_0C_CFG_PLL_LOL_SET |
1300 SD25G_LANE_CMU_0C_CFG_VCO_DIV_MODE_1_0,
1301 priv,
1302 SD25G_LANE_CMU_0C(sd_index));
1303
1304 sdx5_rmw(SD25G_LANE_CMU_0D_CFG_PRE_DIVSEL_1_0_SET
1305 (params->cfg_pre_divsel_1_0),
1306 SD25G_LANE_CMU_0D_CFG_PRE_DIVSEL_1_0,
1307 priv,
1308 SD25G_LANE_CMU_0D(sd_index));
1309
1310 sdx5_rmw(SD25G_LANE_CMU_0E_CFG_SEL_DIV_3_0_SET(params->cfg_sel_div_3_0),
1311 SD25G_LANE_CMU_0E_CFG_SEL_DIV_3_0,
1312 priv,
1313 SD25G_LANE_CMU_0E(sd_index));
1314
1315 sdx5_rmw(SD25G_LANE_CMU_FF_REGISTER_TABLE_INDEX_SET(0x00),
1316 SD25G_LANE_CMU_FF_REGISTER_TABLE_INDEX,
1317 priv,
1318 SD25G_LANE_CMU_FF(sd_index));
1319
1320 sdx5_rmw(SD25G_LANE_LANE_0C_LN_CFG_PMA_TX_CK_BITWIDTH_2_0_SET
1321 (params->cfg_pma_tx_ck_bitwidth_2_0),
1322 SD25G_LANE_LANE_0C_LN_CFG_PMA_TX_CK_BITWIDTH_2_0,
1323 priv,
1324 SD25G_LANE_LANE_0C(sd_index));
1325
1326 sdx5_rmw(SD25G_LANE_LANE_01_LN_CFG_TX_PREDIV_1_0_SET
1327 (params->cfg_tx_prediv_1_0),
1328 SD25G_LANE_LANE_01_LN_CFG_TX_PREDIV_1_0,
1329 priv,
1330 SD25G_LANE_LANE_01(sd_index));
1331
1332 sdx5_rmw(SD25G_LANE_LANE_18_LN_CFG_RXDIV_SEL_2_0_SET
1333 (params->cfg_rxdiv_sel_2_0),
1334 SD25G_LANE_LANE_18_LN_CFG_RXDIV_SEL_2_0,
1335 priv,
1336 SD25G_LANE_LANE_18(sd_index));
1337
1338 sdx5_rmw(SD25G_LANE_LANE_2C_LN_CFG_TX_SUBRATE_2_0_SET
1339 (params->cfg_tx_subrate_2_0),
1340 SD25G_LANE_LANE_2C_LN_CFG_TX_SUBRATE_2_0,
1341 priv,
1342 SD25G_LANE_LANE_2C(sd_index));
1343
1344 sdx5_rmw(SD25G_LANE_LANE_28_LN_CFG_RX_SUBRATE_2_0_SET
1345 (params->cfg_rx_subrate_2_0),
1346 SD25G_LANE_LANE_28_LN_CFG_RX_SUBRATE_2_0,
1347 priv,
1348 SD25G_LANE_LANE_28(sd_index));
1349
1350 sdx5_rmw(SD25G_LANE_LANE_18_LN_CFG_CDRCK_EN_SET(params->cfg_cdrck_en),
1351 SD25G_LANE_LANE_18_LN_CFG_CDRCK_EN,
1352 priv,
1353 SD25G_LANE_LANE_18(sd_index));
1354
1355 sdx5_rmw(SD25G_LANE_LANE_0F_LN_CFG_DFETAP_EN_5_1_SET
1356 (params->cfg_dfetap_en_5_1),
1357 SD25G_LANE_LANE_0F_LN_CFG_DFETAP_EN_5_1,
1358 priv,
1359 SD25G_LANE_LANE_0F(sd_index));
1360
1361 sdx5_rmw(SD25G_LANE_LANE_18_LN_CFG_ERRAMP_PD_SET(params->cfg_erramp_pd),
1362 SD25G_LANE_LANE_18_LN_CFG_ERRAMP_PD,
1363 priv,
1364 SD25G_LANE_LANE_18(sd_index));
1365
1366 sdx5_rmw(SD25G_LANE_LANE_1D_LN_CFG_PI_DFE_EN_SET(params->cfg_pi_dfe_en),
1367 SD25G_LANE_LANE_1D_LN_CFG_PI_DFE_EN,
1368 priv,
1369 SD25G_LANE_LANE_1D(sd_index));
1370
1371 sdx5_rmw(SD25G_LANE_LANE_19_LN_CFG_ECDR_PD_SET(params->cfg_ecdr_pd),
1372 SD25G_LANE_LANE_19_LN_CFG_ECDR_PD,
1373 priv,
1374 SD25G_LANE_LANE_19(sd_index));
1375
1376 sdx5_rmw(SD25G_LANE_LANE_01_LN_CFG_ITX_IPDRIVER_BASE_2_0_SET
1377 (params->cfg_itx_ipdriver_base_2_0),
1378 SD25G_LANE_LANE_01_LN_CFG_ITX_IPDRIVER_BASE_2_0,
1379 priv,
1380 SD25G_LANE_LANE_01(sd_index));
1381
1382 sdx5_rmw(SD25G_LANE_LANE_03_LN_CFG_TAP_DLY_4_0_SET(params->cfg_tap_dly_4_0),
1383 SD25G_LANE_LANE_03_LN_CFG_TAP_DLY_4_0,
1384 priv,
1385 SD25G_LANE_LANE_03(sd_index));
1386
1387 sdx5_rmw(SD25G_LANE_LANE_06_LN_CFG_TAP_ADV_3_0_SET(params->cfg_tap_adv_3_0),
1388 SD25G_LANE_LANE_06_LN_CFG_TAP_ADV_3_0,
1389 priv,
1390 SD25G_LANE_LANE_06(sd_index));
1391
1392 sdx5_rmw(SD25G_LANE_LANE_07_LN_CFG_EN_ADV_SET(params->cfg_en_adv) |
1393 SD25G_LANE_LANE_07_LN_CFG_EN_DLY_SET(params->cfg_en_dly),
1394 SD25G_LANE_LANE_07_LN_CFG_EN_ADV |
1395 SD25G_LANE_LANE_07_LN_CFG_EN_DLY,
1396 priv,
1397 SD25G_LANE_LANE_07(sd_index));
1398
1399 sdx5_rmw(SD25G_LANE_LANE_43_LN_CFG_TX_RESERVE_15_8_SET
1400 (params->cfg_tx_reserve_15_8),
1401 SD25G_LANE_LANE_43_LN_CFG_TX_RESERVE_15_8,
1402 priv,
1403 SD25G_LANE_LANE_43(sd_index));
1404
1405 sdx5_rmw(SD25G_LANE_LANE_42_LN_CFG_TX_RESERVE_7_0_SET
1406 (params->cfg_tx_reserve_7_0),
1407 SD25G_LANE_LANE_42_LN_CFG_TX_RESERVE_7_0,
1408 priv,
1409 SD25G_LANE_LANE_42(sd_index));
1410
1411 sdx5_rmw(SD25G_LANE_LANE_05_LN_CFG_BW_1_0_SET(params->cfg_bw_1_0),
1412 SD25G_LANE_LANE_05_LN_CFG_BW_1_0,
1413 priv,
1414 SD25G_LANE_LANE_05(sd_index));
1415
1416 sdx5_rmw(SD25G_LANE_LANE_0B_LN_CFG_TXCAL_MAN_EN_SET
1417 (params->cfg_txcal_man_en),
1418 SD25G_LANE_LANE_0B_LN_CFG_TXCAL_MAN_EN,
1419 priv,
1420 SD25G_LANE_LANE_0B(sd_index));
1421
1422 sdx5_rmw(SD25G_LANE_LANE_0A_LN_CFG_TXCAL_SHIFT_CODE_5_0_SET
1423 (params->cfg_txcal_shift_code_5_0),
1424 SD25G_LANE_LANE_0A_LN_CFG_TXCAL_SHIFT_CODE_5_0,
1425 priv,
1426 SD25G_LANE_LANE_0A(sd_index));
1427
1428 sdx5_rmw(SD25G_LANE_LANE_09_LN_CFG_TXCAL_VALID_SEL_3_0_SET
1429 (params->cfg_txcal_valid_sel_3_0),
1430 SD25G_LANE_LANE_09_LN_CFG_TXCAL_VALID_SEL_3_0,
1431 priv,
1432 SD25G_LANE_LANE_09(sd_index));
1433
1434 sdx5_rmw(SD25G_LANE_LANE_1A_LN_CFG_CDR_KF_2_0_SET(params->cfg_cdr_kf_2_0),
1435 SD25G_LANE_LANE_1A_LN_CFG_CDR_KF_2_0,
1436 priv,
1437 SD25G_LANE_LANE_1A(sd_index));
1438
1439 sdx5_rmw(SD25G_LANE_LANE_1B_LN_CFG_CDR_M_7_0_SET(params->cfg_cdr_m_7_0),
1440 SD25G_LANE_LANE_1B_LN_CFG_CDR_M_7_0,
1441 priv,
1442 SD25G_LANE_LANE_1B(sd_index));
1443
1444 sdx5_rmw(SD25G_LANE_LANE_2B_LN_CFG_PI_BW_3_0_SET(params->cfg_pi_bw_3_0),
1445 SD25G_LANE_LANE_2B_LN_CFG_PI_BW_3_0,
1446 priv,
1447 SD25G_LANE_LANE_2B(sd_index));
1448
1449 sdx5_rmw(SD25G_LANE_LANE_2C_LN_CFG_DIS_2NDORDER_SET
1450 (params->cfg_dis_2ndorder),
1451 SD25G_LANE_LANE_2C_LN_CFG_DIS_2NDORDER,
1452 priv,
1453 SD25G_LANE_LANE_2C(sd_index));
1454
1455 sdx5_rmw(SD25G_LANE_LANE_2E_LN_CFG_CTLE_RSTN_SET(params->cfg_ctle_rstn),
1456 SD25G_LANE_LANE_2E_LN_CFG_CTLE_RSTN,
1457 priv,
1458 SD25G_LANE_LANE_2E(sd_index));
1459
1460 sdx5_rmw(SD25G_LANE_LANE_00_LN_CFG_ITX_IPCML_BASE_1_0_SET
1461 (params->cfg_itx_ipcml_base_1_0),
1462 SD25G_LANE_LANE_00_LN_CFG_ITX_IPCML_BASE_1_0,
1463 priv,
1464 SD25G_LANE_LANE_00(sd_index));
1465
1466 sdx5_rmw(SD25G_LANE_LANE_44_LN_CFG_RX_RESERVE_7_0_SET
1467 (params->cfg_rx_reserve_7_0),
1468 SD25G_LANE_LANE_44_LN_CFG_RX_RESERVE_7_0,
1469 priv,
1470 SD25G_LANE_LANE_44(sd_index));
1471
1472 sdx5_rmw(SD25G_LANE_LANE_45_LN_CFG_RX_RESERVE_15_8_SET
1473 (params->cfg_rx_reserve_15_8),
1474 SD25G_LANE_LANE_45_LN_CFG_RX_RESERVE_15_8,
1475 priv,
1476 SD25G_LANE_LANE_45(sd_index));
1477
1478 sdx5_rmw(SD25G_LANE_LANE_0D_LN_CFG_DFECK_EN_SET(params->cfg_dfeck_en) |
1479 SD25G_LANE_LANE_0D_LN_CFG_RXTERM_2_0_SET(params->cfg_rxterm_2_0),
1480 SD25G_LANE_LANE_0D_LN_CFG_DFECK_EN |
1481 SD25G_LANE_LANE_0D_LN_CFG_RXTERM_2_0,
1482 priv,
1483 SD25G_LANE_LANE_0D(sd_index));
1484
1485 sdx5_rmw(SD25G_LANE_LANE_21_LN_CFG_VGA_CTRL_BYP_4_0_SET
1486 (params->cfg_vga_ctrl_byp_4_0),
1487 SD25G_LANE_LANE_21_LN_CFG_VGA_CTRL_BYP_4_0,
1488 priv,
1489 SD25G_LANE_LANE_21(sd_index));
1490
1491 sdx5_rmw(SD25G_LANE_LANE_22_LN_CFG_EQR_FORCE_3_0_SET
1492 (params->cfg_eqr_force_3_0),
1493 SD25G_LANE_LANE_22_LN_CFG_EQR_FORCE_3_0,
1494 priv,
1495 SD25G_LANE_LANE_22(sd_index));
1496
1497 sdx5_rmw(SD25G_LANE_LANE_1C_LN_CFG_EQC_FORCE_3_0_SET
1498 (params->cfg_eqc_force_3_0) |
1499 SD25G_LANE_LANE_1C_LN_CFG_DFE_PD_SET(params->cfg_dfe_pd),
1500 SD25G_LANE_LANE_1C_LN_CFG_EQC_FORCE_3_0 |
1501 SD25G_LANE_LANE_1C_LN_CFG_DFE_PD,
1502 priv,
1503 SD25G_LANE_LANE_1C(sd_index));
1504
1505 sdx5_rmw(SD25G_LANE_LANE_1E_LN_CFG_SUM_SETCM_EN_SET
1506 (params->cfg_sum_setcm_en),
1507 SD25G_LANE_LANE_1E_LN_CFG_SUM_SETCM_EN,
1508 priv,
1509 SD25G_LANE_LANE_1E(sd_index));
1510
1511 sdx5_rmw(SD25G_LANE_LANE_25_LN_CFG_INIT_POS_ISCAN_6_0_SET
1512 (params->cfg_init_pos_iscan_6_0),
1513 SD25G_LANE_LANE_25_LN_CFG_INIT_POS_ISCAN_6_0,
1514 priv,
1515 SD25G_LANE_LANE_25(sd_index));
1516
1517 sdx5_rmw(SD25G_LANE_LANE_26_LN_CFG_INIT_POS_IPI_6_0_SET
1518 (params->cfg_init_pos_ipi_6_0),
1519 SD25G_LANE_LANE_26_LN_CFG_INIT_POS_IPI_6_0,
1520 priv,
1521 SD25G_LANE_LANE_26(sd_index));
1522
1523 sdx5_rmw(SD25G_LANE_LANE_18_LN_CFG_ERRAMP_PD_SET(params->cfg_erramp_pd),
1524 SD25G_LANE_LANE_18_LN_CFG_ERRAMP_PD,
1525 priv,
1526 SD25G_LANE_LANE_18(sd_index));
1527
1528 sdx5_rmw(SD25G_LANE_LANE_0E_LN_CFG_DFEDIG_M_2_0_SET
1529 (params->cfg_dfedig_m_2_0),
1530 SD25G_LANE_LANE_0E_LN_CFG_DFEDIG_M_2_0,
1531 priv,
1532 SD25G_LANE_LANE_0E(sd_index));
1533
1534 sdx5_rmw(SD25G_LANE_LANE_0E_LN_CFG_EN_DFEDIG_SET(params->cfg_en_dfedig),
1535 SD25G_LANE_LANE_0E_LN_CFG_EN_DFEDIG,
1536 priv,
1537 SD25G_LANE_LANE_0E(sd_index));
1538
1539 sdx5_rmw(SD25G_LANE_LANE_40_LN_R_TX_POL_INV_SET(params->r_tx_pol_inv) |
1540 SD25G_LANE_LANE_40_LN_R_RX_POL_INV_SET(params->r_rx_pol_inv),
1541 SD25G_LANE_LANE_40_LN_R_TX_POL_INV |
1542 SD25G_LANE_LANE_40_LN_R_RX_POL_INV,
1543 priv,
1544 SD25G_LANE_LANE_40(sd_index));
1545
1546 sdx5_rmw(SD25G_LANE_LANE_04_LN_CFG_RX2TX_LP_EN_SET(params->cfg_rx2tx_lp_en) |
1547 SD25G_LANE_LANE_04_LN_CFG_TX2RX_LP_EN_SET(params->cfg_tx2rx_lp_en),
1548 SD25G_LANE_LANE_04_LN_CFG_RX2TX_LP_EN |
1549 SD25G_LANE_LANE_04_LN_CFG_TX2RX_LP_EN,
1550 priv,
1551 SD25G_LANE_LANE_04(sd_index));
1552
1553 sdx5_rmw(SD25G_LANE_LANE_1E_LN_CFG_RXLB_EN_SET(params->cfg_rxlb_en),
1554 SD25G_LANE_LANE_1E_LN_CFG_RXLB_EN,
1555 priv,
1556 SD25G_LANE_LANE_1E(sd_index));
1557
1558 sdx5_rmw(SD25G_LANE_LANE_19_LN_CFG_TXLB_EN_SET(params->cfg_txlb_en),
1559 SD25G_LANE_LANE_19_LN_CFG_TXLB_EN,
1560 priv,
1561 SD25G_LANE_LANE_19(sd_index));
1562
1563 sdx5_rmw(SD25G_LANE_LANE_2E_LN_CFG_RSTN_DFEDIG_SET(0),
1564 SD25G_LANE_LANE_2E_LN_CFG_RSTN_DFEDIG,
1565 priv,
1566 SD25G_LANE_LANE_2E(sd_index));
1567
1568 sdx5_rmw(SD25G_LANE_LANE_2E_LN_CFG_RSTN_DFEDIG_SET(1),
1569 SD25G_LANE_LANE_2E_LN_CFG_RSTN_DFEDIG,
1570 priv,
1571 SD25G_LANE_LANE_2E(sd_index));
1572
1573 sdx5_rmw(SD_LANE_25G_SD_LANE_CFG_MACRO_RST_SET(0),
1574 SD_LANE_25G_SD_LANE_CFG_MACRO_RST,
1575 priv,
1576 SD_LANE_25G_SD_LANE_CFG(sd_index));
1577
1578 sdx5_rmw(SD25G_LANE_LANE_1C_LN_CFG_CDR_RSTN_SET(0),
1579 SD25G_LANE_LANE_1C_LN_CFG_CDR_RSTN,
1580 priv,
1581 SD25G_LANE_LANE_1C(sd_index));
1582
1583 usleep_range(1000, 2000);
1584
1585 sdx5_rmw(SD25G_LANE_LANE_1C_LN_CFG_CDR_RSTN_SET(1),
1586 SD25G_LANE_LANE_1C_LN_CFG_CDR_RSTN,
1587 priv,
1588 SD25G_LANE_LANE_1C(sd_index));
1589
1590 usleep_range(10000, 20000);
1591
1592 sdx5_rmw(SD25G_LANE_CMU_FF_REGISTER_TABLE_INDEX_SET(0xff),
1593 SD25G_LANE_CMU_FF_REGISTER_TABLE_INDEX,
1594 priv,
1595 SD25G_LANE_CMU_FF(sd_index));
1596
1597 value = readl(sdx5_addr(regs, SD25G_LANE_CMU_C0(sd_index)));
1598 value = SD25G_LANE_CMU_C0_PLL_LOL_UDL_GET(value);
1599
1600 if (value) {
1601 dev_err(dev, "25G PLL Loss of Lock: 0x%x\n", value);
1602 return -EINVAL;
1603 }
1604
1605 value = readl(sdx5_addr(regs, SD_LANE_25G_SD_LANE_STAT(sd_index)));
1606 value = SD_LANE_25G_SD_LANE_STAT_PMA_RST_DONE_GET(value);
1607
1608 if (value != 0x1) {
1609 dev_err(dev, "25G PMA Reset failed: 0x%x\n", value);
1610 return -EINVAL;
1611 }
1612 sdx5_rmw(SD25G_LANE_CMU_2A_R_DBG_LOL_STATUS_SET(0x1),
1613 SD25G_LANE_CMU_2A_R_DBG_LOL_STATUS,
1614 priv,
1615 SD25G_LANE_CMU_2A(sd_index));
1616
1617 sdx5_rmw(SD_LANE_25G_SD_SER_RST_SER_RST_SET(0x0),
1618 SD_LANE_25G_SD_SER_RST_SER_RST,
1619 priv,
1620 SD_LANE_25G_SD_SER_RST(sd_index));
1621
1622 sdx5_rmw(SD_LANE_25G_SD_DES_RST_DES_RST_SET(0x0),
1623 SD_LANE_25G_SD_DES_RST_DES_RST,
1624 priv,
1625 SD_LANE_25G_SD_DES_RST(sd_index));
1626
1627 sdx5_rmw(SD25G_LANE_CMU_FF_REGISTER_TABLE_INDEX_SET(0),
1628 SD25G_LANE_CMU_FF_REGISTER_TABLE_INDEX,
1629 priv,
1630 SD25G_LANE_CMU_FF(sd_index));
1631
1632 sdx5_rmw(SD25G_LANE_LANE_2D_LN_CFG_ALOS_THR_2_0_SET
1633 (params->cfg_alos_thr_2_0),
1634 SD25G_LANE_LANE_2D_LN_CFG_ALOS_THR_2_0,
1635 priv,
1636 SD25G_LANE_LANE_2D(sd_index));
1637
1638 sdx5_rmw(SD25G_LANE_LANE_2E_LN_CFG_DIS_SQ_SET(0),
1639 SD25G_LANE_LANE_2E_LN_CFG_DIS_SQ,
1640 priv,
1641 SD25G_LANE_LANE_2E(sd_index));
1642
1643 sdx5_rmw(SD25G_LANE_LANE_2E_LN_CFG_PD_SQ_SET(0),
1644 SD25G_LANE_LANE_2E_LN_CFG_PD_SQ,
1645 priv,
1646 SD25G_LANE_LANE_2E(sd_index));
1647
1648 return 0;
1649}
1650
1651static void sparx5_sd10g28_reset(void __iomem *regs[], u32 lane_index)
1652{
1653 /* Note: SerDes SD10G_LANE_1 is configured in 10G_LAN mode */
1654 sdx5_rmw_addr(SD_LANE_SD_LANE_CFG_EXT_CFG_RST_SET(1),
1655 SD_LANE_SD_LANE_CFG_EXT_CFG_RST,
1656 sdx5_addr(regs, SD_LANE_SD_LANE_CFG(lane_index)));
1657
1658 usleep_range(1000, 2000);
1659
1660 sdx5_rmw_addr(SD_LANE_SD_LANE_CFG_EXT_CFG_RST_SET(0),
1661 SD_LANE_SD_LANE_CFG_EXT_CFG_RST,
1662 sdx5_addr(regs, SD_LANE_SD_LANE_CFG(lane_index)));
1663}
1664
1665static int sparx5_sd10g28_apply_params(struct sparx5_serdes_macro *macro,
1666 struct sparx5_sd10g28_params *params)
1667{
1668 struct sparx5_serdes_private *priv = macro->priv;
1669 void __iomem **regs = priv->regs;
1670 struct device *dev = priv->dev;
1671 u32 lane_index = macro->sidx;
1672 u32 sd_index = macro->stpidx;
1673 void __iomem *sd_inst;
1674 u32 value, cmu_idx;
1675 int err;
1676
1677 /* Do not configure serdes if CMU is not to be configured too */
1678 if (params->skip_cmu_cfg)
1679 return 0;
1680
1681 cmu_idx = priv->data->ops.serdes_cmu_get(params->cmu_sel, macro->sidx);
1682 err = sparx5_cmu_cfg(priv, cmu_idx);
1683 if (err)
1684 return err;
1685
1686 if (params->is_6g)
1687 sd_inst = sdx5_inst_get(priv, TARGET_SD6G_LANE, sd_index);
1688 else
1689 sd_inst = sdx5_inst_get(priv, TARGET_SD10G_LANE, sd_index);
1690
1691 sdx5_rmw(SD_LANE_SD_LANE_CFG_MACRO_RST_SET(1),
1692 SD_LANE_SD_LANE_CFG_MACRO_RST,
1693 priv,
1694 SD_LANE_SD_LANE_CFG(lane_index));
1695
1696 sdx5_inst_rmw(SD10G_LANE_LANE_93_R_DWIDTHCTRL_FROM_HWT_SET(0x0) |
1697 SD10G_LANE_LANE_93_R_REG_MANUAL_SET(0x1) |
1698 SD10G_LANE_LANE_93_R_AUXCKSEL_FROM_HWT_SET(0x1) |
1699 SD10G_LANE_LANE_93_R_LANE_ID_FROM_HWT_SET(0x1) |
1700 SD10G_LANE_LANE_93_R_EN_RATECHG_CTRL_SET(0x0),
1701 SD10G_LANE_LANE_93_R_DWIDTHCTRL_FROM_HWT |
1702 SD10G_LANE_LANE_93_R_REG_MANUAL |
1703 SD10G_LANE_LANE_93_R_AUXCKSEL_FROM_HWT |
1704 SD10G_LANE_LANE_93_R_LANE_ID_FROM_HWT |
1705 SD10G_LANE_LANE_93_R_EN_RATECHG_CTRL,
1706 sd_inst,
1707 SD10G_LANE_LANE_93(sd_index));
1708
1709 sdx5_inst_rmw(SD10G_LANE_LANE_94_R_ISCAN_REG_SET(0x1) |
1710 SD10G_LANE_LANE_94_R_TXEQ_REG_SET(0x1) |
1711 SD10G_LANE_LANE_94_R_MISC_REG_SET(0x1) |
1712 SD10G_LANE_LANE_94_R_SWING_REG_SET(0x1),
1713 SD10G_LANE_LANE_94_R_ISCAN_REG |
1714 SD10G_LANE_LANE_94_R_TXEQ_REG |
1715 SD10G_LANE_LANE_94_R_MISC_REG |
1716 SD10G_LANE_LANE_94_R_SWING_REG,
1717 sd_inst,
1718 SD10G_LANE_LANE_94(sd_index));
1719
1720 sdx5_inst_rmw(SD10G_LANE_LANE_9E_R_RXEQ_REG_SET(0x1),
1721 SD10G_LANE_LANE_9E_R_RXEQ_REG,
1722 sd_inst,
1723 SD10G_LANE_LANE_9E(sd_index));
1724
1725 sdx5_inst_rmw(SD10G_LANE_LANE_A1_R_SSC_FROM_HWT_SET(0x0) |
1726 SD10G_LANE_LANE_A1_R_CDR_FROM_HWT_SET(0x0) |
1727 SD10G_LANE_LANE_A1_R_PCLK_GATING_FROM_HWT_SET(0x1),
1728 SD10G_LANE_LANE_A1_R_SSC_FROM_HWT |
1729 SD10G_LANE_LANE_A1_R_CDR_FROM_HWT |
1730 SD10G_LANE_LANE_A1_R_PCLK_GATING_FROM_HWT,
1731 sd_inst,
1732 SD10G_LANE_LANE_A1(sd_index));
1733
1734 sdx5_rmw(SD_LANE_SD_LANE_CFG_RX_REF_SEL_SET(params->cmu_sel) |
1735 SD_LANE_SD_LANE_CFG_TX_REF_SEL_SET(params->cmu_sel),
1736 SD_LANE_SD_LANE_CFG_RX_REF_SEL |
1737 SD_LANE_SD_LANE_CFG_TX_REF_SEL,
1738 priv,
1739 SD_LANE_SD_LANE_CFG(lane_index));
1740
1741 sdx5_inst_rmw(SD10G_LANE_LANE_40_CFG_LANE_RESERVE_7_0_SET
1742 (params->cfg_lane_reserve_7_0),
1743 SD10G_LANE_LANE_40_CFG_LANE_RESERVE_7_0,
1744 sd_inst,
1745 SD10G_LANE_LANE_40(sd_index));
1746
1747 sdx5_inst_rmw(SD10G_LANE_LANE_50_CFG_SSC_RTL_CLK_SEL_SET
1748 (params->cfg_ssc_rtl_clk_sel),
1749 SD10G_LANE_LANE_50_CFG_SSC_RTL_CLK_SEL,
1750 sd_inst,
1751 SD10G_LANE_LANE_50(sd_index));
1752
1753 sdx5_inst_rmw(SD10G_LANE_LANE_35_CFG_TXRATE_1_0_SET
1754 (params->cfg_txrate_1_0) |
1755 SD10G_LANE_LANE_35_CFG_RXRATE_1_0_SET
1756 (params->cfg_rxrate_1_0),
1757 SD10G_LANE_LANE_35_CFG_TXRATE_1_0 |
1758 SD10G_LANE_LANE_35_CFG_RXRATE_1_0,
1759 sd_inst,
1760 SD10G_LANE_LANE_35(sd_index));
1761
1762 sdx5_inst_rmw(SD10G_LANE_LANE_94_R_DWIDTHCTRL_2_0_SET
1763 (params->r_d_width_ctrl_2_0),
1764 SD10G_LANE_LANE_94_R_DWIDTHCTRL_2_0,
1765 sd_inst,
1766 SD10G_LANE_LANE_94(sd_index));
1767
1768 sdx5_inst_rmw(SD10G_LANE_LANE_01_CFG_PMA_TX_CK_BITWIDTH_2_0_SET
1769 (params->cfg_pma_tx_ck_bitwidth_2_0),
1770 SD10G_LANE_LANE_01_CFG_PMA_TX_CK_BITWIDTH_2_0,
1771 sd_inst,
1772 SD10G_LANE_LANE_01(sd_index));
1773
1774 sdx5_inst_rmw(SD10G_LANE_LANE_30_CFG_RXDIV_SEL_2_0_SET
1775 (params->cfg_rxdiv_sel_2_0),
1776 SD10G_LANE_LANE_30_CFG_RXDIV_SEL_2_0,
1777 sd_inst,
1778 SD10G_LANE_LANE_30(sd_index));
1779
1780 sdx5_inst_rmw(SD10G_LANE_LANE_A2_R_PCS2PMA_PHYMODE_4_0_SET
1781 (params->r_pcs2pma_phymode_4_0),
1782 SD10G_LANE_LANE_A2_R_PCS2PMA_PHYMODE_4_0,
1783 sd_inst,
1784 SD10G_LANE_LANE_A2(sd_index));
1785
1786 sdx5_inst_rmw(SD10G_LANE_LANE_13_CFG_CDRCK_EN_SET(params->cfg_cdrck_en),
1787 SD10G_LANE_LANE_13_CFG_CDRCK_EN,
1788 sd_inst,
1789 SD10G_LANE_LANE_13(sd_index));
1790
1791 sdx5_inst_rmw(SD10G_LANE_LANE_23_CFG_DFECK_EN_SET
1792 (params->cfg_dfeck_en) |
1793 SD10G_LANE_LANE_23_CFG_DFE_PD_SET(params->cfg_dfe_pd) |
1794 SD10G_LANE_LANE_23_CFG_ERRAMP_PD_SET
1795 (params->cfg_erramp_pd),
1796 SD10G_LANE_LANE_23_CFG_DFECK_EN |
1797 SD10G_LANE_LANE_23_CFG_DFE_PD |
1798 SD10G_LANE_LANE_23_CFG_ERRAMP_PD,
1799 sd_inst,
1800 SD10G_LANE_LANE_23(sd_index));
1801
1802 sdx5_inst_rmw(SD10G_LANE_LANE_22_CFG_DFETAP_EN_5_1_SET
1803 (params->cfg_dfetap_en_5_1),
1804 SD10G_LANE_LANE_22_CFG_DFETAP_EN_5_1,
1805 sd_inst,
1806 SD10G_LANE_LANE_22(sd_index));
1807
1808 sdx5_inst_rmw(SD10G_LANE_LANE_1A_CFG_PI_DFE_EN_SET
1809 (params->cfg_pi_DFE_en),
1810 SD10G_LANE_LANE_1A_CFG_PI_DFE_EN,
1811 sd_inst,
1812 SD10G_LANE_LANE_1A(sd_index));
1813
1814 sdx5_inst_rmw(SD10G_LANE_LANE_02_CFG_EN_ADV_SET(params->cfg_en_adv) |
1815 SD10G_LANE_LANE_02_CFG_EN_MAIN_SET(params->cfg_en_main) |
1816 SD10G_LANE_LANE_02_CFG_EN_DLY_SET(params->cfg_en_dly) |
1817 SD10G_LANE_LANE_02_CFG_TAP_ADV_3_0_SET
1818 (params->cfg_tap_adv_3_0),
1819 SD10G_LANE_LANE_02_CFG_EN_ADV |
1820 SD10G_LANE_LANE_02_CFG_EN_MAIN |
1821 SD10G_LANE_LANE_02_CFG_EN_DLY |
1822 SD10G_LANE_LANE_02_CFG_TAP_ADV_3_0,
1823 sd_inst,
1824 SD10G_LANE_LANE_02(sd_index));
1825
1826 sdx5_inst_rmw(SD10G_LANE_LANE_03_CFG_TAP_MAIN_SET(params->cfg_tap_main),
1827 SD10G_LANE_LANE_03_CFG_TAP_MAIN,
1828 sd_inst,
1829 SD10G_LANE_LANE_03(sd_index));
1830
1831 sdx5_inst_rmw(SD10G_LANE_LANE_04_CFG_TAP_DLY_4_0_SET
1832 (params->cfg_tap_dly_4_0),
1833 SD10G_LANE_LANE_04_CFG_TAP_DLY_4_0,
1834 sd_inst,
1835 SD10G_LANE_LANE_04(sd_index));
1836
1837 sdx5_inst_rmw(SD10G_LANE_LANE_2F_CFG_VGA_CTRL_3_0_SET
1838 (params->cfg_vga_ctrl_3_0),
1839 SD10G_LANE_LANE_2F_CFG_VGA_CTRL_3_0,
1840 sd_inst,
1841 SD10G_LANE_LANE_2F(sd_index));
1842
1843 sdx5_inst_rmw(SD10G_LANE_LANE_2F_CFG_VGA_CP_2_0_SET
1844 (params->cfg_vga_cp_2_0),
1845 SD10G_LANE_LANE_2F_CFG_VGA_CP_2_0,
1846 sd_inst,
1847 SD10G_LANE_LANE_2F(sd_index));
1848
1849 sdx5_inst_rmw(SD10G_LANE_LANE_0B_CFG_EQ_RES_3_0_SET
1850 (params->cfg_eq_res_3_0),
1851 SD10G_LANE_LANE_0B_CFG_EQ_RES_3_0,
1852 sd_inst,
1853 SD10G_LANE_LANE_0B(sd_index));
1854
1855 sdx5_inst_rmw(SD10G_LANE_LANE_0D_CFG_EQR_BYP_SET(params->cfg_eq_r_byp),
1856 SD10G_LANE_LANE_0D_CFG_EQR_BYP,
1857 sd_inst,
1858 SD10G_LANE_LANE_0D(sd_index));
1859
1860 sdx5_inst_rmw(SD10G_LANE_LANE_0E_CFG_EQC_FORCE_3_0_SET
1861 (params->cfg_eq_c_force_3_0) |
1862 SD10G_LANE_LANE_0E_CFG_SUM_SETCM_EN_SET
1863 (params->cfg_sum_setcm_en),
1864 SD10G_LANE_LANE_0E_CFG_EQC_FORCE_3_0 |
1865 SD10G_LANE_LANE_0E_CFG_SUM_SETCM_EN,
1866 sd_inst,
1867 SD10G_LANE_LANE_0E(sd_index));
1868
1869 sdx5_inst_rmw(SD10G_LANE_LANE_23_CFG_EN_DFEDIG_SET
1870 (params->cfg_en_dfedig),
1871 SD10G_LANE_LANE_23_CFG_EN_DFEDIG,
1872 sd_inst,
1873 SD10G_LANE_LANE_23(sd_index));
1874
1875 sdx5_inst_rmw(SD10G_LANE_LANE_06_CFG_EN_PREEMPH_SET
1876 (params->cfg_en_preemph),
1877 SD10G_LANE_LANE_06_CFG_EN_PREEMPH,
1878 sd_inst,
1879 SD10G_LANE_LANE_06(sd_index));
1880
1881 sdx5_inst_rmw(SD10G_LANE_LANE_33_CFG_ITX_IPPREEMP_BASE_1_0_SET
1882 (params->cfg_itx_ippreemp_base_1_0) |
1883 SD10G_LANE_LANE_33_CFG_ITX_IPDRIVER_BASE_2_0_SET
1884 (params->cfg_itx_ipdriver_base_2_0),
1885 SD10G_LANE_LANE_33_CFG_ITX_IPPREEMP_BASE_1_0 |
1886 SD10G_LANE_LANE_33_CFG_ITX_IPDRIVER_BASE_2_0,
1887 sd_inst,
1888 SD10G_LANE_LANE_33(sd_index));
1889
1890 sdx5_inst_rmw(SD10G_LANE_LANE_52_CFG_IBIAS_TUNE_RESERVE_5_0_SET
1891 (params->cfg_ibias_tune_reserve_5_0),
1892 SD10G_LANE_LANE_52_CFG_IBIAS_TUNE_RESERVE_5_0,
1893 sd_inst,
1894 SD10G_LANE_LANE_52(sd_index));
1895
1896 sdx5_inst_rmw(SD10G_LANE_LANE_37_CFG_TXSWING_HALF_SET
1897 (params->cfg_txswing_half),
1898 SD10G_LANE_LANE_37_CFG_TXSWING_HALF,
1899 sd_inst,
1900 SD10G_LANE_LANE_37(sd_index));
1901
1902 sdx5_inst_rmw(SD10G_LANE_LANE_3C_CFG_DIS_2NDORDER_SET
1903 (params->cfg_dis_2nd_order),
1904 SD10G_LANE_LANE_3C_CFG_DIS_2NDORDER,
1905 sd_inst,
1906 SD10G_LANE_LANE_3C(sd_index));
1907
1908 sdx5_inst_rmw(SD10G_LANE_LANE_39_CFG_RX_SSC_LH_SET
1909 (params->cfg_rx_ssc_lh),
1910 SD10G_LANE_LANE_39_CFG_RX_SSC_LH,
1911 sd_inst,
1912 SD10G_LANE_LANE_39(sd_index));
1913
1914 sdx5_inst_rmw(SD10G_LANE_LANE_1A_CFG_PI_FLOOP_STEPS_1_0_SET
1915 (params->cfg_pi_floop_steps_1_0),
1916 SD10G_LANE_LANE_1A_CFG_PI_FLOOP_STEPS_1_0,
1917 sd_inst,
1918 SD10G_LANE_LANE_1A(sd_index));
1919
1920 sdx5_inst_rmw(SD10G_LANE_LANE_16_CFG_PI_EXT_DAC_23_16_SET
1921 (params->cfg_pi_ext_dac_23_16),
1922 SD10G_LANE_LANE_16_CFG_PI_EXT_DAC_23_16,
1923 sd_inst,
1924 SD10G_LANE_LANE_16(sd_index));
1925
1926 sdx5_inst_rmw(SD10G_LANE_LANE_15_CFG_PI_EXT_DAC_15_8_SET
1927 (params->cfg_pi_ext_dac_15_8),
1928 SD10G_LANE_LANE_15_CFG_PI_EXT_DAC_15_8,
1929 sd_inst,
1930 SD10G_LANE_LANE_15(sd_index));
1931
1932 sdx5_inst_rmw(SD10G_LANE_LANE_26_CFG_ISCAN_EXT_DAC_7_0_SET
1933 (params->cfg_iscan_ext_dac_7_0),
1934 SD10G_LANE_LANE_26_CFG_ISCAN_EXT_DAC_7_0,
1935 sd_inst,
1936 SD10G_LANE_LANE_26(sd_index));
1937
1938 sdx5_inst_rmw(SD10G_LANE_LANE_42_CFG_CDR_KF_GEN1_2_0_SET
1939 (params->cfg_cdr_kf_gen1_2_0),
1940 SD10G_LANE_LANE_42_CFG_CDR_KF_GEN1_2_0,
1941 sd_inst,
1942 SD10G_LANE_LANE_42(sd_index));
1943
1944 sdx5_inst_rmw(SD10G_LANE_LANE_0F_R_CDR_M_GEN1_7_0_SET
1945 (params->r_cdr_m_gen1_7_0),
1946 SD10G_LANE_LANE_0F_R_CDR_M_GEN1_7_0,
1947 sd_inst,
1948 SD10G_LANE_LANE_0F(sd_index));
1949
1950 sdx5_inst_rmw(SD10G_LANE_LANE_24_CFG_PI_BW_GEN1_3_0_SET
1951 (params->cfg_pi_bw_gen1_3_0),
1952 SD10G_LANE_LANE_24_CFG_PI_BW_GEN1_3_0,
1953 sd_inst,
1954 SD10G_LANE_LANE_24(sd_index));
1955
1956 sdx5_inst_rmw(SD10G_LANE_LANE_14_CFG_PI_EXT_DAC_7_0_SET
1957 (params->cfg_pi_ext_dac_7_0),
1958 SD10G_LANE_LANE_14_CFG_PI_EXT_DAC_7_0,
1959 sd_inst,
1960 SD10G_LANE_LANE_14(sd_index));
1961
1962 sdx5_inst_rmw(SD10G_LANE_LANE_1A_CFG_PI_STEPS_SET(params->cfg_pi_steps),
1963 SD10G_LANE_LANE_1A_CFG_PI_STEPS,
1964 sd_inst,
1965 SD10G_LANE_LANE_1A(sd_index));
1966
1967 sdx5_inst_rmw(SD10G_LANE_LANE_3A_CFG_MP_MAX_3_0_SET
1968 (params->cfg_mp_max_3_0),
1969 SD10G_LANE_LANE_3A_CFG_MP_MAX_3_0,
1970 sd_inst,
1971 SD10G_LANE_LANE_3A(sd_index));
1972
1973 sdx5_inst_rmw(SD10G_LANE_LANE_31_CFG_RSTN_DFEDIG_SET
1974 (params->cfg_rstn_dfedig),
1975 SD10G_LANE_LANE_31_CFG_RSTN_DFEDIG,
1976 sd_inst,
1977 SD10G_LANE_LANE_31(sd_index));
1978
1979 sdx5_inst_rmw(SD10G_LANE_LANE_48_CFG_ALOS_THR_3_0_SET
1980 (params->cfg_alos_thr_3_0),
1981 SD10G_LANE_LANE_48_CFG_ALOS_THR_3_0,
1982 sd_inst,
1983 SD10G_LANE_LANE_48(sd_index));
1984
1985 sdx5_inst_rmw(SD10G_LANE_LANE_36_CFG_PREDRV_SLEWRATE_1_0_SET
1986 (params->cfg_predrv_slewrate_1_0),
1987 SD10G_LANE_LANE_36_CFG_PREDRV_SLEWRATE_1_0,
1988 sd_inst,
1989 SD10G_LANE_LANE_36(sd_index));
1990
1991 sdx5_inst_rmw(SD10G_LANE_LANE_32_CFG_ITX_IPCML_BASE_1_0_SET
1992 (params->cfg_itx_ipcml_base_1_0),
1993 SD10G_LANE_LANE_32_CFG_ITX_IPCML_BASE_1_0,
1994 sd_inst,
1995 SD10G_LANE_LANE_32(sd_index));
1996
1997 sdx5_inst_rmw(SD10G_LANE_LANE_37_CFG_IP_PRE_BASE_1_0_SET
1998 (params->cfg_ip_pre_base_1_0),
1999 SD10G_LANE_LANE_37_CFG_IP_PRE_BASE_1_0,
2000 sd_inst,
2001 SD10G_LANE_LANE_37(sd_index));
2002
2003 sdx5_inst_rmw(SD10G_LANE_LANE_41_CFG_LANE_RESERVE_15_8_SET
2004 (params->cfg_lane_reserve_15_8),
2005 SD10G_LANE_LANE_41_CFG_LANE_RESERVE_15_8,
2006 sd_inst,
2007 SD10G_LANE_LANE_41(sd_index));
2008
2009 sdx5_inst_rmw(SD10G_LANE_LANE_9E_R_EN_AUTO_CDR_RSTN_SET
2010 (params->r_en_auto_cdr_rstn),
2011 SD10G_LANE_LANE_9E_R_EN_AUTO_CDR_RSTN,
2012 sd_inst,
2013 SD10G_LANE_LANE_9E(sd_index));
2014
2015 sdx5_inst_rmw(SD10G_LANE_LANE_0C_CFG_OSCAL_AFE_SET
2016 (params->cfg_oscal_afe) |
2017 SD10G_LANE_LANE_0C_CFG_PD_OSDAC_AFE_SET
2018 (params->cfg_pd_osdac_afe),
2019 SD10G_LANE_LANE_0C_CFG_OSCAL_AFE |
2020 SD10G_LANE_LANE_0C_CFG_PD_OSDAC_AFE,
2021 sd_inst,
2022 SD10G_LANE_LANE_0C(sd_index));
2023
2024 sdx5_inst_rmw(SD10G_LANE_LANE_0B_CFG_RESETB_OSCAL_AFE_SET
2025 (params->cfg_resetb_oscal_afe[0]),
2026 SD10G_LANE_LANE_0B_CFG_RESETB_OSCAL_AFE,
2027 sd_inst,
2028 SD10G_LANE_LANE_0B(sd_index));
2029
2030 sdx5_inst_rmw(SD10G_LANE_LANE_0B_CFG_RESETB_OSCAL_AFE_SET
2031 (params->cfg_resetb_oscal_afe[1]),
2032 SD10G_LANE_LANE_0B_CFG_RESETB_OSCAL_AFE,
2033 sd_inst,
2034 SD10G_LANE_LANE_0B(sd_index));
2035
2036 sdx5_inst_rmw(SD10G_LANE_LANE_83_R_TX_POL_INV_SET
2037 (params->r_tx_pol_inv) |
2038 SD10G_LANE_LANE_83_R_RX_POL_INV_SET
2039 (params->r_rx_pol_inv),
2040 SD10G_LANE_LANE_83_R_TX_POL_INV |
2041 SD10G_LANE_LANE_83_R_RX_POL_INV,
2042 sd_inst,
2043 SD10G_LANE_LANE_83(sd_index));
2044
2045 sdx5_inst_rmw(SD10G_LANE_LANE_06_CFG_RX2TX_LP_EN_SET
2046 (params->cfg_rx2tx_lp_en) |
2047 SD10G_LANE_LANE_06_CFG_TX2RX_LP_EN_SET
2048 (params->cfg_tx2rx_lp_en),
2049 SD10G_LANE_LANE_06_CFG_RX2TX_LP_EN |
2050 SD10G_LANE_LANE_06_CFG_TX2RX_LP_EN,
2051 sd_inst,
2052 SD10G_LANE_LANE_06(sd_index));
2053
2054 sdx5_inst_rmw(SD10G_LANE_LANE_0E_CFG_RXLB_EN_SET(params->cfg_rxlb_en) |
2055 SD10G_LANE_LANE_0E_CFG_TXLB_EN_SET(params->cfg_txlb_en),
2056 SD10G_LANE_LANE_0E_CFG_RXLB_EN |
2057 SD10G_LANE_LANE_0E_CFG_TXLB_EN,
2058 sd_inst,
2059 SD10G_LANE_LANE_0E(sd_index));
2060
2061 sdx5_rmw(SD_LANE_SD_LANE_CFG_MACRO_RST_SET(0),
2062 SD_LANE_SD_LANE_CFG_MACRO_RST,
2063 priv,
2064 SD_LANE_SD_LANE_CFG(lane_index));
2065
2066 sdx5_inst_rmw(SD10G_LANE_LANE_50_CFG_SSC_RESETB_SET(1),
2067 SD10G_LANE_LANE_50_CFG_SSC_RESETB,
2068 sd_inst,
2069 SD10G_LANE_LANE_50(sd_index));
2070
2071 sdx5_rmw(SD10G_LANE_LANE_50_CFG_SSC_RESETB_SET(1),
2072 SD10G_LANE_LANE_50_CFG_SSC_RESETB,
2073 priv,
2074 SD10G_LANE_LANE_50(sd_index));
2075
2076 sdx5_rmw(SD_LANE_MISC_SD_125_RST_DIS_SET(params->fx_100),
2077 SD_LANE_MISC_SD_125_RST_DIS,
2078 priv,
2079 SD_LANE_MISC(lane_index));
2080
2081 sdx5_rmw(SD_LANE_MISC_RX_ENA_SET(params->fx_100),
2082 SD_LANE_MISC_RX_ENA,
2083 priv,
2084 SD_LANE_MISC(lane_index));
2085
2086 sdx5_rmw(SD_LANE_MISC_MUX_ENA_SET(params->fx_100),
2087 SD_LANE_MISC_MUX_ENA,
2088 priv,
2089 SD_LANE_MISC(lane_index));
2090
2091 usleep_range(3000, 6000);
2092
2093 value = readl(sdx5_addr(regs, SD_LANE_SD_LANE_STAT(lane_index)));
2094 value = SD_LANE_SD_LANE_STAT_PMA_RST_DONE_GET(value);
2095 if (value != 1) {
2096 dev_err(dev, "10G PMA Reset failed: 0x%x\n", value);
2097 return -EINVAL;
2098 }
2099
2100 sdx5_rmw(SD_LANE_SD_SER_RST_SER_RST_SET(0x0),
2101 SD_LANE_SD_SER_RST_SER_RST,
2102 priv,
2103 SD_LANE_SD_SER_RST(lane_index));
2104
2105 sdx5_rmw(SD_LANE_SD_DES_RST_DES_RST_SET(0x0),
2106 SD_LANE_SD_DES_RST_DES_RST,
2107 priv,
2108 SD_LANE_SD_DES_RST(lane_index));
2109
2110 return 0;
2111}
2112
2113static int sparx5_sd25g28_config(struct sparx5_serdes_macro *macro, bool reset)
2114{
2115 struct sparx5_sd25g28_media_preset media = media_presets_25g[macro->media];
2116 struct sparx5_sd25g28_mode_preset mode;
2117 struct sparx5_sd25g28_args args = {
2118 .rxinvert = 1,
2119 .txinvert = 0,
2120 .txswing = 240,
2121 .com_pll_reserve = 0xf,
2122 .reg_rst = reset,
2123 };
2124 struct sparx5_sd25g28_params params;
2125 int err;
2126
2127 err = sparx5_sd10g25_get_mode_preset(macro, &mode);
2128 if (err)
2129 return err;
2130 sparx5_sd25g28_get_params(macro, &media, &mode, &args, ¶ms);
2131 sparx5_sd25g28_reset(macro->priv->regs, ¶ms, macro->stpidx);
2132 return sparx5_sd25g28_apply_params(macro, ¶ms);
2133}
2134
2135static int sparx5_sd10g28_config(struct sparx5_serdes_macro *macro, bool reset)
2136{
2137 struct sparx5_sd10g28_media_preset media = media_presets_10g[macro->media];
2138 struct sparx5_sd10g28_mode_preset mode;
2139 struct sparx5_sd10g28_params params;
2140 struct sparx5_sd10g28_args args = {
2141 .is_6g = (macro->serdestype == SPX5_SDT_6G),
2142 .txinvert = 0,
2143 .rxinvert = 1,
2144 .txswing = 240,
2145 .reg_rst = reset,
2146 .skip_cmu_cfg = reset,
2147 };
2148 int err;
2149
2150 err = sparx5_sd10g28_get_mode_preset(macro, &mode, &args);
2151 if (err)
2152 return err;
2153 sparx5_sd10g28_get_params(macro, &media, &mode, &args, ¶ms);
2154 sparx5_sd10g28_reset(macro->priv->regs, macro->sidx);
2155 return sparx5_sd10g28_apply_params(macro, ¶ms);
2156}
2157
2158/* Power down serdes TX driver */
2159static int sparx5_serdes_power_save(struct sparx5_serdes_macro *macro, u32 pwdn)
2160{
2161 struct sparx5_serdes_private *priv = macro->priv;
2162 void __iomem *sd_inst, *sd_lane_inst;
2163
2164 if (macro->serdestype == SPX5_SDT_6G)
2165 sd_inst = sdx5_inst_get(priv, TARGET_SD6G_LANE, macro->stpidx);
2166 else if (macro->serdestype == SPX5_SDT_10G)
2167 sd_inst = sdx5_inst_get(priv, TARGET_SD10G_LANE, macro->stpidx);
2168 else
2169 sd_inst = sdx5_inst_get(priv, TARGET_SD25G_LANE, macro->stpidx);
2170
2171 if (macro->serdestype == SPX5_SDT_25G) {
2172 sd_lane_inst = sdx5_inst_get(priv, TARGET_SD_LANE_25G,
2173 macro->stpidx);
2174 /* Take serdes out of reset */
2175 sdx5_inst_rmw(SD_LANE_25G_SD_LANE_CFG_EXT_CFG_RST_SET(0),
2176 SD_LANE_25G_SD_LANE_CFG_EXT_CFG_RST, sd_lane_inst,
2177 SD_LANE_25G_SD_LANE_CFG(0));
2178
2179 /* Configure optimal settings for quiet mode */
2180 sdx5_inst_rmw(SD_LANE_25G_QUIET_MODE_6G_QUIET_MODE_SET(SPX5_SERDES_QUIET_MODE_VAL),
2181 SD_LANE_25G_QUIET_MODE_6G_QUIET_MODE,
2182 sd_lane_inst, SD_LANE_25G_QUIET_MODE_6G(0));
2183
2184 sdx5_inst_rmw(SD25G_LANE_LANE_04_LN_CFG_PD_DRIVER_SET(pwdn),
2185 SD25G_LANE_LANE_04_LN_CFG_PD_DRIVER,
2186 sd_inst,
2187 SD25G_LANE_LANE_04(0));
2188 } else {
2189 /* 6G and 10G */
2190 sd_lane_inst = sdx5_inst_get(priv, TARGET_SD_LANE, macro->sidx);
2191
2192 /* Take serdes out of reset */
2193 sdx5_inst_rmw(SD_LANE_SD_LANE_CFG_EXT_CFG_RST_SET(0),
2194 SD_LANE_SD_LANE_CFG_EXT_CFG_RST, sd_lane_inst,
2195 SD_LANE_SD_LANE_CFG(0));
2196
2197 /* Configure optimal settings for quiet mode */
2198 sdx5_inst_rmw(SD_LANE_QUIET_MODE_6G_QUIET_MODE_SET(SPX5_SERDES_QUIET_MODE_VAL),
2199 SD_LANE_QUIET_MODE_6G_QUIET_MODE, sd_lane_inst,
2200 SD_LANE_QUIET_MODE_6G(0));
2201
2202 sdx5_inst_rmw(SD10G_LANE_LANE_06_CFG_PD_DRIVER_SET(pwdn),
2203 SD10G_LANE_LANE_06_CFG_PD_DRIVER,
2204 sd_inst,
2205 SD10G_LANE_LANE_06(0));
2206 }
2207 return 0;
2208}
2209
2210static int sparx5_serdes_clock_config(struct sparx5_serdes_macro *macro)
2211{
2212 struct sparx5_serdes_private *priv = macro->priv;
2213
2214 /* Clock is auto-detected in 100Base-FX mode on lan969x */
2215 if (priv->data->type == SPX5_TARGET_LAN969X)
2216 return 0;
2217
2218 if (macro->serdesmode == SPX5_SD_MODE_100FX) {
2219 u32 freq = priv->coreclock == 250000000 ? 2 :
2220 priv->coreclock == 500000000 ? 1 : 0;
2221
2222 sdx5_rmw(SD_LANE_MISC_CORE_CLK_FREQ_SET(freq),
2223 SD_LANE_MISC_CORE_CLK_FREQ,
2224 priv,
2225 SD_LANE_MISC(macro->sidx));
2226 }
2227 return 0;
2228}
2229
2230static int sparx5_serdes_get_serdesmode(phy_interface_t portmode, int speed)
2231{
2232 switch (portmode) {
2233 case PHY_INTERFACE_MODE_1000BASEX:
2234 case PHY_INTERFACE_MODE_2500BASEX:
2235 if (speed == SPEED_2500)
2236 return SPX5_SD_MODE_2G5;
2237 if (speed == SPEED_100)
2238 return SPX5_SD_MODE_100FX;
2239 return SPX5_SD_MODE_1000BASEX;
2240 case PHY_INTERFACE_MODE_SGMII:
2241 /* The same Serdes mode is used for both SGMII and 1000BaseX */
2242 return SPX5_SD_MODE_1000BASEX;
2243 case PHY_INTERFACE_MODE_QSGMII:
2244 return SPX5_SD_MODE_QSGMII;
2245 case PHY_INTERFACE_MODE_10GBASER:
2246 return SPX5_SD_MODE_SFI;
2247 default:
2248 return -EINVAL;
2249 }
2250}
2251
2252static int sparx5_serdes_config(struct sparx5_serdes_macro *macro)
2253{
2254 struct device *dev = macro->priv->dev;
2255 int serdesmode;
2256 int err;
2257
2258 serdesmode = sparx5_serdes_get_serdesmode(macro->portmode, macro->speed);
2259 if (serdesmode < 0) {
2260 dev_err(dev, "SerDes %u, interface not supported: %s\n",
2261 macro->sidx,
2262 phy_modes(macro->portmode));
2263 return serdesmode;
2264 }
2265 macro->serdesmode = serdesmode;
2266
2267 sparx5_serdes_clock_config(macro);
2268
2269 if (macro->serdestype == SPX5_SDT_25G)
2270 err = sparx5_sd25g28_config(macro, false);
2271 else
2272 err = sparx5_sd10g28_config(macro, false);
2273 if (err) {
2274 dev_err(dev, "SerDes %u, config error: %d\n",
2275 macro->sidx, err);
2276 }
2277 return err;
2278}
2279
2280static int sparx5_serdes_power_on(struct phy *phy)
2281{
2282 struct sparx5_serdes_macro *macro = phy_get_drvdata(phy);
2283
2284 return sparx5_serdes_power_save(macro, false);
2285}
2286
2287static int sparx5_serdes_power_off(struct phy *phy)
2288{
2289 struct sparx5_serdes_macro *macro = phy_get_drvdata(phy);
2290
2291 return sparx5_serdes_power_save(macro, true);
2292}
2293
2294static int sparx5_serdes_set_mode(struct phy *phy, enum phy_mode mode, int submode)
2295{
2296 struct sparx5_serdes_macro *macro;
2297
2298 if (mode != PHY_MODE_ETHERNET)
2299 return -EINVAL;
2300
2301 switch (submode) {
2302 case PHY_INTERFACE_MODE_1000BASEX:
2303 case PHY_INTERFACE_MODE_2500BASEX:
2304 case PHY_INTERFACE_MODE_SGMII:
2305 case PHY_INTERFACE_MODE_QSGMII:
2306 case PHY_INTERFACE_MODE_10GBASER:
2307 macro = phy_get_drvdata(phy);
2308 macro->portmode = submode;
2309 sparx5_serdes_config(macro);
2310 return 0;
2311 default:
2312 return -EINVAL;
2313 }
2314}
2315
2316static int sparx5_serdes_set_media(struct phy *phy, enum phy_media media)
2317{
2318 struct sparx5_serdes_macro *macro = phy_get_drvdata(phy);
2319
2320 if (media != macro->media) {
2321 macro->media = media;
2322 if (macro->serdesmode != SPX5_SD_MODE_NONE)
2323 sparx5_serdes_config(macro);
2324 }
2325 return 0;
2326}
2327
2328static int sparx5_serdes_set_speed(struct phy *phy, int speed)
2329{
2330 struct sparx5_serdes_macro *macro = phy_get_drvdata(phy);
2331
2332 if (macro->priv->data->type == SPX5_TARGET_SPARX5) {
2333 if (macro->sidx < SPX5_SERDES_10G_START && speed > SPEED_5000)
2334 return -EINVAL;
2335 if (macro->sidx < SPX5_SERDES_25G_START && speed > SPEED_10000)
2336 return -EINVAL;
2337 }
2338 if (speed != macro->speed) {
2339 macro->speed = speed;
2340 if (macro->serdesmode != SPX5_SD_MODE_NONE)
2341 sparx5_serdes_config(macro);
2342 }
2343 return 0;
2344}
2345
2346static int sparx5_serdes_reset(struct phy *phy)
2347{
2348 struct sparx5_serdes_macro *macro = phy_get_drvdata(phy);
2349 int err;
2350
2351 if (macro->serdestype == SPX5_SDT_25G)
2352 err = sparx5_sd25g28_config(macro, true);
2353 else
2354 err = sparx5_sd10g28_config(macro, true);
2355 if (err) {
2356 dev_err(&phy->dev, "SerDes %u, reset error: %d\n",
2357 macro->sidx, err);
2358 }
2359 return err;
2360}
2361
2362static int sparx5_serdes_validate(struct phy *phy, enum phy_mode mode,
2363 int submode,
2364 union phy_configure_opts *opts)
2365{
2366 struct sparx5_serdes_macro *macro = phy_get_drvdata(phy);
2367
2368 if (mode != PHY_MODE_ETHERNET)
2369 return -EINVAL;
2370
2371 if (macro->speed == 0)
2372 return -EINVAL;
2373
2374 if (macro->priv->data->type == SPX5_TARGET_SPARX5) {
2375 if (macro->sidx < SPX5_SERDES_10G_START &&
2376 macro->speed > SPEED_5000)
2377 return -EINVAL;
2378 if (macro->sidx < SPX5_SERDES_25G_START &&
2379 macro->speed > SPEED_10000)
2380 return -EINVAL;
2381 }
2382 switch (submode) {
2383 case PHY_INTERFACE_MODE_1000BASEX:
2384 if (macro->speed != SPEED_100 && /* This is for 100BASE-FX */
2385 macro->speed != SPEED_1000)
2386 return -EINVAL;
2387 break;
2388 case PHY_INTERFACE_MODE_SGMII:
2389 case PHY_INTERFACE_MODE_2500BASEX:
2390 case PHY_INTERFACE_MODE_QSGMII:
2391 if (macro->speed >= SPEED_5000)
2392 return -EINVAL;
2393 break;
2394 case PHY_INTERFACE_MODE_10GBASER:
2395 if (macro->speed < SPEED_5000)
2396 return -EINVAL;
2397 break;
2398 default:
2399 return -EINVAL;
2400 }
2401 return 0;
2402}
2403
2404static const struct phy_ops sparx5_serdes_ops = {
2405 .power_on = sparx5_serdes_power_on,
2406 .power_off = sparx5_serdes_power_off,
2407 .set_mode = sparx5_serdes_set_mode,
2408 .set_media = sparx5_serdes_set_media,
2409 .set_speed = sparx5_serdes_set_speed,
2410 .reset = sparx5_serdes_reset,
2411 .validate = sparx5_serdes_validate,
2412 .owner = THIS_MODULE,
2413};
2414
2415static void sparx5_serdes_type_set(struct sparx5_serdes_macro *macro, int sidx)
2416{
2417 if (sidx < SPX5_SERDES_10G_START) {
2418 macro->serdestype = SPX5_SDT_6G;
2419 macro->stpidx = macro->sidx;
2420 } else if (sidx < SPX5_SERDES_25G_START) {
2421 macro->serdestype = SPX5_SDT_10G;
2422 macro->stpidx = macro->sidx - SPX5_SERDES_10G_START;
2423 } else {
2424 macro->serdestype = SPX5_SDT_25G;
2425 macro->stpidx = macro->sidx - SPX5_SERDES_25G_START;
2426 }
2427}
2428
2429static void lan969x_serdes_type_set(struct sparx5_serdes_macro *macro, int sidx)
2430{
2431 macro->serdestype = SPX5_SDT_10G;
2432 macro->stpidx = macro->sidx;
2433}
2434
2435static int sparx5_phy_create(struct sparx5_serdes_private *priv,
2436 int idx, struct phy **phy)
2437{
2438 struct sparx5_serdes_macro *macro;
2439
2440 *phy = devm_phy_create(priv->dev, NULL, &sparx5_serdes_ops);
2441 if (IS_ERR(*phy))
2442 return PTR_ERR(*phy);
2443
2444 macro = devm_kzalloc(priv->dev, sizeof(*macro), GFP_KERNEL);
2445 if (!macro)
2446 return -ENOMEM;
2447
2448 macro->sidx = idx;
2449 macro->priv = priv;
2450 macro->speed = SPEED_UNKNOWN;
2451
2452 priv->data->ops.serdes_type_set(macro, idx);
2453
2454 phy_set_drvdata(*phy, macro);
2455
2456 /* Power off serdes by default */
2457 sparx5_serdes_power_off(*phy);
2458
2459 return 0;
2460}
2461
2462static struct sparx5_serdes_io_resource sparx5_serdes_iomap[] = {
2463 { TARGET_SD_CMU, 0x0 }, /* 0x610808000: sd_cmu_0 */
2464 { TARGET_SD_CMU + 1, 0x8000 }, /* 0x610810000: sd_cmu_1 */
2465 { TARGET_SD_CMU + 2, 0x10000 }, /* 0x610818000: sd_cmu_2 */
2466 { TARGET_SD_CMU + 3, 0x18000 }, /* 0x610820000: sd_cmu_3 */
2467 { TARGET_SD_CMU + 4, 0x20000 }, /* 0x610828000: sd_cmu_4 */
2468 { TARGET_SD_CMU + 5, 0x28000 }, /* 0x610830000: sd_cmu_5 */
2469 { TARGET_SD_CMU + 6, 0x30000 }, /* 0x610838000: sd_cmu_6 */
2470 { TARGET_SD_CMU + 7, 0x38000 }, /* 0x610840000: sd_cmu_7 */
2471 { TARGET_SD_CMU + 8, 0x40000 }, /* 0x610848000: sd_cmu_8 */
2472 { TARGET_SD_CMU_CFG, 0x48000 }, /* 0x610850000: sd_cmu_cfg_0 */
2473 { TARGET_SD_CMU_CFG + 1, 0x50000 }, /* 0x610858000: sd_cmu_cfg_1 */
2474 { TARGET_SD_CMU_CFG + 2, 0x58000 }, /* 0x610860000: sd_cmu_cfg_2 */
2475 { TARGET_SD_CMU_CFG + 3, 0x60000 }, /* 0x610868000: sd_cmu_cfg_3 */
2476 { TARGET_SD_CMU_CFG + 4, 0x68000 }, /* 0x610870000: sd_cmu_cfg_4 */
2477 { TARGET_SD_CMU_CFG + 5, 0x70000 }, /* 0x610878000: sd_cmu_cfg_5 */
2478 { TARGET_SD_CMU_CFG + 6, 0x78000 }, /* 0x610880000: sd_cmu_cfg_6 */
2479 { TARGET_SD_CMU_CFG + 7, 0x80000 }, /* 0x610888000: sd_cmu_cfg_7 */
2480 { TARGET_SD_CMU_CFG + 8, 0x88000 }, /* 0x610890000: sd_cmu_cfg_8 */
2481 { TARGET_SD6G_LANE, 0x90000 }, /* 0x610898000: sd6g_lane_0 */
2482 { TARGET_SD6G_LANE + 1, 0x98000 }, /* 0x6108a0000: sd6g_lane_1 */
2483 { TARGET_SD6G_LANE + 2, 0xa0000 }, /* 0x6108a8000: sd6g_lane_2 */
2484 { TARGET_SD6G_LANE + 3, 0xa8000 }, /* 0x6108b0000: sd6g_lane_3 */
2485 { TARGET_SD6G_LANE + 4, 0xb0000 }, /* 0x6108b8000: sd6g_lane_4 */
2486 { TARGET_SD6G_LANE + 5, 0xb8000 }, /* 0x6108c0000: sd6g_lane_5 */
2487 { TARGET_SD6G_LANE + 6, 0xc0000 }, /* 0x6108c8000: sd6g_lane_6 */
2488 { TARGET_SD6G_LANE + 7, 0xc8000 }, /* 0x6108d0000: sd6g_lane_7 */
2489 { TARGET_SD6G_LANE + 8, 0xd0000 }, /* 0x6108d8000: sd6g_lane_8 */
2490 { TARGET_SD6G_LANE + 9, 0xd8000 }, /* 0x6108e0000: sd6g_lane_9 */
2491 { TARGET_SD6G_LANE + 10, 0xe0000 }, /* 0x6108e8000: sd6g_lane_10 */
2492 { TARGET_SD6G_LANE + 11, 0xe8000 }, /* 0x6108f0000: sd6g_lane_11 */
2493 { TARGET_SD6G_LANE + 12, 0xf0000 }, /* 0x6108f8000: sd6g_lane_12 */
2494 { TARGET_SD10G_LANE, 0xf8000 }, /* 0x610900000: sd10g_lane_0 */
2495 { TARGET_SD10G_LANE + 1, 0x100000 }, /* 0x610908000: sd10g_lane_1 */
2496 { TARGET_SD10G_LANE + 2, 0x108000 }, /* 0x610910000: sd10g_lane_2 */
2497 { TARGET_SD10G_LANE + 3, 0x110000 }, /* 0x610918000: sd10g_lane_3 */
2498 { TARGET_SD_LANE, 0x1a0000 }, /* 0x6109a8000: sd_lane_0 */
2499 { TARGET_SD_LANE + 1, 0x1a8000 }, /* 0x6109b0000: sd_lane_1 */
2500 { TARGET_SD_LANE + 2, 0x1b0000 }, /* 0x6109b8000: sd_lane_2 */
2501 { TARGET_SD_LANE + 3, 0x1b8000 }, /* 0x6109c0000: sd_lane_3 */
2502 { TARGET_SD_LANE + 4, 0x1c0000 }, /* 0x6109c8000: sd_lane_4 */
2503 { TARGET_SD_LANE + 5, 0x1c8000 }, /* 0x6109d0000: sd_lane_5 */
2504 { TARGET_SD_LANE + 6, 0x1d0000 }, /* 0x6109d8000: sd_lane_6 */
2505 { TARGET_SD_LANE + 7, 0x1d8000 }, /* 0x6109e0000: sd_lane_7 */
2506 { TARGET_SD_LANE + 8, 0x1e0000 }, /* 0x6109e8000: sd_lane_8 */
2507 { TARGET_SD_LANE + 9, 0x1e8000 }, /* 0x6109f0000: sd_lane_9 */
2508 { TARGET_SD_LANE + 10, 0x1f0000 }, /* 0x6109f8000: sd_lane_10 */
2509 { TARGET_SD_LANE + 11, 0x1f8000 }, /* 0x610a00000: sd_lane_11 */
2510 { TARGET_SD_LANE + 12, 0x200000 }, /* 0x610a08000: sd_lane_12 */
2511 { TARGET_SD_LANE + 13, 0x208000 }, /* 0x610a10000: sd_lane_13 */
2512 { TARGET_SD_LANE + 14, 0x210000 }, /* 0x610a18000: sd_lane_14 */
2513 { TARGET_SD_LANE + 15, 0x218000 }, /* 0x610a20000: sd_lane_15 */
2514 { TARGET_SD_LANE + 16, 0x220000 }, /* 0x610a28000: sd_lane_16 */
2515 { TARGET_SD_CMU + 9, 0x400000 }, /* 0x610c08000: sd_cmu_9 */
2516 { TARGET_SD_CMU + 10, 0x408000 }, /* 0x610c10000: sd_cmu_10 */
2517 { TARGET_SD_CMU + 11, 0x410000 }, /* 0x610c18000: sd_cmu_11 */
2518 { TARGET_SD_CMU + 12, 0x418000 }, /* 0x610c20000: sd_cmu_12 */
2519 { TARGET_SD_CMU + 13, 0x420000 }, /* 0x610c28000: sd_cmu_13 */
2520 { TARGET_SD_CMU_CFG + 9, 0x428000 }, /* 0x610c30000: sd_cmu_cfg_9 */
2521 { TARGET_SD_CMU_CFG + 10, 0x430000 }, /* 0x610c38000: sd_cmu_cfg_10 */
2522 { TARGET_SD_CMU_CFG + 11, 0x438000 }, /* 0x610c40000: sd_cmu_cfg_11 */
2523 { TARGET_SD_CMU_CFG + 12, 0x440000 }, /* 0x610c48000: sd_cmu_cfg_12 */
2524 { TARGET_SD_CMU_CFG + 13, 0x448000 }, /* 0x610c50000: sd_cmu_cfg_13 */
2525 { TARGET_SD10G_LANE + 4, 0x450000 }, /* 0x610c58000: sd10g_lane_4 */
2526 { TARGET_SD10G_LANE + 5, 0x458000 }, /* 0x610c60000: sd10g_lane_5 */
2527 { TARGET_SD10G_LANE + 6, 0x460000 }, /* 0x610c68000: sd10g_lane_6 */
2528 { TARGET_SD10G_LANE + 7, 0x468000 }, /* 0x610c70000: sd10g_lane_7 */
2529 { TARGET_SD10G_LANE + 8, 0x470000 }, /* 0x610c78000: sd10g_lane_8 */
2530 { TARGET_SD10G_LANE + 9, 0x478000 }, /* 0x610c80000: sd10g_lane_9 */
2531 { TARGET_SD10G_LANE + 10, 0x480000 }, /* 0x610c88000: sd10g_lane_10 */
2532 { TARGET_SD10G_LANE + 11, 0x488000 }, /* 0x610c90000: sd10g_lane_11 */
2533 { TARGET_SD25G_LANE, 0x490000 }, /* 0x610c98000: sd25g_lane_0 */
2534 { TARGET_SD25G_LANE + 1, 0x498000 }, /* 0x610ca0000: sd25g_lane_1 */
2535 { TARGET_SD25G_LANE + 2, 0x4a0000 }, /* 0x610ca8000: sd25g_lane_2 */
2536 { TARGET_SD25G_LANE + 3, 0x4a8000 }, /* 0x610cb0000: sd25g_lane_3 */
2537 { TARGET_SD25G_LANE + 4, 0x4b0000 }, /* 0x610cb8000: sd25g_lane_4 */
2538 { TARGET_SD25G_LANE + 5, 0x4b8000 }, /* 0x610cc0000: sd25g_lane_5 */
2539 { TARGET_SD25G_LANE + 6, 0x4c0000 }, /* 0x610cc8000: sd25g_lane_6 */
2540 { TARGET_SD25G_LANE + 7, 0x4c8000 }, /* 0x610cd0000: sd25g_lane_7 */
2541 { TARGET_SD_LANE + 17, 0x550000 }, /* 0x610d58000: sd_lane_17 */
2542 { TARGET_SD_LANE + 18, 0x558000 }, /* 0x610d60000: sd_lane_18 */
2543 { TARGET_SD_LANE + 19, 0x560000 }, /* 0x610d68000: sd_lane_19 */
2544 { TARGET_SD_LANE + 20, 0x568000 }, /* 0x610d70000: sd_lane_20 */
2545 { TARGET_SD_LANE + 21, 0x570000 }, /* 0x610d78000: sd_lane_21 */
2546 { TARGET_SD_LANE + 22, 0x578000 }, /* 0x610d80000: sd_lane_22 */
2547 { TARGET_SD_LANE + 23, 0x580000 }, /* 0x610d88000: sd_lane_23 */
2548 { TARGET_SD_LANE + 24, 0x588000 }, /* 0x610d90000: sd_lane_24 */
2549 { TARGET_SD_LANE_25G, 0x590000 }, /* 0x610d98000: sd_lane_25g_25 */
2550 { TARGET_SD_LANE_25G + 1, 0x598000 }, /* 0x610da0000: sd_lane_25g_26 */
2551 { TARGET_SD_LANE_25G + 2, 0x5a0000 }, /* 0x610da8000: sd_lane_25g_27 */
2552 { TARGET_SD_LANE_25G + 3, 0x5a8000 }, /* 0x610db0000: sd_lane_25g_28 */
2553 { TARGET_SD_LANE_25G + 4, 0x5b0000 }, /* 0x610db8000: sd_lane_25g_29 */
2554 { TARGET_SD_LANE_25G + 5, 0x5b8000 }, /* 0x610dc0000: sd_lane_25g_30 */
2555 { TARGET_SD_LANE_25G + 6, 0x5c0000 }, /* 0x610dc8000: sd_lane_25g_31 */
2556 { TARGET_SD_LANE_25G + 7, 0x5c8000 }, /* 0x610dd0000: sd_lane_25g_32 */
2557};
2558
2559static const struct sparx5_serdes_io_resource lan969x_serdes_iomap[] = {
2560 { TARGET_SD_CMU, 0x0 }, /* 0xe3410000 */
2561 { TARGET_SD_CMU + 1, 0x8000 }, /* 0xe3418000 */
2562 { TARGET_SD_CMU + 2, 0x10000 }, /* 0xe3420000 */
2563 { TARGET_SD_CMU + 3, 0x18000 }, /* 0xe3428000 */
2564 { TARGET_SD_CMU + 4, 0x20000 }, /* 0xe3430000 */
2565 { TARGET_SD_CMU + 5, 0x28000 }, /* 0xe3438000 */
2566 { TARGET_SD_CMU_CFG, 0x30000 }, /* 0xe3440000 */
2567 { TARGET_SD_CMU_CFG + 1, 0x38000 }, /* 0xe3448000 */
2568 { TARGET_SD_CMU_CFG + 2, 0x40000 }, /* 0xe3450000 */
2569 { TARGET_SD_CMU_CFG + 3, 0x48000 }, /* 0xe3458000 */
2570 { TARGET_SD_CMU_CFG + 4, 0x50000 }, /* 0xe3460000 */
2571 { TARGET_SD_CMU_CFG + 5, 0x58000 }, /* 0xe3468000 */
2572 { TARGET_SD10G_LANE, 0x60000 }, /* 0xe3470000 */
2573 { TARGET_SD10G_LANE + 1, 0x68000 }, /* 0xe3478000 */
2574 { TARGET_SD10G_LANE + 2, 0x70000 }, /* 0xe3480000 */
2575 { TARGET_SD10G_LANE + 3, 0x78000 }, /* 0xe3488000 */
2576 { TARGET_SD10G_LANE + 4, 0x80000 }, /* 0xe3490000 */
2577 { TARGET_SD10G_LANE + 5, 0x88000 }, /* 0xe3498000 */
2578 { TARGET_SD10G_LANE + 6, 0x90000 }, /* 0xe34a0000 */
2579 { TARGET_SD10G_LANE + 7, 0x98000 }, /* 0xe34a8000 */
2580 { TARGET_SD10G_LANE + 8, 0xa0000 }, /* 0xe34b0000 */
2581 { TARGET_SD10G_LANE + 9, 0xa8000 }, /* 0xe34b8000 */
2582 { TARGET_SD_LANE, 0x100000 }, /* 0xe3510000 */
2583 { TARGET_SD_LANE + 1, 0x108000 }, /* 0xe3518000 */
2584 { TARGET_SD_LANE + 2, 0x110000 }, /* 0xe3520000 */
2585 { TARGET_SD_LANE + 3, 0x118000 }, /* 0xe3528000 */
2586 { TARGET_SD_LANE + 4, 0x120000 }, /* 0xe3530000 */
2587 { TARGET_SD_LANE + 5, 0x128000 }, /* 0xe3538000 */
2588 { TARGET_SD_LANE + 6, 0x130000 }, /* 0xe3540000 */
2589 { TARGET_SD_LANE + 7, 0x138000 }, /* 0xe3548000 */
2590 { TARGET_SD_LANE + 8, 0x140000 }, /* 0xe3550000 */
2591 { TARGET_SD_LANE + 9, 0x148000 }, /* 0xe3558000 */
2592};
2593
2594static const struct sparx5_serdes_match_data sparx5_desc = {
2595 .type = SPX5_TARGET_SPARX5,
2596 .iomap = sparx5_serdes_iomap,
2597 .iomap_size = ARRAY_SIZE(sparx5_serdes_iomap),
2598 .tsize = sparx5_serdes_tsize,
2599 .consts = {
2600 .sd_max = 33,
2601 .cmu_max = 14,
2602 },
2603 .ops = {
2604 .serdes_type_set = &sparx5_serdes_type_set,
2605 .serdes_cmu_get = &sparx5_serdes_cmu_get,
2606 },
2607};
2608
2609static const struct sparx5_serdes_match_data lan969x_desc = {
2610 .type = SPX5_TARGET_LAN969X,
2611 .iomap = lan969x_serdes_iomap,
2612 .iomap_size = ARRAY_SIZE(lan969x_serdes_iomap),
2613 .tsize = lan969x_serdes_tsize,
2614 .consts = {
2615 .sd_max = 10,
2616 .cmu_max = 6,
2617 },
2618 .ops = {
2619 .serdes_type_set = &lan969x_serdes_type_set,
2620 .serdes_cmu_get = &lan969x_serdes_cmu_get,
2621 }
2622};
2623
2624/* Client lookup function, uses serdes index */
2625static struct phy *sparx5_serdes_xlate(struct device *dev,
2626 const struct of_phandle_args *args)
2627{
2628 struct sparx5_serdes_private *priv = dev_get_drvdata(dev);
2629 int idx;
2630 unsigned int sidx;
2631
2632 if (args->args_count != 1)
2633 return ERR_PTR(-EINVAL);
2634
2635 sidx = args->args[0];
2636
2637 /* Check validity: ERR_PTR(-ENODEV) if not valid */
2638 for (idx = 0; idx < priv->data->consts.sd_max; idx++) {
2639 struct sparx5_serdes_macro *macro =
2640 phy_get_drvdata(priv->phys[idx]);
2641
2642 if (sidx != macro->sidx)
2643 continue;
2644
2645 return priv->phys[idx];
2646 }
2647 return ERR_PTR(-ENODEV);
2648}
2649
2650static int sparx5_serdes_probe(struct platform_device *pdev)
2651{
2652 struct device_node *np = pdev->dev.of_node;
2653 struct sparx5_serdes_private *priv;
2654 struct phy_provider *provider;
2655 struct resource *iores;
2656 void __iomem *iomem;
2657 unsigned long clock;
2658 struct clk *clk;
2659 int idx;
2660 int err;
2661
2662 if (!np && !pdev->dev.platform_data)
2663 return -ENODEV;
2664
2665 priv = devm_kzalloc(&pdev->dev, sizeof(*priv), GFP_KERNEL);
2666 if (!priv)
2667 return -ENOMEM;
2668
2669 platform_set_drvdata(pdev, priv);
2670 priv->dev = &pdev->dev;
2671
2672 priv->data = device_get_match_data(priv->dev);
2673 if (!priv->data)
2674 return -EINVAL;
2675
2676 tsize = priv->data->tsize;
2677
2678 /* Get coreclock */
2679 clk = devm_clk_get(priv->dev, NULL);
2680 if (IS_ERR(clk)) {
2681 dev_err(priv->dev, "Failed to get coreclock\n");
2682 return PTR_ERR(clk);
2683 }
2684 clock = clk_get_rate(clk);
2685 if (clock == 0) {
2686 dev_err(priv->dev, "Invalid coreclock %lu\n", clock);
2687 return -EINVAL;
2688 }
2689 priv->coreclock = clock;
2690
2691 iores = platform_get_resource(pdev, IORESOURCE_MEM, 0);
2692 if (!iores) {
2693 dev_err(priv->dev, "Invalid resource\n");
2694 return -EINVAL;
2695 }
2696 iomem = devm_ioremap(priv->dev, iores->start, resource_size(iores));
2697 if (!iomem) {
2698 dev_err(priv->dev, "Unable to get serdes registers: %s\n",
2699 iores->name);
2700 return -ENOMEM;
2701 }
2702 for (idx = 0; idx < priv->data->iomap_size; idx++) {
2703 const struct sparx5_serdes_io_resource *iomap =
2704 &priv->data->iomap[idx];
2705
2706 priv->regs[iomap->id] = iomem + iomap->offset;
2707 }
2708 for (idx = 0; idx < priv->data->consts.sd_max; idx++) {
2709 err = sparx5_phy_create(priv, idx, &priv->phys[idx]);
2710 if (err)
2711 return err;
2712 }
2713
2714 /* Power down all CMU's by default */
2715 if (priv->data->type == SPX5_TARGET_SPARX5)
2716 sparx5_serdes_cmu_power_off(priv);
2717
2718 provider = devm_of_phy_provider_register(priv->dev, sparx5_serdes_xlate);
2719
2720 return PTR_ERR_OR_ZERO(provider);
2721}
2722
2723static const struct of_device_id sparx5_serdes_match[] = {
2724 { .compatible = "microchip,sparx5-serdes", .data = &sparx5_desc },
2725 { .compatible = "microchip,lan9691-serdes", .data = &lan969x_desc },
2726 { }
2727};
2728MODULE_DEVICE_TABLE(of, sparx5_serdes_match);
2729
2730static struct platform_driver sparx5_serdes_driver = {
2731 .probe = sparx5_serdes_probe,
2732 .driver = {
2733 .name = "sparx5-serdes",
2734 .of_match_table = sparx5_serdes_match,
2735 },
2736};
2737
2738module_platform_driver(sparx5_serdes_driver);
2739
2740MODULE_DESCRIPTION("Microchip Sparx5 switch serdes driver");
2741MODULE_AUTHOR("Steen Hegelund <steen.hegelund@microchip.com>");
2742MODULE_LICENSE("GPL v2");