2 * Copyright 2009-2012 Freescale Semiconductor, Inc.
4 * SPDX-License-Identifier: GPL-2.0+
11 #include <linux/compiler.h>
13 #include <asm/processor.h>
14 #include <asm/cache.h>
15 #include <asm/immap_85xx.h>
16 #include <asm/fsl_law.h>
17 #include <asm/fsl_serdes.h>
18 #include <asm/fsl_portals.h>
19 #include <asm/fsl_liodn.h>
22 #include "../common/qixis.h"
23 #include "../common/vsc3316_3308.h"
25 #include "t4240qds_qixis.h"
27 DECLARE_GLOBAL_DATA_PTR
;
29 static int8_t vsc3316_fsm1_tx
[8][2] = { {0, 0}, {1, 1}, {6, 6}, {7, 7},
30 {8, 8}, {9, 9}, {14, 14}, {15, 15} };
32 static int8_t vsc3316_fsm2_tx
[8][2] = { {2, 2}, {3, 3}, {4, 4}, {5, 5},
33 {10, 10}, {11, 11}, {12, 12}, {13, 13} };
35 static int8_t vsc3316_fsm1_rx
[8][2] = { {2, 12}, {3, 13}, {4, 5}, {5, 4},
36 {10, 11}, {11, 10}, {12, 2}, {13, 3} };
38 static int8_t vsc3316_fsm2_rx
[8][2] = { {0, 15}, {1, 14}, {6, 7}, {7, 6},
39 {8, 9}, {9, 8}, {14, 1}, {15, 0} };
45 struct cpu_type
*cpu
= gd
->arch
.cpu
;
48 printf("Board: %sQDS, ", cpu
->name
);
49 printf("Sys ID: 0x%02x, Sys Ver: 0x%02x, ",
50 QIXIS_READ(id
), QIXIS_READ(arch
));
52 sw
= QIXIS_READ(brdcfg
[0]);
53 sw
= (sw
& QIXIS_LBMAP_MASK
) >> QIXIS_LBMAP_SHIFT
;
56 printf("vBank: %d\n", sw
);
62 printf("invalid setting of SW%u\n", QIXIS_LBMAP_SWITCH
);
64 printf("FPGA: v%d (%s), build %d",
65 (int)QIXIS_READ(scver
), qixis_read_tag(buf
),
66 (int)qixis_read_minor());
67 /* the timestamp string contains "\n" at the end */
68 printf(" on %s", qixis_read_time(buf
));
71 * Display the actual SERDES reference clocks as configured by the
72 * dip switches on the board. Note that the SWx registers could
73 * technically be set to force the reference clocks to match the
74 * values that the SERDES expects (or vice versa). For now, however,
75 * we just display both values and hope the user notices when they
78 puts("SERDES Reference Clocks: ");
79 sw
= QIXIS_READ(brdcfg
[2]);
80 for (i
= 0; i
< MAX_SERDES
; i
++) {
81 static const char * const freq
[] = {
82 "100", "125", "156.25", "161.1328125"};
83 unsigned int clock
= (sw
>> (6 - 2 * i
)) & 3;
85 printf("SERDES%u=%sMHz ", i
+1, freq
[clock
]);
92 int select_i2c_ch_pca9547(u8 ch
)
96 ret
= i2c_write(I2C_MUX_PCA_ADDR_PRI
, 0, 1, &ch
, 1);
98 puts("PCA: failed to select proper channel\n");
106 * read_voltage from sensor on I2C bus
107 * We use average of 4 readings, waiting for 532us befor another reading
109 #define NUM_READINGS 4 /* prefer to be power of 2 for efficiency */
110 #define WAIT_FOR_ADC 532 /* wait for 532 microseconds for ADC */
112 static inline int read_voltage(void)
114 int i
, ret
, voltage_read
= 0;
117 for (i
= 0; i
< NUM_READINGS
; i
++) {
118 ret
= i2c_read(I2C_VOL_MONITOR_ADDR
,
119 I2C_VOL_MONITOR_BUS_V_OFFSET
, 1, (void *)&vol_mon
, 2);
121 printf("VID: failed to read core voltage\n");
124 if (vol_mon
& I2C_VOL_MONITOR_BUS_V_OVF
) {
125 printf("VID: Core voltage sensor error\n");
128 debug("VID: bus voltage reads 0x%04x\n", vol_mon
);
130 voltage_read
+= (vol_mon
>> I2C_VOL_MONITOR_BUS_V_SHIFT
) * 4;
131 udelay(WAIT_FOR_ADC
);
133 /* calculate the average */
134 voltage_read
/= NUM_READINGS
;
140 * We need to calculate how long before the voltage starts to drop or increase
141 * It returns with the loop count. Each loop takes several readings (532us)
143 static inline int wait_for_voltage_change(int vdd_last
)
145 int timeout
, vdd_current
;
147 vdd_current
= read_voltage();
148 /* wait until voltage starts to drop */
149 for (timeout
= 0; abs(vdd_last
- vdd_current
) <= 4 &&
150 timeout
< 100; timeout
++) {
151 vdd_current
= read_voltage();
153 if (timeout
>= 100) {
154 printf("VID: Voltage adjustment timeout\n");
161 * argument 'wait' is the time we know the voltage difference can be measured
162 * this function keeps reading the voltage until it is stable
164 static inline int wait_for_voltage_stable(int wait
)
166 int timeout
, vdd_current
, vdd_last
;
168 vdd_last
= read_voltage();
169 udelay(wait
* NUM_READINGS
* WAIT_FOR_ADC
);
170 /* wait until voltage is stable */
171 vdd_current
= read_voltage();
172 for (timeout
= 0; abs(vdd_last
- vdd_current
) >= 4 &&
173 timeout
< 100; timeout
++) {
174 vdd_last
= vdd_current
;
175 udelay(wait
* NUM_READINGS
* WAIT_FOR_ADC
);
176 vdd_current
= read_voltage();
178 if (timeout
>= 100) {
179 printf("VID: Voltage adjustment timeout\n");
186 static inline int set_voltage(u8 vid
)
190 vdd_last
= read_voltage();
191 QIXIS_WRITE(brdcfg
[6], vid
);
192 wait
= wait_for_voltage_change(vdd_last
);
195 debug("VID: Waited %d us\n", wait
* NUM_READINGS
* WAIT_FOR_ADC
);
196 wait
= wait
? wait
: 1;
198 vdd_last
= wait_for_voltage_stable(wait
);
201 debug("VID: Current voltage is %d mV\n", vdd_last
);
207 static int adjust_vdd(ulong vdd_override
)
209 int re_enable
= disable_interrupts();
210 ccsr_gur_t __iomem
*gur
=
211 (void __iomem
*)(CONFIG_SYS_MPC85xx_GUTS_ADDR
);
214 int vdd_target
, vdd_current
, vdd_last
;
216 unsigned long vdd_string_override
;
218 static const uint16_t vdd
[32] = {
251 ret
= select_i2c_ch_pca9547(I2C_MUX_CH_VOL_MONITOR
);
253 debug("VID: I2c failed to switch channel\n");
258 /* get the voltage ID from fuse status register */
259 fusesr
= in_be32(&gur
->dcfg_fusesr
);
260 vid
= (fusesr
>> FSL_CORENET_DCFG_FUSESR_VID_SHIFT
) &
261 FSL_CORENET_DCFG_FUSESR_VID_MASK
;
262 if (vid
== FSL_CORENET_DCFG_FUSESR_VID_MASK
) {
263 vid
= (fusesr
>> FSL_CORENET_DCFG_FUSESR_ALTVID_SHIFT
) &
264 FSL_CORENET_DCFG_FUSESR_ALTVID_MASK
;
266 vdd_target
= vdd
[vid
];
268 /* check override variable for overriding VDD */
269 vdd_string
= getenv("t4240qds_vdd_mv");
270 if (vdd_override
== 0 && vdd_string
&&
271 !strict_strtoul(vdd_string
, 10, &vdd_string_override
))
272 vdd_override
= vdd_string_override
;
273 if (vdd_override
>= 819 && vdd_override
<= 1212) {
274 vdd_target
= vdd_override
* 10; /* convert to 1/10 mV */
275 debug("VDD override is %lu\n", vdd_override
);
276 } else if (vdd_override
!= 0) {
277 printf("Invalid value.\n");
280 if (vdd_target
== 0) {
281 debug("VID: VID not used\n");
285 /* round up and divice by 10 to get a value in mV */
286 vdd_target
= DIV_ROUND_UP(vdd_target
, 10);
287 debug("VID: vid = %d mV\n", vdd_target
);
291 * Check current board VID setting
292 * Voltage regulator support output to 6.250mv step
293 * The highes voltage allowed for this board is (vid=0x40) 1.21250V
294 * the lowest is (vid=0x7f) 0.81875V
296 vid_current
= QIXIS_READ(brdcfg
[6]);
297 vdd_current
= 121250 - (vid_current
- 0x40) * 625;
298 debug("VID: Current vid setting is (0x%x) %d mV\n",
299 vid_current
, vdd_current
/100);
302 * Read voltage monitor to check real voltage.
303 * Voltage monitor LSB is 4mv.
305 vdd_last
= read_voltage();
307 printf("VID: Could not read voltage sensor abort VID adjustment\n");
311 debug("VID: Core voltage is at %d mV\n", vdd_last
);
313 * Adjust voltage to at or 8mV above target.
314 * Each step of adjustment is 6.25mV.
315 * Stepping down too fast may cause over current.
317 while (vdd_last
> 0 && vid_current
< 0x80 &&
318 vdd_last
> (vdd_target
+ 8)) {
320 vdd_last
= set_voltage(vid_current
);
323 * Check if we need to step up
324 * This happens when board voltage switch was set too low
326 while (vdd_last
> 0 && vid_current
>= 0x40 &&
327 vdd_last
< vdd_target
+ 2) {
329 vdd_last
= set_voltage(vid_current
);
332 printf("VID: Core voltage %d mV\n", vdd_last
);
342 /* Configure Crossbar switches for Front-Side SerDes Ports */
343 int config_frontside_crossbar_vsc3316(void)
345 ccsr_gur_t
*gur
= (void *)(CONFIG_SYS_MPC85xx_GUTS_ADDR
);
346 u32 srds_prtcl_s1
, srds_prtcl_s2
;
349 ret
= select_i2c_ch_pca9547(I2C_MUX_CH_VSC3316_FS
);
353 srds_prtcl_s1
= in_be32(&gur
->rcwsr
[4]) &
354 FSL_CORENET2_RCWSR4_SRDS1_PRTCL
;
355 srds_prtcl_s1
>>= FSL_CORENET2_RCWSR4_SRDS1_PRTCL_SHIFT
;
356 switch (srds_prtcl_s1
) {
358 /* swap first lane and third lane on slot1 */
359 vsc3316_fsm1_tx
[0][1] = 14;
360 vsc3316_fsm1_tx
[6][1] = 0;
361 vsc3316_fsm1_rx
[1][1] = 2;
362 vsc3316_fsm1_rx
[6][1] = 13;
366 /* swap first lane and third lane on slot2 */
367 vsc3316_fsm1_tx
[2][1] = 8;
368 vsc3316_fsm1_tx
[4][1] = 6;
369 vsc3316_fsm1_rx
[2][1] = 10;
370 vsc3316_fsm1_rx
[5][1] = 5;
372 ret
= vsc3316_config(VSC3316_FSM_TX_ADDR
, vsc3316_fsm1_tx
, 8);
375 ret
= vsc3316_config(VSC3316_FSM_RX_ADDR
, vsc3316_fsm1_rx
, 8);
381 srds_prtcl_s2
= in_be32(&gur
->rcwsr
[4]) &
382 FSL_CORENET2_RCWSR4_SRDS2_PRTCL
;
383 srds_prtcl_s2
>>= FSL_CORENET2_RCWSR4_SRDS2_PRTCL_SHIFT
;
384 switch (srds_prtcl_s2
) {
386 /* swap first lane and third lane on slot3 */
387 vsc3316_fsm2_tx
[2][1] = 11;
388 vsc3316_fsm2_tx
[5][1] = 4;
389 vsc3316_fsm2_rx
[2][1] = 9;
390 vsc3316_fsm2_rx
[4][1] = 7;
397 /* swap first lane and third lane on slot4 */
398 vsc3316_fsm2_tx
[6][1] = 3;
399 vsc3316_fsm2_tx
[1][1] = 12;
400 vsc3316_fsm2_rx
[0][1] = 1;
401 vsc3316_fsm2_rx
[6][1] = 15;
403 ret
= vsc3316_config(VSC3316_FSM_TX_ADDR
, vsc3316_fsm2_tx
, 8);
406 ret
= vsc3316_config(VSC3316_FSM_RX_ADDR
, vsc3316_fsm2_rx
, 8);
415 int config_backside_crossbar_mux(void)
417 ccsr_gur_t
*gur
= (void *)(CONFIG_SYS_MPC85xx_GUTS_ADDR
);
418 u32 srds_prtcl_s3
, srds_prtcl_s4
;
421 srds_prtcl_s3
= in_be32(&gur
->rcwsr
[4]) &
422 FSL_CORENET2_RCWSR4_SRDS3_PRTCL
;
423 srds_prtcl_s3
>>= FSL_CORENET2_RCWSR4_SRDS3_PRTCL_SHIFT
;
424 switch (srds_prtcl_s3
) {
426 /* SerDes3 is not enabled */
431 /* SD3(0:7) => SLOT5(0:7) */
432 brdcfg
= QIXIS_READ(brdcfg
[12]);
433 brdcfg
&= ~BRDCFG12_SD3MX_MASK
;
434 brdcfg
|= BRDCFG12_SD3MX_SLOT5
;
435 QIXIS_WRITE(brdcfg
[12], brdcfg
);
446 /* SD3(4:7) => SLOT6(0:3) */
447 brdcfg
= QIXIS_READ(brdcfg
[12]);
448 brdcfg
&= ~BRDCFG12_SD3MX_MASK
;
449 brdcfg
|= BRDCFG12_SD3MX_SLOT6
;
450 QIXIS_WRITE(brdcfg
[12], brdcfg
);
453 printf("WARNING: unsupported for SerDes3 Protocol %d\n",
458 srds_prtcl_s4
= in_be32(&gur
->rcwsr
[4]) &
459 FSL_CORENET2_RCWSR4_SRDS4_PRTCL
;
460 srds_prtcl_s4
>>= FSL_CORENET2_RCWSR4_SRDS4_PRTCL_SHIFT
;
461 switch (srds_prtcl_s4
) {
463 /* SerDes4 is not enabled */
466 /* 10b, SD4(0:7) => SLOT7(0:7) */
467 brdcfg
= QIXIS_READ(brdcfg
[12]);
468 brdcfg
&= ~BRDCFG12_SD4MX_MASK
;
469 brdcfg
|= BRDCFG12_SD4MX_SLOT7
;
470 QIXIS_WRITE(brdcfg
[12], brdcfg
);
475 /* x1b, SD4(4:7) => SLOT8(0:3) */
476 brdcfg
= QIXIS_READ(brdcfg
[12]);
477 brdcfg
&= ~BRDCFG12_SD4MX_MASK
;
478 brdcfg
|= BRDCFG12_SD4MX_SLOT8
;
479 QIXIS_WRITE(brdcfg
[12], brdcfg
);
486 /* 00b, SD4(4:5) => AURORA, SD4(6:7) => SATA */
487 brdcfg
= QIXIS_READ(brdcfg
[12]);
488 brdcfg
&= ~BRDCFG12_SD4MX_MASK
;
489 brdcfg
|= BRDCFG12_SD4MX_AURO_SATA
;
490 QIXIS_WRITE(brdcfg
[12], brdcfg
);
493 printf("WARNING: unsupported for SerDes4 Protocol %d\n",
501 int board_early_init_r(void)
503 const unsigned int flashbase
= CONFIG_SYS_FLASH_BASE
;
504 const u8 flash_esel
= find_tlb_idx((void *)flashbase
, 1);
507 * Remap Boot flash + PROMJET region to caching-inhibited
508 * so that flash can be erased properly.
511 /* Flush d-cache and invalidate i-cache of any FLASH data */
515 /* invalidate existing TLB entry for flash + promjet */
516 disable_tlb(flash_esel
);
518 set_tlb(1, flashbase
, CONFIG_SYS_FLASH_BASE_PHYS
,
519 MAS3_SX
|MAS3_SW
|MAS3_SR
, MAS2_I
|MAS2_G
,
520 0, flash_esel
, BOOKE_PAGESZ_256M
, 1);
523 #ifdef CONFIG_SYS_DPAA_QBMAN
527 /* Disable remote I2C connection to qixis fpga */
528 QIXIS_WRITE(brdcfg
[5], QIXIS_READ(brdcfg
[5]) & ~BRDCFG5_IRE
);
531 * Adjust core voltage according to voltage ID
532 * This function changes I2C mux to channel 2.
535 printf("Warning: Adjusting core voltage failed.\n");
537 /* Configure board SERDES ports crossbar */
538 config_frontside_crossbar_vsc3316();
539 config_backside_crossbar_mux();
540 select_i2c_ch_pca9547(I2C_MUX_CH_DEFAULT
);
545 unsigned long get_board_sys_clk(void)
547 u8 sysclk_conf
= QIXIS_READ(brdcfg
[1]);
548 #ifdef CONFIG_FSL_QIXIS_CLOCK_MEASUREMENT
549 /* use accurate clock measurement */
550 int freq
= QIXIS_READ(clk_freq
[0]) << 8 | QIXIS_READ(clk_freq
[1]);
551 int base
= QIXIS_READ(clk_base
[0]) << 8 | QIXIS_READ(clk_base
[1]);
556 debug("SYS Clock measurement is: %d\n", val
);
559 printf("Warning: SYS clock measurement is invalid, using value from brdcfg1.\n");
563 switch (sysclk_conf
& 0x0F) {
564 case QIXIS_SYSCLK_83
:
566 case QIXIS_SYSCLK_100
:
568 case QIXIS_SYSCLK_125
:
570 case QIXIS_SYSCLK_133
:
572 case QIXIS_SYSCLK_150
:
574 case QIXIS_SYSCLK_160
:
576 case QIXIS_SYSCLK_166
:
582 unsigned long get_board_ddr_clk(void)
584 u8 ddrclk_conf
= QIXIS_READ(brdcfg
[1]);
585 #ifdef CONFIG_FSL_QIXIS_CLOCK_MEASUREMENT
586 /* use accurate clock measurement */
587 int freq
= QIXIS_READ(clk_freq
[2]) << 8 | QIXIS_READ(clk_freq
[3]);
588 int base
= QIXIS_READ(clk_base
[0]) << 8 | QIXIS_READ(clk_base
[1]);
593 debug("DDR Clock measurement is: %d\n", val
);
596 printf("Warning: DDR clock measurement is invalid, using value from brdcfg1.\n");
600 switch ((ddrclk_conf
& 0x30) >> 4) {
601 case QIXIS_DDRCLK_100
:
603 case QIXIS_DDRCLK_125
:
605 case QIXIS_DDRCLK_133
:
611 static const char *serdes_clock_to_string(u32 clock
)
614 case SRDS_PLLCR0_RFCK_SEL_100
:
616 case SRDS_PLLCR0_RFCK_SEL_125
:
618 case SRDS_PLLCR0_RFCK_SEL_156_25
:
620 case SRDS_PLLCR0_RFCK_SEL_161_13
:
621 return "161.1328125";
627 int misc_init_r(void)
630 serdes_corenet_t
*srds_regs
=
631 (void *)CONFIG_SYS_FSL_CORENET_SERDES_ADDR
;
632 u32 actual
[MAX_SERDES
];
635 sw
= QIXIS_READ(brdcfg
[2]);
636 for (i
= 0; i
< MAX_SERDES
; i
++) {
637 unsigned int clock
= (sw
>> (6 - 2 * i
)) & 3;
640 actual
[i
] = SRDS_PLLCR0_RFCK_SEL_100
;
643 actual
[i
] = SRDS_PLLCR0_RFCK_SEL_125
;
646 actual
[i
] = SRDS_PLLCR0_RFCK_SEL_156_25
;
649 actual
[i
] = SRDS_PLLCR0_RFCK_SEL_161_13
;
654 for (i
= 0; i
< MAX_SERDES
; i
++) {
655 u32 pllcr0
= srds_regs
->bank
[i
].pllcr0
;
656 u32 expected
= pllcr0
& SRDS_PLLCR0_RFCK_SEL_MASK
;
657 if (expected
!= actual
[i
]) {
658 printf("Warning: SERDES%u expects reference clock %sMHz, but actual is %sMHz\n",
659 i
+ 1, serdes_clock_to_string(expected
),
660 serdes_clock_to_string(actual
[i
]));
667 void ft_board_setup(void *blob
, bd_t
*bd
)
672 ft_cpu_setup(blob
, bd
);
674 base
= getenv_bootm_low();
675 size
= getenv_bootm_size();
677 fdt_fixup_memory(blob
, (u64
)base
, (u64
)size
);
680 pci_of_setup(blob
, bd
);
683 fdt_fixup_liodn(blob
);
684 fdt_fixup_dr_usb(blob
, bd
);
686 #ifdef CONFIG_SYS_DPAA_FMAN
687 fdt_fixup_fman_ethernet(blob
);
688 fdt_fixup_board_enet(blob
);
693 * This function is called by bdinfo to print detail board information.
694 * As an exmaple for future board, we organize the messages into
695 * several sections. If applicable, the message is in the format of
697 * It should aligned with normal output of bdinfo command.
699 * Voltage: Core, DDR and another configurable voltages
700 * Clock : Critical clocks which are not printed already
701 * RCW : RCW source if not printed already
702 * Misc : Other important information not in above catagories
704 void board_detail(void)
707 u8 brdcfg
[16], dutcfg
[16], rst_ctl
;
709 static const char * const clk
[] = {"66.67", "100", "125", "133.33"};
711 for (i
= 0; i
< 16; i
++) {
712 brdcfg
[i
] = qixis_read(offsetof(struct qixis
, brdcfg
[0]) + i
);
713 dutcfg
[i
] = qixis_read(offsetof(struct qixis
, dutcfg
[0]) + i
);
717 if (!select_i2c_ch_pca9547(I2C_MUX_CH_VOL_MONITOR
)) {
718 vdd
= read_voltage();
720 printf("Core voltage= %d mV\n", vdd
);
721 select_i2c_ch_pca9547(I2C_MUX_CH_DEFAULT
);
724 printf("XVDD = 1.%d V\n", ((brdcfg
[8] & 0xf) - 4) * 5 + 25);
727 printf("SYSCLK = %s MHz\nDDRCLK = %s MHz\n",
728 clk
[(brdcfg
[11] >> 2) & 0x3], clk
[brdcfg
[11] & 3]);
731 rcwsrc
= (dutcfg
[0] << 1) + (dutcfg
[1] & 1);
732 puts("RCW source = ");
740 puts("16-bit NOR\n");
746 puts("SPI 16-bit addressing\n");
749 puts("SPI 24-bit addressing\n");
752 puts("I2C normal addressing\n");
755 puts("I2C extended addressing\n");
761 puts("8-bit NAND, 2KB\n");
764 if ((rcwsrc
>= 0x080) && (rcwsrc
<= 0x09f))
765 puts("Hard-coded RCW\n");
766 else if ((rcwsrc
>= 0x110) && (rcwsrc
<= 0x11f))
767 puts("8-bit NAND, 4KB\n");
774 rst_ctl
= QIXIS_READ(rst_ctl
);
775 puts("HRESET_REQ = ");
776 switch (rst_ctl
& 0x30) {
781 puts("Assert HRESET\n");
784 puts("Reset system\n");
793 * Reverse engineering switch settings.
794 * Some bits cannot be figured out. They will be displayed as
795 * underscore in binary format. mask[] has those bits.
796 * Some bits are calculated differently than the actual switches
797 * if booting with overriding by FPGA.
799 void qixis_dump_switch(void)
805 * Any bit with 1 means that bit cannot be reverse engineered.
806 * It will be displayed as _ in binary format.
808 static const u8 mask
[] = {0, 0, 0, 0, 0, 0x1, 0xcf, 0x3f, 0x1f};
810 u8 brdcfg
[16], dutcfg
[16];
812 for (i
= 0; i
< 16; i
++) {
813 brdcfg
[i
] = qixis_read(offsetof(struct qixis
, brdcfg
[0]) + i
);
814 dutcfg
[i
] = qixis_read(offsetof(struct qixis
, dutcfg
[0]) + i
);
818 sw
[1] = (dutcfg
[1] << 0x07) |
819 ((dutcfg
[12] & 0xC0) >> 1) |
820 ((dutcfg
[11] & 0xE0) >> 3) |
821 ((dutcfg
[6] & 0x80) >> 6) |
822 ((dutcfg
[1] & 0x80) >> 7);
823 sw
[2] = ((brdcfg
[1] & 0x0f) << 4) |
824 ((brdcfg
[1] & 0x30) >> 2) |
825 ((brdcfg
[1] & 0x40) >> 5) |
826 ((brdcfg
[1] & 0x80) >> 7);
828 sw
[4] = ((dutcfg
[2] & 0x01) << 7) |
829 ((dutcfg
[2] & 0x06) << 4) |
830 ((~QIXIS_READ(present
)) & 0x10) |
831 ((brdcfg
[3] & 0x80) >> 4) |
832 ((brdcfg
[3] & 0x01) << 2) |
833 ((brdcfg
[6] == 0x62) ? 3 :
834 ((brdcfg
[6] == 0x5a) ? 2 :
835 ((brdcfg
[6] == 0x5e) ? 1 : 0)));
836 sw
[5] = ((brdcfg
[0] & 0x0f) << 4) |
837 ((QIXIS_READ(rst_ctl
) & 0x30) >> 2) |
838 ((brdcfg
[0] & 0x40) >> 5);
839 sw
[6] = (brdcfg
[11] & 0x20) |
840 ((brdcfg
[5] & 0x02) << 3);
841 sw
[7] = (((~QIXIS_READ(rst_ctl
)) & 0x40) << 1) |
842 ((brdcfg
[5] & 0x10) << 2);
843 sw
[8] = ((brdcfg
[12] & 0x08) << 4) |
844 ((brdcfg
[12] & 0x03) << 5);
846 puts("DIP switch (reverse-engineering)\n");
847 for (i
= 0; i
< 9; i
++) {
848 printf("SW%d = 0b%s (0x%02x)\n",
849 i
+ 1, byte_to_binary_mask(sw
[i
], mask
[i
], buf
), sw
[i
]);
853 static int do_vdd_adjust(cmd_tbl_t
*cmdtp
,
860 return CMD_RET_USAGE
;
861 if (!strict_strtoul(argv
[1], 10, &override
))
862 adjust_vdd(override
); /* the value is checked by callee */
864 return CMD_RET_USAGE
;
870 vdd_override
, 2, 0, do_vdd_adjust
,
872 "- override with the voltage specified in mV, eg. 1050"