3 * Stefan Roese, DENX Software Engineering, sr@denx.de.
5 * See file CREDITS for list of people who contributed to this
8 * This program is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU General Public License as
10 * published by the Free Software Foundation; either version 2 of
11 * the License, or (at your option) any later version.
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
27 #include <asm/processor.h>
29 #include <asm/cache.h>
31 #if defined(CONFIG_SDRAM_PPC4xx_IBM_DDR) || \
32 defined(CONFIG_SDRAM_PPC4xx_IBM_DDR2)
33 #if defined(CONFIG_DDR_ECC) || defined(CONFIG_SDRAM_ECC)
35 #if defined(CONFIG_405EX)
37 * Currently only 405EX uses 16bit data bus width as an alternative
38 * option to 32bit data width (SDRAM0_MCOPT1_WDTH)
40 #define SDRAM_DATA_ALT_WIDTH 2
42 #define SDRAM_DATA_ALT_WIDTH 8
45 #if defined(CONFIG_SYS_OCM_BASE)
46 #define CONFIG_FUNC_ISRAM_ADDR CONFIG_SYS_OCM_BASE
49 #if defined(CONFIG_SYS_ISRAM_BASE)
50 #define CONFIG_FUNC_ISRAM_ADDR CONFIG_SYS_ISRAM_BASE
53 #if !defined(CONFIG_FUNC_ISRAM_ADDR)
54 #error "No internal SRAM/OCM provided!"
57 #define force_inline inline __attribute__ ((always_inline))
59 static inline void machine_check_disable(void)
61 mtmsr(mfmsr() & ~MSR_ME
);
64 static inline void machine_check_enable(void)
66 mtmsr(mfmsr() | MSR_ME
);
70 * These helper functions need to be inlined, since they
71 * are called from the functions running from internal SRAM.
72 * SDRAM operation is forbidden at that time, so calling
73 * functions in SDRAM has to be avoided.
75 static force_inline
void wait_ddr_idle(void)
80 mfsdram(SDRAM_MCSTAT
, val
);
81 } while ((val
& SDRAM_MCSTAT_IDLE_MASK
) == SDRAM_MCSTAT_IDLE_NOT
);
84 static force_inline
void recalibrate_ddr(void)
89 * Rewrite RQDC & RFDC to calibrate again. If this is not
90 * done, the SDRAM controller is working correctly after
91 * changing the MCOPT1_MCHK bits.
93 mfsdram(SDRAM_RQDC
, val
);
94 mtsdram(SDRAM_RQDC
, val
);
95 mfsdram(SDRAM_RFDC
, val
);
96 mtsdram(SDRAM_RFDC
, val
);
99 static force_inline
void set_mcopt1_mchk(u32 bits
)
104 mfsdram(SDRAM_MCOPT1
, val
);
105 mtsdram(SDRAM_MCOPT1
, (val
& ~SDRAM_MCOPT1_MCHK_MASK
) | bits
);
110 * The next 2 functions are copied to internal SRAM/OCM and run
111 * there. No function calls allowed here. No SDRAM acitivity should
114 static void inject_ecc_error(void *ptr
, int par
)
119 * Taken from PPC460EX/EXr/GT users manual (Rev 1.21)
120 * 22.2.17.13 ECC Diagnostics
122 * Items 1 ... 5 are already done by now, running from RAM
126 out_be32(ptr
, 0x00000000);
129 /* 6. Set memory controller to no error checking */
130 set_mcopt1_mchk(SDRAM_MCOPT1_MCHK_NON
);
132 /* 7. Modify one or two bits for error simulation */
134 out_be32(ptr
, in_be32(ptr
) ^ 0x00000001);
136 out_be32(ptr
, in_be32(ptr
) ^ 0x00000003);
138 /* 8. Wait for SDRAM idle */
140 set_mcopt1_mchk(SDRAM_MCOPT1_MCHK_CHK_REP
);
142 /* Wait for SDRAM idle */
145 /* Continue with 9. in calling function... */
148 static void rewrite_ecc_parity(void *ptr
, int par
)
150 u32 current_address
= (u32
)ptr
;
152 u32 address_increment
;
157 * Fill ECC parity byte again. Otherwise further accesses to
158 * the failure address will result in exceptions.
161 /* Wait for SDRAM idle */
162 val
= in_be32(0x00000000);
163 set_mcopt1_mchk(SDRAM_MCOPT1_MCHK_GEN
);
165 /* ECC bit set method for non-cached memory */
166 mfsdram(SDRAM_MCOPT1
, mcopt1
);
167 if ((mcopt1
& SDRAM_MCOPT1_DMWD_MASK
) == SDRAM_MCOPT1_DMWD_32
)
168 address_increment
= 4;
170 address_increment
= SDRAM_DATA_ALT_WIDTH
;
171 end_address
= current_address
+ CONFIG_SYS_CACHELINE_SIZE
;
173 while (current_address
< end_address
) {
174 *((unsigned long *)current_address
) = 0;
175 current_address
+= address_increment
;
178 set_mcopt1_mchk(SDRAM_MCOPT1_MCHK_CHK_REP
);
180 /* Wait for SDRAM idle */
184 static int do_ecctest(cmd_tbl_t
*cmdtp
, int flag
, int argc
, char * const argv
[])
189 void (*sram_func
)(u32
*, int);
197 ptr
= (u32
*)simple_strtoul(argv
[1], NULL
, 16);
198 error
= simple_strtoul(argv
[2], NULL
, 16);
199 if ((error
< 1) || (error
> 2)) {
204 printf("Using address %p for %d bit ECC error injection\n",
208 * Save value to restore it later on
210 old_val
= in_be32(ptr
);
213 * Copy ECC injection function into internal SRAM/OCM
215 sram_func
= (void *)CONFIG_FUNC_ISRAM_ADDR
;
216 memcpy((void *)CONFIG_FUNC_ISRAM_ADDR
, inject_ecc_error
, 0x10000);
219 * Disable interrupts and exceptions before calling this
220 * function in internal SRAM/OCM
222 disable_interrupts();
223 machine_check_disable();
227 * Jump to ECC simulation function in internal SRAM/OCM
229 (*sram_func
)(ptr
, error
);
231 /* 10. Read the corresponding address */
235 * Read and print ECC status register/info:
236 * The faulting address is only known upon uncorrectable ECC
239 mfsdram(SDRAM_ECCES
, val
);
240 if (val
& SDRAM_ECCES_CE
)
241 printf("ECC: Correctable error\n");
242 if (val
& SDRAM_ECCES_UE
) {
243 printf("ECC: Uncorrectable error at 0x%02x%08x\n",
244 mfdcr(SDRAM_ERRADDULL
), mfdcr(SDRAM_ERRADDLLL
));
248 * Clear pending interrupts/exceptions
250 mtsdram(SDRAM_ECCES
, 0xffffffff);
251 mtdcr(SDRAM_ERRSTATLL
, 0xff000000);
252 set_mcsr(get_mcsr());
254 /* Now enable interrupts and exceptions again */
256 machine_check_enable();
260 * The ECC parity byte need to be re-written for the
261 * corresponding address. Otherwise future accesses to it
262 * will result in exceptions.
264 * Jump to ECC parity generation function
266 memcpy((void *)CONFIG_FUNC_ISRAM_ADDR
, rewrite_ecc_parity
, 0x10000);
267 (*sram_func
)(ptr
, 0);
270 * Restore value in corresponding address
272 out_be32(ptr
, old_val
);
278 ecctest
, 3, 0, do_ecctest
,
279 "Test ECC by single and double error bit injection",
283 #endif /* defined(CONFIG_DDR_ECC) || defined(CONFIG_SDRAM_ECC) */
284 #endif /* defined(CONFIG_SDRAM_PPC4xx_IBM_DDR)... */