]> git.ipfire.org Git - people/ms/u-boot.git/blame - board/freescale/b4860qds/b4860qds.c
Merge branch 'u-boot-tegra/master' into 'u-boot-arm/master'
[people/ms/u-boot.git] / board / freescale / b4860qds / b4860qds.c
CommitLineData
b5b06fb7
YS
1/*
2 * Copyright 2011-2012 Freescale Semiconductor, Inc.
3 *
1a459660 4 * SPDX-License-Identifier: GPL-2.0+
b5b06fb7
YS
5 */
6
7#include <common.h>
8#include <command.h>
9#include <i2c.h>
10#include <netdev.h>
11#include <linux/compiler.h>
12#include <asm/mmu.h>
13#include <asm/processor.h>
fb07c0a1 14#include <asm/errno.h>
b5b06fb7
YS
15#include <asm/cache.h>
16#include <asm/immap_85xx.h>
17#include <asm/fsl_law.h>
18#include <asm/fsl_serdes.h>
19#include <asm/fsl_portals.h>
20#include <asm/fsl_liodn.h>
21#include <fm_eth.h>
22
23#include "../common/qixis.h"
24#include "../common/vsc3316_3308.h"
cb033741 25#include "../common/idt8t49n222a_serdes_clk.h"
652e29b4 26#include "../common/zm7300.h"
b5b06fb7
YS
27#include "b4860qds.h"
28#include "b4860qds_qixis.h"
29#include "b4860qds_crossbar_con.h"
30
31#define CLK_MUX_SEL_MASK 0x4
32#define ETH_PHY_CLK_OUT 0x4
33
34DECLARE_GLOBAL_DATA_PTR;
35
36int checkboard(void)
37{
38 char buf[64];
39 u8 sw;
67ac13b1 40 struct cpu_type *cpu = gd->arch.cpu;
b5b06fb7
YS
41 static const char *const freq[] = {"100", "125", "156.25", "161.13",
42 "122.88", "122.88", "122.88"};
43 int clock;
44
45 printf("Board: %sQDS, ", cpu->name);
46 printf("Sys ID: 0x%02x, Sys Ver: 0x%02x, ",
47 QIXIS_READ(id), QIXIS_READ(arch));
48
49 sw = QIXIS_READ(brdcfg[0]);
50 sw = (sw & QIXIS_LBMAP_MASK) >> QIXIS_LBMAP_SHIFT;
51
52 if (sw < 0x8)
53 printf("vBank: %d\n", sw);
54 else if (sw >= 0x8 && sw <= 0xE)
55 puts("NAND\n");
56 else
57 printf("invalid setting of SW%u\n", QIXIS_LBMAP_SWITCH);
58
59 printf("FPGA: v%d (%s), build %d",
60 (int)QIXIS_READ(scver), qixis_read_tag(buf),
61 (int)qixis_read_minor());
62 /* the timestamp string contains "\n" at the end */
63 printf(" on %s", qixis_read_time(buf));
64
b5b06fb7
YS
65 /*
66 * Display the actual SERDES reference clocks as configured by the
67 * dip switches on the board. Note that the SWx registers could
68 * technically be set to force the reference clocks to match the
69 * values that the SERDES expects (or vice versa). For now, however,
70 * we just display both values and hope the user notices when they
71 * don't match.
72 */
73 puts("SERDES Reference Clocks: ");
74 sw = QIXIS_READ(brdcfg[2]);
75 clock = (sw >> 5) & 7;
76 printf("Bank1=%sMHz ", freq[clock]);
77 sw = QIXIS_READ(brdcfg[4]);
78 clock = (sw >> 6) & 3;
79 printf("Bank2=%sMHz\n", freq[clock]);
80
81 return 0;
82}
83
84int select_i2c_ch_pca(u8 ch)
85{
86 int ret;
87
88 /* Selecting proper channel via PCA*/
89 ret = i2c_write(I2C_MUX_PCA_ADDR, 0x0, 1, &ch, 1);
90 if (ret) {
91 printf("PCA: failed to select proper channel.\n");
92 return ret;
93 }
94
95 return 0;
96}
97
652e29b4
SL
98/*
99 * read_voltage from sensor on I2C bus
100 * We use average of 4 readings, waiting for 532us befor another reading
101 */
102#define WAIT_FOR_ADC 532 /* wait for 532 microseconds for ADC */
103#define NUM_READINGS 4 /* prefer to be power of 2 for efficiency */
104
105static inline int read_voltage(void)
106{
107 int i, ret, voltage_read = 0;
108 u16 vol_mon;
109
110 for (i = 0; i < NUM_READINGS; i++) {
111 ret = i2c_read(I2C_VOL_MONITOR_ADDR,
112 I2C_VOL_MONITOR_BUS_V_OFFSET, 1, (void *)&vol_mon, 2);
113 if (ret) {
114 printf("VID: failed to read core voltage\n");
115 return ret;
116 }
117 if (vol_mon & I2C_VOL_MONITOR_BUS_V_OVF) {
118 printf("VID: Core voltage sensor error\n");
119 return -1;
120 }
121 debug("VID: bus voltage reads 0x%04x\n", vol_mon);
122 /* LSB = 4mv */
123 voltage_read += (vol_mon >> I2C_VOL_MONITOR_BUS_V_SHIFT) * 4;
124 udelay(WAIT_FOR_ADC);
125 }
126 /* calculate the average */
127 voltage_read /= NUM_READINGS;
128
129 return voltage_read;
130}
131
132static int adjust_vdd(ulong vdd_override)
133{
134 int re_enable = disable_interrupts();
135 ccsr_gur_t __iomem *gur =
136 (void __iomem *)(CONFIG_SYS_MPC85xx_GUTS_ADDR);
137 u32 fusesr;
138 u8 vid;
139 int vdd_target, vdd_last;
140 int existing_voltage, temp_voltage, voltage; /* all in 1/10 mV */
141 int ret;
142 unsigned int orig_i2c_speed;
143 unsigned long vdd_string_override;
144 char *vdd_string;
145 static const uint16_t vdd[32] = {
146 0, /* unused */
147 9875, /* 0.9875V */
148 9750,
149 9625,
150 9500,
151 9375,
152 9250,
153 9125,
154 9000,
155 8875,
156 8750,
157 8625,
158 8500,
159 8375,
160 8250,
161 8125,
162 10000, /* 1.0000V */
163 10125,
164 10250,
165 10375,
166 10500,
167 10625,
168 10750,
169 10875,
170 11000,
171 0, /* reserved */
172 };
173 struct vdd_drive {
174 u8 vid;
175 unsigned voltage;
176 };
177
178 ret = select_i2c_ch_pca(I2C_MUX_CH_VOL_MONITOR);
179 if (ret) {
180 printf("VID: I2c failed to switch channel\n");
181 ret = -1;
182 goto exit;
183 }
184
185 /* get the voltage ID from fuse status register */
186 fusesr = in_be32(&gur->dcfg_fusesr);
187 vid = (fusesr >> FSL_CORENET_DCFG_FUSESR_VID_SHIFT) &
188 FSL_CORENET_DCFG_FUSESR_VID_MASK;
189 if (vid == FSL_CORENET_DCFG_FUSESR_VID_MASK) {
190 vid = (fusesr >> FSL_CORENET_DCFG_FUSESR_ALTVID_SHIFT) &
191 FSL_CORENET_DCFG_FUSESR_ALTVID_MASK;
192 }
193 vdd_target = vdd[vid];
194 debug("VID:Reading from from fuse,vid=%x vdd is %dmV\n",
195 vid, vdd_target/10);
196
197 /* check override variable for overriding VDD */
198 vdd_string = getenv("b4qds_vdd_mv");
199 if (vdd_override == 0 && vdd_string &&
200 !strict_strtoul(vdd_string, 10, &vdd_string_override))
201 vdd_override = vdd_string_override;
202 if (vdd_override >= 819 && vdd_override <= 1212) {
203 vdd_target = vdd_override * 10; /* convert to 1/10 mV */
204 debug("VDD override is %lu\n", vdd_override);
205 } else if (vdd_override != 0) {
206 printf("Invalid value.\n");
207 }
208
209 if (vdd_target == 0) {
210 printf("VID: VID not used\n");
211 ret = 0;
212 goto exit;
213 }
214
215 /*
216 * Read voltage monitor to check real voltage.
217 * Voltage monitor LSB is 4mv.
218 */
219 vdd_last = read_voltage();
220 if (vdd_last < 0) {
221 printf("VID: abort VID adjustment\n");
222 ret = -1;
223 goto exit;
224 }
225
226 debug("VID: Core voltage is at %d mV\n", vdd_last);
227 ret = select_i2c_ch_pca(I2C_MUX_CH_DPM);
228 if (ret) {
229 printf("VID: I2c failed to switch channel to DPM\n");
230 ret = -1;
231 goto exit;
232 }
233
234 /* Round up to the value of step of Voltage regulator */
235 voltage = roundup(vdd_target, ZM_STEP);
236 debug("VID: rounded up voltage = %d\n", voltage);
237
238 /* lower the speed to 100kHz to access ZM7300 device */
239 debug("VID: Setting bus speed to 100KHz if not already set\n");
240 orig_i2c_speed = i2c_get_bus_speed();
241 if (orig_i2c_speed != 100000)
242 i2c_set_bus_speed(100000);
243
244 /* Read the existing level on board, if equal to requsted one,
245 no need to re-set */
246 existing_voltage = zm_read_voltage();
247
248 /* allowing the voltage difference of one step 0.0125V acceptable */
249 if ((existing_voltage >= voltage) &&
250 (existing_voltage < (voltage + ZM_STEP))) {
251 debug("VID: voltage already set as requested,returning\n");
252 ret = existing_voltage;
253 goto out;
254 }
255 debug("VID: Changing voltage for board from %dmV to %dmV\n",
256 existing_voltage/10, voltage/10);
257
258 if (zm_disable_wp() < 0) {
259 ret = -1;
260 goto out;
261 }
262 /* Change Voltage: the change is done through all the steps in the
263 way, to avoid reset to the board due to power good signal fail
264 in big voltage change gap jump.
265 */
266 if (existing_voltage > voltage) {
267 temp_voltage = existing_voltage - ZM_STEP;
268 while (temp_voltage >= voltage) {
269 ret = zm_write_voltage(temp_voltage);
270 if (ret == temp_voltage) {
271 temp_voltage -= ZM_STEP;
272 } else {
273 /* ZM7300 device failed to set
274 * the voltage */
275 printf
276 ("VID:Stepping down vol failed:%dmV\n",
277 temp_voltage/10);
278 ret = -1;
279 goto out;
280 }
281 }
282 } else {
283 temp_voltage = existing_voltage + ZM_STEP;
284 while (temp_voltage < (voltage + ZM_STEP)) {
285 ret = zm_write_voltage(temp_voltage);
286 if (ret == temp_voltage) {
287 temp_voltage += ZM_STEP;
288 } else {
289 /* ZM7300 device failed to set
290 * the voltage */
291 printf
292 ("VID:Stepping up vol failed:%dmV\n",
293 temp_voltage/10);
294 ret = -1;
295 goto out;
296 }
297 }
298 }
299
300 if (zm_enable_wp() < 0)
301 ret = -1;
302
303 /* restore the speed to 400kHz */
304out: debug("VID: Restore the I2C bus speed to %dKHz\n",
305 orig_i2c_speed/1000);
306 i2c_set_bus_speed(orig_i2c_speed);
307 if (ret < 0)
308 goto exit;
309
310 ret = select_i2c_ch_pca(I2C_MUX_CH_VOL_MONITOR);
311 if (ret) {
312 printf("VID: I2c failed to switch channel\n");
313 ret = -1;
314 goto exit;
315 }
316 vdd_last = read_voltage();
317 select_i2c_ch_pca(I2C_CH_DEFAULT);
318
319 if (vdd_last > 0)
320 printf("VID: Core voltage %d mV\n", vdd_last);
321 else
322 ret = -1;
323
324exit:
325 if (re_enable)
326 enable_interrupts();
327 return ret;
328}
329
b5b06fb7
YS
330int configure_vsc3316_3308(void)
331{
332 ccsr_gur_t *gur = (void *)(CONFIG_SYS_MPC85xx_GUTS_ADDR);
333 unsigned int num_vsc16_con, num_vsc08_con;
334 u32 serdes1_prtcl, serdes2_prtcl;
335 int ret;
336
337 serdes1_prtcl = in_be32(&gur->rcwsr[4]) &
338 FSL_CORENET2_RCWSR4_SRDS1_PRTCL;
339 if (!serdes1_prtcl) {
340 printf("SERDES1 is not enabled\n");
341 return 0;
342 }
343 serdes1_prtcl >>= FSL_CORENET2_RCWSR4_SRDS1_PRTCL_SHIFT;
344 debug("Using SERDES1 Protocol: 0x%x:\n", serdes1_prtcl);
345
346 serdes2_prtcl = in_be32(&gur->rcwsr[4]) &
347 FSL_CORENET2_RCWSR4_SRDS2_PRTCL;
348 if (!serdes2_prtcl) {
349 printf("SERDES2 is not enabled\n");
350 return 0;
351 }
352 serdes2_prtcl >>= FSL_CORENET2_RCWSR4_SRDS2_PRTCL_SHIFT;
353 debug("Using SERDES2 Protocol: 0x%x:\n", serdes2_prtcl);
354
355 switch (serdes1_prtcl) {
c7d506d4 356 case 0x29:
b5b06fb7
YS
357 case 0x2a:
358 case 0x2C:
359 case 0x2D:
360 case 0x2E:
361 /*
362 * Configuration:
363 * SERDES: 1
364 * Lanes: A,B: SGMII
365 * Lanes: C,D,E,F,G,H: CPRI
366 */
367 debug("Configuring crossbar to use onboard SGMII PHYs:"
368 "srds_prctl:%x\n", serdes1_prtcl);
369 num_vsc16_con = NUM_CON_VSC3316;
370 /* Configure VSC3316 crossbar switch */
371 ret = select_i2c_ch_pca(I2C_CH_VSC3316);
372 if (!ret) {
373 ret = vsc3316_config(VSC3316_TX_ADDRESS,
0fecbba8
SL
374 vsc16_tx_4sfp_sgmii_12_56,
375 num_vsc16_con);
b5b06fb7
YS
376 if (ret)
377 return ret;
378 ret = vsc3316_config(VSC3316_RX_ADDRESS,
0fecbba8
SL
379 vsc16_rx_4sfp_sgmii_12_56,
380 num_vsc16_con);
b5b06fb7
YS
381 if (ret)
382 return ret;
383 } else {
384 return ret;
385 }
386 break;
387
5e5097c1
SL
388 case 0x02:
389 case 0x04:
390 case 0x05:
391 case 0x06:
392 case 0x08:
393 case 0x09:
394 case 0x0A:
395 case 0x0B:
396 case 0x0C:
397 case 0x30:
398 case 0x32:
399 case 0x33:
400 case 0x34:
401 case 0x39:
402 case 0x3A:
403 case 0x3C:
404 case 0x3D:
405 case 0x5C:
406 case 0x5D:
407 /*
408 * Configuration:
409 * SERDES: 1
410 * Lanes: A,B: AURORA
411 * Lanes: C,d: SGMII
412 * Lanes: E,F,G,H: CPRI
413 */
414 debug("Configuring crossbar for Aurora, SGMII 3 and 4,"
415 " and CPRI. srds_prctl:%x\n", serdes1_prtcl);
416 num_vsc16_con = NUM_CON_VSC3316;
417 /* Configure VSC3316 crossbar switch */
418 ret = select_i2c_ch_pca(I2C_CH_VSC3316);
419 if (!ret) {
420 ret = vsc3316_config(VSC3316_TX_ADDRESS,
421 vsc16_tx_sfp_sgmii_aurora,
422 num_vsc16_con);
423 if (ret)
424 return ret;
425 ret = vsc3316_config(VSC3316_RX_ADDRESS,
426 vsc16_rx_sfp_sgmii_aurora,
427 num_vsc16_con);
428 if (ret)
429 return ret;
430 } else {
431 return ret;
432 }
433 break;
434
b5b06fb7 435#ifdef CONFIG_PPC_B4420
c7d506d4 436 case 0x17:
b5b06fb7
YS
437 case 0x18:
438 /*
439 * Configuration:
440 * SERDES: 1
441 * Lanes: A,B,C,D: SGMII
442 * Lanes: E,F,G,H: CPRI
443 */
444 debug("Configuring crossbar to use onboard SGMII PHYs:"
445 "srds_prctl:%x\n", serdes1_prtcl);
446 num_vsc16_con = NUM_CON_VSC3316;
447 /* Configure VSC3316 crossbar switch */
448 ret = select_i2c_ch_pca(I2C_CH_VSC3316);
449 if (!ret) {
450 ret = vsc3316_config(VSC3316_TX_ADDRESS,
451 vsc16_tx_sgmii_lane_cd, num_vsc16_con);
452 if (ret)
453 return ret;
454 ret = vsc3316_config(VSC3316_RX_ADDRESS,
455 vsc16_rx_sgmii_lane_cd, num_vsc16_con);
456 if (ret)
457 return ret;
458 } else {
459 return ret;
460 }
461 break;
462#endif
463
464 case 0x3E:
465 case 0x0D:
466 case 0x0E:
467 case 0x12:
468 num_vsc16_con = NUM_CON_VSC3316;
469 /* Configure VSC3316 crossbar switch */
470 ret = select_i2c_ch_pca(I2C_CH_VSC3316);
471 if (!ret) {
472 ret = vsc3316_config(VSC3316_TX_ADDRESS,
473 vsc16_tx_sfp, num_vsc16_con);
474 if (ret)
475 return ret;
476 ret = vsc3316_config(VSC3316_RX_ADDRESS,
477 vsc16_rx_sfp, num_vsc16_con);
478 if (ret)
479 return ret;
480 } else {
481 return ret;
482 }
483 break;
484 default:
485 printf("WARNING:VSC crossbars programming not supported for:%x"
486 " SerDes1 Protocol.\n", serdes1_prtcl);
487 return -1;
488 }
489
490 switch (serdes2_prtcl) {
fa6e7428 491#ifdef CONFIG_PPC_B4420
492 case 0x9d:
493#endif
b5b06fb7
YS
494 case 0x9E:
495 case 0x9A:
496 case 0x98:
497 case 0xb2:
498 case 0x49:
499 case 0x4E:
500 case 0x8D:
501 case 0x7A:
502 num_vsc08_con = NUM_CON_VSC3308;
503 /* Configure VSC3308 crossbar switch */
504 ret = select_i2c_ch_pca(I2C_CH_VSC3308);
505 if (!ret) {
506 ret = vsc3308_config(VSC3308_TX_ADDRESS,
507 vsc08_tx_amc, num_vsc08_con);
508 if (ret)
509 return ret;
510 ret = vsc3308_config(VSC3308_RX_ADDRESS,
511 vsc08_rx_amc, num_vsc08_con);
512 if (ret)
513 return ret;
514 } else {
515 return ret;
516 }
517 break;
518 default:
519 printf("WARNING:VSC crossbars programming not supported for: %x"
520 " SerDes2 Protocol.\n", serdes2_prtcl);
521 return -1;
522 }
523
524 return 0;
525}
526
7af9a074
SL
527static int calibrate_pll(serdes_corenet_t *srds_regs, int pll_num)
528{
529 u32 rst_err;
530
531 /* Steps For SerDes PLLs reset and reconfiguration
532 * or PLL power-up procedure
533 */
534 debug("CALIBRATE PLL:%d\n", pll_num);
535 clrbits_be32(&srds_regs->bank[pll_num].rstctl,
536 SRDS_RSTCTL_SDRST_B);
537 udelay(10);
538 clrbits_be32(&srds_regs->bank[pll_num].rstctl,
539 (SRDS_RSTCTL_SDEN | SRDS_RSTCTL_PLLRST_B));
540 udelay(10);
541 setbits_be32(&srds_regs->bank[pll_num].rstctl,
542 SRDS_RSTCTL_RST);
543 setbits_be32(&srds_regs->bank[pll_num].rstctl,
544 (SRDS_RSTCTL_SDEN | SRDS_RSTCTL_PLLRST_B
545 | SRDS_RSTCTL_SDRST_B));
546
547 udelay(20);
548
549 /* Check whether PLL has been locked or not */
550 rst_err = in_be32(&srds_regs->bank[pll_num].rstctl) &
551 SRDS_RSTCTL_RSTERR;
552 rst_err >>= SRDS_RSTCTL_RSTERR_SHIFT;
553 debug("RST_ERR value for PLL %d is: 0x%x:\n", pll_num, rst_err);
554 if (rst_err)
555 return rst_err;
556
557 return rst_err;
558}
559
560static int check_pll_locks(serdes_corenet_t *srds_regs, int pll_num)
561{
562 int ret = 0;
563 u32 fcap, dcbias, bcap, pllcr1, pllcr0;
564
565 if (calibrate_pll(srds_regs, pll_num)) {
566 /* STEP 1 */
567 /* Read fcap, dcbias and bcap value */
568 clrbits_be32(&srds_regs->bank[pll_num].pllcr0,
569 SRDS_PLLCR0_DCBIAS_OUT_EN);
570 fcap = in_be32(&srds_regs->bank[pll_num].pllsr2) &
571 SRDS_PLLSR2_FCAP;
572 fcap >>= SRDS_PLLSR2_FCAP_SHIFT;
573 bcap = in_be32(&srds_regs->bank[pll_num].pllsr2) &
574 SRDS_PLLSR2_BCAP_EN;
575 bcap >>= SRDS_PLLSR2_BCAP_EN_SHIFT;
576 setbits_be32(&srds_regs->bank[pll_num].pllcr0,
577 SRDS_PLLCR0_DCBIAS_OUT_EN);
578 dcbias = in_be32(&srds_regs->bank[pll_num].pllsr2) &
579 SRDS_PLLSR2_DCBIAS;
580 dcbias >>= SRDS_PLLSR2_DCBIAS_SHIFT;
581 debug("values of bcap:%x, fcap:%x and dcbias:%x\n",
582 bcap, fcap, dcbias);
583 if (fcap == 0 && bcap == 1) {
584 /* Step 3 */
585 clrbits_be32(&srds_regs->bank[pll_num].rstctl,
586 (SRDS_RSTCTL_SDEN | SRDS_RSTCTL_PLLRST_B
587 | SRDS_RSTCTL_SDRST_B));
588 clrbits_be32(&srds_regs->bank[pll_num].pllcr1,
589 SRDS_PLLCR1_BCAP_EN);
590 setbits_be32(&srds_regs->bank[pll_num].pllcr1,
591 SRDS_PLLCR1_BCAP_OVD);
592 if (calibrate_pll(srds_regs, pll_num)) {
593 /*save the fcap, dcbias and bcap values*/
594 clrbits_be32(&srds_regs->bank[pll_num].pllcr0,
595 SRDS_PLLCR0_DCBIAS_OUT_EN);
596 fcap = in_be32(&srds_regs->bank[pll_num].pllsr2)
597 & SRDS_PLLSR2_FCAP;
598 fcap >>= SRDS_PLLSR2_FCAP_SHIFT;
599 bcap = in_be32(&srds_regs->bank[pll_num].pllsr2)
600 & SRDS_PLLSR2_BCAP_EN;
601 bcap >>= SRDS_PLLSR2_BCAP_EN_SHIFT;
602 setbits_be32(&srds_regs->bank[pll_num].pllcr0,
603 SRDS_PLLCR0_DCBIAS_OUT_EN);
604 dcbias = in_be32
605 (&srds_regs->bank[pll_num].pllsr2) &
606 SRDS_PLLSR2_DCBIAS;
607 dcbias >>= SRDS_PLLSR2_DCBIAS_SHIFT;
608
609 /* Step 4*/
610 clrbits_be32(&srds_regs->bank[pll_num].rstctl,
611 (SRDS_RSTCTL_SDEN | SRDS_RSTCTL_PLLRST_B
612 | SRDS_RSTCTL_SDRST_B));
613 setbits_be32(&srds_regs->bank[pll_num].pllcr1,
614 SRDS_PLLCR1_BYP_CAL);
615 clrbits_be32(&srds_regs->bank[pll_num].pllcr1,
616 SRDS_PLLCR1_BCAP_EN);
617 setbits_be32(&srds_regs->bank[pll_num].pllcr1,
618 SRDS_PLLCR1_BCAP_OVD);
619 /* change the fcap and dcbias to the saved
620 * values from Step 3 */
621 clrbits_be32(&srds_regs->bank[pll_num].pllcr1,
622 SRDS_PLLCR1_PLL_FCAP);
623 pllcr1 = (in_be32
624 (&srds_regs->bank[pll_num].pllcr1)|
625 (fcap << SRDS_PLLCR1_PLL_FCAP_SHIFT));
626 out_be32(&srds_regs->bank[pll_num].pllcr1,
627 pllcr1);
628 clrbits_be32(&srds_regs->bank[pll_num].pllcr0,
629 SRDS_PLLCR0_DCBIAS_OVRD);
630 pllcr0 = (in_be32
631 (&srds_regs->bank[pll_num].pllcr0)|
632 (dcbias << SRDS_PLLCR0_DCBIAS_OVRD_SHIFT));
633 out_be32(&srds_regs->bank[pll_num].pllcr0,
634 pllcr0);
635 ret = calibrate_pll(srds_regs, pll_num);
636 if (ret)
637 return ret;
638 } else {
639 goto out;
640 }
641 } else { /* Step 5 */
642 clrbits_be32(&srds_regs->bank[pll_num].rstctl,
643 (SRDS_RSTCTL_SDEN | SRDS_RSTCTL_PLLRST_B
644 | SRDS_RSTCTL_SDRST_B));
645 udelay(10);
646 /* Change the fcap, dcbias, and bcap to the
647 * values from Step 1 */
648 setbits_be32(&srds_regs->bank[pll_num].pllcr1,
649 SRDS_PLLCR1_BYP_CAL);
650 clrbits_be32(&srds_regs->bank[pll_num].pllcr1,
651 SRDS_PLLCR1_PLL_FCAP);
652 pllcr1 = (in_be32(&srds_regs->bank[pll_num].pllcr1)|
653 (fcap << SRDS_PLLCR1_PLL_FCAP_SHIFT));
654 out_be32(&srds_regs->bank[pll_num].pllcr1,
655 pllcr1);
656 clrbits_be32(&srds_regs->bank[pll_num].pllcr0,
657 SRDS_PLLCR0_DCBIAS_OVRD);
658 pllcr0 = (in_be32(&srds_regs->bank[pll_num].pllcr0)|
659 (dcbias << SRDS_PLLCR0_DCBIAS_OVRD_SHIFT));
660 out_be32(&srds_regs->bank[pll_num].pllcr0,
661 pllcr0);
662 clrbits_be32(&srds_regs->bank[pll_num].pllcr1,
663 SRDS_PLLCR1_BCAP_EN);
664 setbits_be32(&srds_regs->bank[pll_num].pllcr1,
665 SRDS_PLLCR1_BCAP_OVD);
666 ret = calibrate_pll(srds_regs, pll_num);
667 if (ret)
668 return ret;
669 }
670 }
671out:
672 return 0;
673}
674
675static int check_serdes_pll_locks(void)
676{
677 serdes_corenet_t *srds1_regs =
678 (void *)CONFIG_SYS_FSL_CORENET_SERDES_ADDR;
679 serdes_corenet_t *srds2_regs =
680 (void *)CONFIG_SYS_FSL_CORENET_SERDES2_ADDR;
681 int i, ret1, ret2;
682
683 debug("\nSerDes1 Lock check\n");
684 for (i = 0; i < CONFIG_SYS_FSL_SRDS_NUM_PLLS; i++) {
685 ret1 = check_pll_locks(srds1_regs, i);
686 if (ret1) {
687 printf("SerDes1, PLL:%d didnt lock\n", i);
688 return ret1;
689 }
690 }
691 debug("\nSerDes2 Lock check\n");
692 for (i = 0; i < CONFIG_SYS_FSL_SRDS_NUM_PLLS; i++) {
693 ret2 = check_pll_locks(srds2_regs, i);
694 if (ret2) {
695 printf("SerDes2, PLL:%d didnt lock\n", i);
696 return ret2;
697 }
698 }
699
700 return 0;
701}
702
cb033741
SL
703int config_serdes1_refclks(void)
704{
705 ccsr_gur_t *gur = (void *)(CONFIG_SYS_MPC85xx_GUTS_ADDR);
706 serdes_corenet_t *srds_regs =
707 (void *)CONFIG_SYS_FSL_CORENET_SERDES_ADDR;
708 u32 serdes1_prtcl, lane;
5e5097c1 709 unsigned int flag_sgmii_aurora_prtcl = 0;
fb07c0a1
SL
710 int i;
711 int ret = 0;
cb033741
SL
712
713 serdes1_prtcl = in_be32(&gur->rcwsr[4]) &
714 FSL_CORENET2_RCWSR4_SRDS1_PRTCL;
715 if (!serdes1_prtcl) {
716 printf("SERDES1 is not enabled\n");
717 return -1;
718 }
719 serdes1_prtcl >>= FSL_CORENET2_RCWSR4_SRDS1_PRTCL_SHIFT;
720 debug("Using SERDES1 Protocol: 0x%x:\n", serdes1_prtcl);
721
fb07c0a1
SL
722 /* To prevent generation of reset request from SerDes
723 * while changing the refclks, By setting SRDS_RST_MSK bit,
724 * SerDes reset event cannot cause a reset request
cb033741 725 */
fb07c0a1
SL
726 setbits_be32(&gur->rstrqmr1, FSL_CORENET_RSTRQMR1_SRDS_RST_MSK);
727
cb033741
SL
728 /* Reconfigure IDT idt8t49n222a device for CPRI to work
729 * For this SerDes1's Refclk1 and refclk2 need to be set
730 * to 122.88MHz
731 */
732 switch (serdes1_prtcl) {
733 case 0x2A:
734 case 0x2C:
735 case 0x2D:
736 case 0x2E:
5e5097c1
SL
737 case 0x02:
738 case 0x04:
739 case 0x05:
740 case 0x06:
741 case 0x08:
742 case 0x09:
743 case 0x0A:
744 case 0x0B:
745 case 0x0C:
746 case 0x30:
747 case 0x32:
748 case 0x33:
749 case 0x34:
750 case 0x39:
751 case 0x3A:
752 case 0x3C:
753 case 0x3D:
754 case 0x5C:
755 case 0x5D:
cb033741
SL
756 debug("Configuring idt8t49n222a for CPRI SerDes clks:"
757 " for srds_prctl:%x\n", serdes1_prtcl);
758 ret = select_i2c_ch_pca(I2C_CH_IDT);
759 if (!ret) {
760 ret = set_serdes_refclk(IDT_SERDES1_ADDRESS, 1,
761 SERDES_REFCLK_122_88,
762 SERDES_REFCLK_122_88, 0);
763 if (ret) {
764 printf("IDT8T49N222A configuration failed.\n");
fb07c0a1 765 goto out;
cb033741 766 } else
fb07c0a1 767 debug("IDT8T49N222A configured.\n");
cb033741 768 } else {
fb07c0a1 769 goto out;
cb033741
SL
770 }
771 select_i2c_ch_pca(I2C_CH_DEFAULT);
772
773 /* Change SerDes1's Refclk1 to 125MHz for on board
5e5097c1 774 * SGMIIs or Aurora to work
cb033741
SL
775 */
776 for (lane = 0; lane < SRDS_MAX_LANES; lane++) {
777 enum srds_prtcl lane_prtcl = serdes_get_prtcl
778 (0, serdes1_prtcl, lane);
779 switch (lane_prtcl) {
780 case SGMII_FM1_DTSEC1:
781 case SGMII_FM1_DTSEC2:
782 case SGMII_FM1_DTSEC3:
783 case SGMII_FM1_DTSEC4:
784 case SGMII_FM1_DTSEC5:
785 case SGMII_FM1_DTSEC6:
5e5097c1
SL
786 case AURORA:
787 flag_sgmii_aurora_prtcl++;
cb033741
SL
788 break;
789 default:
790 break;
791 }
792 }
793
5e5097c1 794 if (flag_sgmii_aurora_prtcl)
cb033741
SL
795 QIXIS_WRITE(brdcfg[4], QIXIS_SRDS1CLK_125);
796
797 /* Steps For SerDes PLLs reset and reconfiguration after
798 * changing SerDes's refclks
799 */
c4930b1a 800 for (i = 0; i < CONFIG_SYS_FSL_SRDS_NUM_PLLS; i++) {
cb033741
SL
801 debug("For PLL%d reset and reconfiguration after"
802 " changing refclks\n", i+1);
803 clrbits_be32(&srds_regs->bank[i].rstctl,
804 SRDS_RSTCTL_SDRST_B);
805 udelay(10);
806 clrbits_be32(&srds_regs->bank[i].rstctl,
807 (SRDS_RSTCTL_SDEN | SRDS_RSTCTL_PLLRST_B));
808 udelay(10);
809 setbits_be32(&srds_regs->bank[i].rstctl,
810 SRDS_RSTCTL_RST);
811 setbits_be32(&srds_regs->bank[i].rstctl,
812 (SRDS_RSTCTL_SDEN | SRDS_RSTCTL_PLLRST_B
813 | SRDS_RSTCTL_SDRST_B));
814 }
815 break;
816 default:
817 printf("WARNING:IDT8T49N222A configuration not"
818 " supported for:%x SerDes1 Protocol.\n",
819 serdes1_prtcl);
cb033741
SL
820 }
821
fb07c0a1
SL
822out:
823 /* Clearing SRDS_RST_MSK bit as now
824 * SerDes reset event can cause a reset request
825 */
826 clrbits_be32(&gur->rstrqmr1, FSL_CORENET_RSTRQMR1_SRDS_RST_MSK);
827 return ret;
828}
829
830int config_serdes2_refclks(void)
831{
832 ccsr_gur_t *gur = (void __iomem *)(CONFIG_SYS_MPC85xx_GUTS_ADDR);
833 serdes_corenet_t *srds2_regs =
834 (void *)CONFIG_SYS_FSL_CORENET_SERDES2_ADDR;
835 u32 serdes2_prtcl;
836 int ret = 0;
837 int i;
838
839 serdes2_prtcl = in_be32(&gur->rcwsr[4]) &
840 FSL_CORENET2_RCWSR4_SRDS2_PRTCL;
841 if (!serdes2_prtcl) {
842 debug("SERDES2 is not enabled\n");
843 return -ENODEV;
844 }
845 serdes2_prtcl >>= FSL_CORENET2_RCWSR4_SRDS2_PRTCL_SHIFT;
846 debug("Using SERDES2 Protocol: 0x%x:\n", serdes2_prtcl);
847
848 /* To prevent generation of reset request from SerDes
849 * while changing the refclks, By setting SRDS_RST_MSK bit,
850 * SerDes reset event cannot cause a reset request
851 */
852 setbits_be32(&gur->rstrqmr1, FSL_CORENET_RSTRQMR1_SRDS_RST_MSK);
853
854 /* Reconfigure IDT idt8t49n222a device for PCIe SATA to work
855 * For this SerDes2's Refclk1 need to be set to 100MHz
856 */
857 switch (serdes2_prtcl) {
fa6e7428 858#ifdef CONFIG_PPC_B4420
859 case 0x9d:
860#endif
fb07c0a1
SL
861 case 0x9E:
862 case 0x9A:
863 case 0xb2:
864 debug("Configuring IDT for PCIe SATA for srds_prctl:%x\n",
865 serdes2_prtcl);
866 ret = select_i2c_ch_pca(I2C_CH_IDT);
867 if (!ret) {
868 ret = set_serdes_refclk(IDT_SERDES2_ADDRESS, 2,
869 SERDES_REFCLK_100,
c4930b1a 870 SERDES_REFCLK_156_25, 0);
fb07c0a1
SL
871 if (ret) {
872 printf("IDT8T49N222A configuration failed.\n");
873 goto out;
874 } else
875 debug("IDT8T49N222A configured.\n");
876 } else {
877 goto out;
878 }
879 select_i2c_ch_pca(I2C_CH_DEFAULT);
880
881 /* Steps For SerDes PLLs reset and reconfiguration after
882 * changing SerDes's refclks
883 */
c4930b1a 884 for (i = 0; i < CONFIG_SYS_FSL_SRDS_NUM_PLLS; i++) {
fb07c0a1
SL
885 clrbits_be32(&srds2_regs->bank[i].rstctl,
886 SRDS_RSTCTL_SDRST_B);
887 udelay(10);
888 clrbits_be32(&srds2_regs->bank[i].rstctl,
889 (SRDS_RSTCTL_SDEN | SRDS_RSTCTL_PLLRST_B));
890 udelay(10);
891 setbits_be32(&srds2_regs->bank[i].rstctl,
892 SRDS_RSTCTL_RST);
893 setbits_be32(&srds2_regs->bank[i].rstctl,
894 (SRDS_RSTCTL_SDEN | SRDS_RSTCTL_PLLRST_B
895 | SRDS_RSTCTL_SDRST_B));
7af9a074
SL
896
897 udelay(10);
fb07c0a1
SL
898 }
899 break;
900 default:
901 printf("IDT configuration not supported for:%x S2 Protocol.\n",
902 serdes2_prtcl);
903 }
904
905out:
906 /* Clearing SRDS_RST_MSK bit as now
907 * SerDes reset event can cause a reset request
908 */
909 clrbits_be32(&gur->rstrqmr1, FSL_CORENET_RSTRQMR1_SRDS_RST_MSK);
910 return ret;
cb033741
SL
911}
912
b5b06fb7
YS
913int board_early_init_r(void)
914{
915 const unsigned int flashbase = CONFIG_SYS_FLASH_BASE;
916 const u8 flash_esel = find_tlb_idx((void *)flashbase, 1);
fb07c0a1 917 int ret;
b5b06fb7
YS
918
919 /*
920 * Remap Boot flash + PROMJET region to caching-inhibited
921 * so that flash can be erased properly.
922 */
923
924 /* Flush d-cache and invalidate i-cache of any FLASH data */
925 flush_dcache();
926 invalidate_icache();
927
928 /* invalidate existing TLB entry for flash + promjet */
929 disable_tlb(flash_esel);
930
931 set_tlb(1, flashbase, CONFIG_SYS_FLASH_BASE_PHYS,
932 MAS3_SX|MAS3_SW|MAS3_SR, MAS2_I|MAS2_G,
933 0, flash_esel, BOOKE_PAGESZ_256M, 1);
934
935 set_liodns();
936#ifdef CONFIG_SYS_DPAA_QBMAN
937 setup_portals();
938#endif
652e29b4
SL
939 /*
940 * Adjust core voltage according to voltage ID
941 * This function changes I2C mux to channel 2.
942 */
943 if (adjust_vdd(0) < 0)
944 printf("Warning: Adjusting core voltage failed\n");
945
cb033741
SL
946 /* SerDes1 refclks need to be set again, as default clks
947 * are not suitable for CPRI and onboard SGMIIs to work
948 * simultaneously.
949 * This function will set SerDes1's Refclk1 and refclk2
950 * as per SerDes1 protocols
951 */
952 if (config_serdes1_refclks())
953 printf("SerDes1 Refclks couldn't set properly.\n");
954 else
955 printf("SerDes1 Refclks have been set.\n");
b5b06fb7 956
fb07c0a1
SL
957 /* SerDes2 refclks need to be set again, as default clks
958 * are not suitable for PCIe SATA to work
959 * This function will set SerDes2's Refclk1 and refclk2
960 * for SerDes2 protocols having PCIe in them
961 * for PCIe SATA to work
962 */
963 ret = config_serdes2_refclks();
964 if (!ret)
965 printf("SerDes2 Refclks have been set.\n");
966 else if (ret == -ENODEV)
967 printf("SerDes disable, Refclks couldn't change.\n");
968 else
969 printf("SerDes2 Refclk reconfiguring failed.\n");
970
7af9a074
SL
971#if defined(CONFIG_SYS_FSL_ERRATUM_A006384) || \
972 defined(CONFIG_SYS_FSL_ERRATUM_A006475)
973 /* Rechecking the SerDes locks after all SerDes configurations
974 * are done, As SerDes PLLs may not lock reliably at 5 G VCO
975 * and at cold temperatures.
976 * Following sequence ensure the proper locking of SerDes PLLs.
977 */
978 if (SVR_MAJ(get_svr()) == 1) {
979 if (check_serdes_pll_locks())
980 printf("SerDes plls still not locked properly.\n");
981 else
982 printf("SerDes plls have been locked well.\n");
983 }
984#endif
985
b5b06fb7
YS
986 /* Configure VSC3316 and VSC3308 crossbar switches */
987 if (configure_vsc3316_3308())
988 printf("VSC:failed to configure VSC3316/3308.\n");
989 else
990 printf("VSC:VSC3316/3308 successfully configured.\n");
991
992 select_i2c_ch_pca(I2C_CH_DEFAULT);
993
994 return 0;
995}
996
997unsigned long get_board_sys_clk(void)
998{
999 u8 sysclk_conf = QIXIS_READ(brdcfg[1]);
1000
1001 switch ((sysclk_conf & 0x0C) >> 2) {
1002 case QIXIS_CLK_100:
1003 return 100000000;
1004 case QIXIS_CLK_125:
1005 return 125000000;
1006 case QIXIS_CLK_133:
1007 return 133333333;
1008 }
1009 return 66666666;
1010}
1011
1012unsigned long get_board_ddr_clk(void)
1013{
1014 u8 ddrclk_conf = QIXIS_READ(brdcfg[1]);
1015
1016 switch (ddrclk_conf & 0x03) {
1017 case QIXIS_CLK_100:
1018 return 100000000;
1019 case QIXIS_CLK_125:
1020 return 125000000;
1021 case QIXIS_CLK_133:
1022 return 133333333;
1023 }
1024 return 66666666;
1025}
1026
1027static int serdes_refclock(u8 sw, u8 sdclk)
1028{
1029 unsigned int clock;
1030 int ret = -1;
1031 u8 brdcfg4;
1032
1033 if (sdclk == 1) {
1034 brdcfg4 = QIXIS_READ(brdcfg[4]);
1035 if ((brdcfg4 & CLK_MUX_SEL_MASK) == ETH_PHY_CLK_OUT)
1036 return SRDS_PLLCR0_RFCK_SEL_125;
1037 else
1038 clock = (sw >> 5) & 7;
1039 } else
1040 clock = (sw >> 6) & 3;
1041
1042 switch (clock) {
1043 case 0:
1044 ret = SRDS_PLLCR0_RFCK_SEL_100;
1045 break;
1046 case 1:
1047 ret = SRDS_PLLCR0_RFCK_SEL_125;
1048 break;
1049 case 2:
1050 ret = SRDS_PLLCR0_RFCK_SEL_156_25;
1051 break;
1052 case 3:
1053 ret = SRDS_PLLCR0_RFCK_SEL_161_13;
1054 break;
1055 case 4:
1056 case 5:
1057 case 6:
1058 ret = SRDS_PLLCR0_RFCK_SEL_122_88;
1059 break;
1060 default:
1061 ret = -1;
1062 break;
1063 }
1064
1065 return ret;
1066}
1067
b5b06fb7
YS
1068#define NUM_SRDS_BANKS 2
1069
1070int misc_init_r(void)
1071{
1072 u8 sw;
1073 serdes_corenet_t *srds_regs =
1074 (void *)CONFIG_SYS_FSL_CORENET_SERDES_ADDR;
1075 u32 actual[NUM_SRDS_BANKS];
1076 unsigned int i;
1077 int clock;
1078
1079 sw = QIXIS_READ(brdcfg[2]);
1080 clock = serdes_refclock(sw, 1);
1081 if (clock >= 0)
1082 actual[0] = clock;
1083 else
1084 printf("Warning: SDREFCLK1 switch setting is unsupported\n");
1085
1086 sw = QIXIS_READ(brdcfg[4]);
1087 clock = serdes_refclock(sw, 2);
1088 if (clock >= 0)
1089 actual[1] = clock;
1090 else
1091 printf("Warning: SDREFCLK2 switch setting unsupported\n");
1092
1093 for (i = 0; i < NUM_SRDS_BANKS; i++) {
1094 u32 pllcr0 = srds_regs->bank[i].pllcr0;
1095 u32 expected = pllcr0 & SRDS_PLLCR0_RFCK_SEL_MASK;
1096 if (expected != actual[i]) {
1097 printf("Warning: SERDES bank %u expects reference clock"
1098 " %sMHz, but actual is %sMHz\n", i + 1,
1099 serdes_clock_to_string(expected),
1100 serdes_clock_to_string(actual[i]));
1101 }
1102 }
1103
1104 return 0;
1105}
1106
1107void ft_board_setup(void *blob, bd_t *bd)
1108{
1109 phys_addr_t base;
1110 phys_size_t size;
1111
1112 ft_cpu_setup(blob, bd);
1113
1114 base = getenv_bootm_low();
1115 size = getenv_bootm_size();
1116
1117 fdt_fixup_memory(blob, (u64)base, (u64)size);
1118
1119#ifdef CONFIG_PCI
1120 pci_of_setup(blob, bd);
1121#endif
1122
1123 fdt_fixup_liodn(blob);
1124
1125#ifdef CONFIG_HAS_FSL_DR_USB
1126 fdt_fixup_dr_usb(blob, bd);
1127#endif
1128
1129#ifdef CONFIG_SYS_DPAA_FMAN
1130 fdt_fixup_fman_ethernet(blob);
1131 fdt_fixup_board_enet(blob);
1132#endif
1133}
4354889b
SL
1134
1135/*
1136 * Dump board switch settings.
1137 * The bits that cannot be read/sampled via some FPGA or some
1138 * registers, they will be displayed as
1139 * underscore in binary format. mask[] has those bits.
1140 * Some bits are calculated differently than the actual switches
1141 * if booting with overriding by FPGA.
1142 */
1143void qixis_dump_switch(void)
1144{
1145 int i;
1146 u8 sw[5];
1147
1148 /*
1149 * Any bit with 1 means that bit cannot be reverse engineered.
1150 * It will be displayed as _ in binary format.
1151 */
1152 static const u8 mask[] = {0x07, 0, 0, 0xff, 0};
1153 char buf[10];
1154 u8 brdcfg[16], dutcfg[16];
1155
1156 for (i = 0; i < 16; i++) {
1157 brdcfg[i] = qixis_read(offsetof(struct qixis, brdcfg[0]) + i);
1158 dutcfg[i] = qixis_read(offsetof(struct qixis, dutcfg[0]) + i);
1159 }
1160
1161 sw[0] = ((brdcfg[0] & 0x0f) << 4) | \
1162 (brdcfg[9] & 0x08);
1163 sw[1] = ((dutcfg[1] & 0x01) << 7) | \
1164 ((dutcfg[2] & 0x07) << 4) | \
1165 ((dutcfg[6] & 0x10) >> 1) | \
1166 ((dutcfg[6] & 0x80) >> 5) | \
1167 ((dutcfg[1] & 0x40) >> 5) | \
1168 (dutcfg[6] & 0x01);
1169 sw[2] = dutcfg[0];
1170 sw[3] = 0;
1171 sw[4] = ((brdcfg[1] & 0x30) << 2) | \
1172 ((brdcfg[1] & 0xc0) >> 2) | \
1173 (brdcfg[1] & 0x0f);
1174
1175 puts("DIP switch settings:\n");
1176 for (i = 0; i < 5; i++) {
1177 printf("SW%d = 0b%s (0x%02x)\n",
1178 i + 1, byte_to_binary_mask(sw[i], mask[i], buf), sw[i]);
1179 }
1180}