mirror of
https://github.com/AsahiLinux/u-boot
synced 2024-12-26 04:53:42 +00:00
44366be10a
P1/P2 RDB boards have external max6370 watchdog connected to CPLD and this watchdog is not deactivated on board reset. So if it is active during board reset, it can trigger another reset when CPU is booting U-Boot. To prevent possible infinite reset loop caused by external watchdog, turn it off before reset. Do it via a new board_reset_prepare() callback which is called from do_reset() function before any reset sequence. Signed-off-by: Pali Rohár <pali@kernel.org> Signed-off-by: Peng Fan <peng.fan@nxp.com>
705 lines
17 KiB
C
705 lines
17 KiB
C
// SPDX-License-Identifier: GPL-2.0+
|
|
/*
|
|
* Copyright 2004,2007-2011 Freescale Semiconductor, Inc.
|
|
* (C) Copyright 2002, 2003 Motorola Inc.
|
|
* Xianghua Xiao (X.Xiao@motorola.com)
|
|
*
|
|
* (C) Copyright 2000
|
|
* Wolfgang Denk, DENX Software Engineering, wd@denx.de.
|
|
*/
|
|
|
|
#include <config.h>
|
|
#include <common.h>
|
|
#include <cpu_func.h>
|
|
#include <clock_legacy.h>
|
|
#include <display_options.h>
|
|
#include <init.h>
|
|
#include <irq_func.h>
|
|
#include <log.h>
|
|
#include <time.h>
|
|
#include <vsprintf.h>
|
|
#include <watchdog.h>
|
|
#include <command.h>
|
|
#include <fsl_esdhc.h>
|
|
#include <asm/cache.h>
|
|
#include <asm/global_data.h>
|
|
#include <asm/io.h>
|
|
#include <asm/mmu.h>
|
|
#include <fsl_ifc.h>
|
|
#include <asm/fsl_law.h>
|
|
#include <asm/fsl_lbc.h>
|
|
#include <post.h>
|
|
#include <asm/processor.h>
|
|
#include <fsl_ddr_sdram.h>
|
|
#include <asm/ppc.h>
|
|
#include <linux/delay.h>
|
|
|
|
DECLARE_GLOBAL_DATA_PTR;
|
|
|
|
/*
|
|
* Default board reset function
|
|
*/
|
|
static void
|
|
__board_reset(void)
|
|
{
|
|
/* Do nothing */
|
|
}
|
|
void board_reset_prepare(void) __attribute__((weak, alias("__board_reset")));
|
|
void board_reset(void) __attribute__((weak, alias("__board_reset")));
|
|
void board_reset_last(void) __attribute__((weak, alias("__board_reset")));
|
|
|
|
int checkcpu (void)
|
|
{
|
|
sys_info_t sysinfo;
|
|
uint pvr, svr;
|
|
uint ver;
|
|
uint major, minor;
|
|
struct cpu_type *cpu;
|
|
char buf1[32], buf2[32];
|
|
#if defined(CONFIG_DYNAMIC_DDR_CLK_FREQ) || \
|
|
defined(CONFIG_STATIC_DDR_CLK_FREQ) || defined(CONFIG_FSL_CORENET)
|
|
ccsr_gur_t __iomem *gur =
|
|
(void __iomem *)(CONFIG_SYS_MPC85xx_GUTS_ADDR);
|
|
#endif
|
|
|
|
/*
|
|
* Cornet platforms use ddr sync bit in RCW to indicate sync vs async
|
|
* mode. Previous platform use ddr ratio to do the same. This
|
|
* information is only for display here.
|
|
*/
|
|
#ifdef CONFIG_FSL_CORENET
|
|
#ifdef CONFIG_SYS_FSL_QORIQ_CHASSIS2
|
|
u32 ddr_sync = 0; /* only async mode is supported */
|
|
#else
|
|
u32 ddr_sync = ((gur->rcwsr[5]) & FSL_CORENET_RCWSR5_DDR_SYNC)
|
|
>> FSL_CORENET_RCWSR5_DDR_SYNC_SHIFT;
|
|
#endif /* CONFIG_SYS_FSL_QORIQ_CHASSIS2 */
|
|
#else /* CONFIG_FSL_CORENET */
|
|
#if defined(CONFIG_DYNAMIC_DDR_CLK_FREQ) || defined(CONFIG_STATIC_DDR_CLK_FREQ)
|
|
u32 ddr_ratio = ((gur->porpllsr) & MPC85xx_PORPLLSR_DDR_RATIO)
|
|
>> MPC85xx_PORPLLSR_DDR_RATIO_SHIFT;
|
|
#else
|
|
u32 ddr_ratio = 0;
|
|
#endif /* CONFIG_DYNAMIC_DDR_CLK_FREQ || CONFIG_STATIC_DDR_CLK_FREQ */
|
|
#endif /* CONFIG_FSL_CORENET */
|
|
|
|
unsigned int i, core, nr_cores = cpu_numcores();
|
|
u32 mask = cpu_mask();
|
|
|
|
#ifdef CONFIG_HETROGENOUS_CLUSTERS
|
|
unsigned int j, dsp_core, dsp_numcores = cpu_num_dspcores();
|
|
u32 dsp_mask = cpu_dsp_mask();
|
|
#endif
|
|
|
|
svr = get_svr();
|
|
major = SVR_MAJ(svr);
|
|
minor = SVR_MIN(svr);
|
|
|
|
#if defined(CONFIG_SYS_FSL_QORIQ_CHASSIS2) && defined(CONFIG_E6500)
|
|
if (SVR_SOC_VER(svr) == SVR_T4080) {
|
|
ccsr_rcpm_t *rcpm =
|
|
(void __iomem *)(CONFIG_SYS_FSL_CORENET_RCPM_ADDR);
|
|
|
|
setbits_be32(&gur->devdisr2, FSL_CORENET_DEVDISR2_DTSEC1_6 ||
|
|
FSL_CORENET_DEVDISR2_DTSEC1_9);
|
|
setbits_be32(&gur->devdisr3, FSL_CORENET_DEVDISR3_PCIE3);
|
|
setbits_be32(&gur->devdisr5, FSL_CORENET_DEVDISR5_DDR3);
|
|
|
|
/* It needs SW to disable core4~7 as HW design sake on T4080 */
|
|
for (i = 4; i < 8; i++)
|
|
cpu_disable(i);
|
|
|
|
/* request core4~7 into PH20 state, prior to entering PCL10
|
|
* state, all cores in cluster should be placed in PH20 state.
|
|
*/
|
|
setbits_be32(&rcpm->pcph20setr, 0xf0);
|
|
|
|
/* put the 2nd cluster into PCL10 state */
|
|
setbits_be32(&rcpm->clpcl10setr, 1 << 1);
|
|
}
|
|
#endif
|
|
|
|
if (cpu_numcores() > 1) {
|
|
#ifndef CONFIG_MP
|
|
puts("Unicore software on multiprocessor system!!\n"
|
|
"To enable mutlticore build define CONFIG_MP\n");
|
|
#endif
|
|
volatile ccsr_pic_t *pic = (void *)(CONFIG_SYS_MPC8xxx_PIC_ADDR);
|
|
printf("CPU%d: ", pic->whoami);
|
|
} else {
|
|
puts("CPU: ");
|
|
}
|
|
|
|
cpu = gd->arch.cpu;
|
|
|
|
puts(cpu->name);
|
|
if (IS_E_PROCESSOR(svr))
|
|
puts("E");
|
|
|
|
printf(", Version: %d.%d, (0x%08x)\n", major, minor, svr);
|
|
|
|
pvr = get_pvr();
|
|
ver = PVR_VER(pvr);
|
|
major = PVR_MAJ(pvr);
|
|
minor = PVR_MIN(pvr);
|
|
|
|
printf("Core: ");
|
|
switch(ver) {
|
|
case PVR_VER_E500_V1:
|
|
puts("e500v1");
|
|
break;
|
|
case PVR_VER_E500_V2:
|
|
puts("e500v2");
|
|
break;
|
|
case PVR_VER_E500MC:
|
|
puts("e500mc");
|
|
break;
|
|
case PVR_VER_E5500:
|
|
puts("e5500");
|
|
break;
|
|
case PVR_VER_E6500:
|
|
puts("e6500");
|
|
break;
|
|
default:
|
|
puts("Unknown");
|
|
break;
|
|
}
|
|
|
|
printf(", Version: %d.%d, (0x%08x)\n", major, minor, pvr);
|
|
|
|
if (nr_cores > CONFIG_MAX_CPUS) {
|
|
panic("\nUnexpected number of cores: %d, max is %d\n",
|
|
nr_cores, CONFIG_MAX_CPUS);
|
|
}
|
|
|
|
get_sys_info(&sysinfo);
|
|
|
|
#ifdef CONFIG_SYS_FSL_SINGLE_SOURCE_CLK
|
|
if (sysinfo.diff_sysclk == 1)
|
|
puts("Single Source Clock Configuration\n");
|
|
#endif
|
|
|
|
puts("Clock Configuration:");
|
|
for_each_cpu(i, core, nr_cores, mask) {
|
|
if (!(i & 3))
|
|
printf ("\n ");
|
|
printf("CPU%d:%-4s MHz, ", core,
|
|
strmhz(buf1, sysinfo.freq_processor[core]));
|
|
}
|
|
|
|
#ifdef CONFIG_HETROGENOUS_CLUSTERS
|
|
for_each_cpu(j, dsp_core, dsp_numcores, dsp_mask) {
|
|
if (!(j & 3))
|
|
printf("\n ");
|
|
printf("DSP CPU%d:%-4s MHz, ", j,
|
|
strmhz(buf1, sysinfo.freq_processor_dsp[dsp_core]));
|
|
}
|
|
#endif
|
|
|
|
printf("\n CCB:%-4s MHz,", strmhz(buf1, sysinfo.freq_systembus));
|
|
printf("\n");
|
|
|
|
#ifdef CONFIG_FSL_CORENET
|
|
if (ddr_sync == 1) {
|
|
printf(" DDR:%-4s MHz (%s MT/s data rate) "
|
|
"(Synchronous), ",
|
|
strmhz(buf1, sysinfo.freq_ddrbus/2),
|
|
strmhz(buf2, sysinfo.freq_ddrbus));
|
|
} else {
|
|
printf(" DDR:%-4s MHz (%s MT/s data rate) "
|
|
"(Asynchronous), ",
|
|
strmhz(buf1, sysinfo.freq_ddrbus/2),
|
|
strmhz(buf2, sysinfo.freq_ddrbus));
|
|
}
|
|
#else
|
|
switch (ddr_ratio) {
|
|
case 0x0:
|
|
printf(" DDR:%-4s MHz (%s MT/s data rate), ",
|
|
strmhz(buf1, sysinfo.freq_ddrbus/2),
|
|
strmhz(buf2, sysinfo.freq_ddrbus));
|
|
break;
|
|
case 0x7:
|
|
printf(" DDR:%-4s MHz (%s MT/s data rate) "
|
|
"(Synchronous), ",
|
|
strmhz(buf1, sysinfo.freq_ddrbus/2),
|
|
strmhz(buf2, sysinfo.freq_ddrbus));
|
|
break;
|
|
default:
|
|
printf(" DDR:%-4s MHz (%s MT/s data rate) "
|
|
"(Asynchronous), ",
|
|
strmhz(buf1, sysinfo.freq_ddrbus/2),
|
|
strmhz(buf2, sysinfo.freq_ddrbus));
|
|
break;
|
|
}
|
|
#endif
|
|
|
|
#if defined(CONFIG_FSL_LBC)
|
|
if (sysinfo.freq_localbus > LCRR_CLKDIV) {
|
|
printf("LBC:%-4s MHz\n", strmhz(buf1, sysinfo.freq_localbus));
|
|
} else {
|
|
printf("LBC: unknown (LCRR[CLKDIV] = 0x%02lx)\n",
|
|
sysinfo.freq_localbus);
|
|
}
|
|
#endif
|
|
|
|
#if defined(CONFIG_FSL_IFC)
|
|
printf("IFC:%-4s MHz\n", strmhz(buf1, sysinfo.freq_localbus));
|
|
#endif
|
|
|
|
#ifdef CONFIG_QE
|
|
printf(" QE:%-4s MHz\n", strmhz(buf1, sysinfo.freq_qe));
|
|
#endif
|
|
|
|
#if defined(CONFIG_SYS_CPRI)
|
|
printf(" ");
|
|
printf("CPRI:%-4s MHz", strmhz(buf1, sysinfo.freq_cpri));
|
|
#endif
|
|
|
|
#if defined(CONFIG_SYS_MAPLE)
|
|
printf("\n ");
|
|
printf("MAPLE:%-4s MHz, ", strmhz(buf1, sysinfo.freq_maple));
|
|
printf("MAPLE-ULB:%-4s MHz, ", strmhz(buf1, sysinfo.freq_maple_ulb));
|
|
printf("MAPLE-eTVPE:%-4s MHz\n",
|
|
strmhz(buf1, sysinfo.freq_maple_etvpe));
|
|
#endif
|
|
|
|
#ifdef CONFIG_SYS_DPAA_FMAN
|
|
for (i = 0; i < CONFIG_SYS_NUM_FMAN; i++) {
|
|
printf(" FMAN%d: %s MHz\n", i + 1,
|
|
strmhz(buf1, sysinfo.freq_fman[i]));
|
|
}
|
|
#endif
|
|
|
|
#ifdef CONFIG_SYS_DPAA_QBMAN
|
|
printf(" QMAN: %s MHz\n", strmhz(buf1, sysinfo.freq_qman));
|
|
#endif
|
|
|
|
#ifdef CONFIG_SYS_DPAA_PME
|
|
printf(" PME: %s MHz\n", strmhz(buf1, sysinfo.freq_pme));
|
|
#endif
|
|
|
|
puts("L1: D-cache 32 KiB enabled\n I-cache 32 KiB enabled\n");
|
|
|
|
#ifdef CONFIG_FSL_CORENET
|
|
/* Display the RCW, so that no one gets confused as to what RCW
|
|
* we're actually using for this boot.
|
|
*/
|
|
puts("Reset Configuration Word (RCW):");
|
|
for (i = 0; i < ARRAY_SIZE(gur->rcwsr); i++) {
|
|
u32 rcw = in_be32(&gur->rcwsr[i]);
|
|
|
|
if ((i % 4) == 0)
|
|
printf("\n %08x:", i * 4);
|
|
printf(" %08x", rcw);
|
|
}
|
|
puts("\n");
|
|
#endif
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
/* ------------------------------------------------------------------------- */
|
|
|
|
int do_reset(struct cmd_tbl *cmdtp, int flag, int argc, char *const argv[])
|
|
{
|
|
/* Everything after the first generation of PQ3 parts has RSTCR */
|
|
#if defined(CONFIG_ARCH_MPC8540) || defined(CONFIG_ARCH_MPC8560)
|
|
unsigned long val, msr;
|
|
|
|
/*
|
|
* Initiate hard reset in debug control register DBCR0
|
|
* Make sure MSR[DE] = 1. This only resets the core.
|
|
*/
|
|
msr = mfmsr ();
|
|
msr |= MSR_DE;
|
|
mtmsr (msr);
|
|
|
|
val = mfspr(DBCR0);
|
|
val |= 0x70000000;
|
|
mtspr(DBCR0,val);
|
|
#else
|
|
volatile ccsr_gur_t *gur = (void *)(CONFIG_SYS_MPC85xx_GUTS_ADDR);
|
|
|
|
/* Call board-specific preparation for reset */
|
|
board_reset_prepare();
|
|
|
|
/* Attempt board-specific reset */
|
|
board_reset();
|
|
|
|
/* Next try asserting HRESET_REQ */
|
|
out_be32(&gur->rstcr, 0x2);
|
|
udelay(100);
|
|
|
|
/* Attempt last-stage board-specific reset */
|
|
board_reset_last();
|
|
#endif
|
|
|
|
return 1;
|
|
}
|
|
|
|
|
|
/*
|
|
* Get timebase clock frequency
|
|
*/
|
|
__weak unsigned long get_tbclk(void)
|
|
{
|
|
unsigned long tbclk_div = CONFIG_SYS_FSL_TBCLK_DIV;
|
|
|
|
return (gd->bus_clk + (tbclk_div >> 1)) / tbclk_div;
|
|
}
|
|
|
|
|
|
#ifndef CONFIG_WDT
|
|
#if defined(CONFIG_WATCHDOG)
|
|
#define WATCHDOG_MASK (TCR_WP(63) | TCR_WRC(3) | TCR_WIE)
|
|
void
|
|
init_85xx_watchdog(void)
|
|
{
|
|
mtspr(SPRN_TCR, (mfspr(SPRN_TCR) & ~WATCHDOG_MASK) |
|
|
TCR_WP(CONFIG_WATCHDOG_PRESC) | TCR_WRC(CONFIG_WATCHDOG_RC));
|
|
}
|
|
|
|
void
|
|
reset_85xx_watchdog(void)
|
|
{
|
|
/*
|
|
* Clear TSR(WIS) bit by writing 1
|
|
*/
|
|
mtspr(SPRN_TSR, TSR_WIS);
|
|
}
|
|
|
|
void
|
|
watchdog_reset(void)
|
|
{
|
|
int re_enable = disable_interrupts();
|
|
|
|
reset_85xx_watchdog();
|
|
if (re_enable)
|
|
enable_interrupts();
|
|
}
|
|
#endif /* CONFIG_WATCHDOG */
|
|
#endif
|
|
|
|
/*
|
|
* Initializes on-chip MMC controllers.
|
|
* to override, implement board_mmc_init()
|
|
*/
|
|
int cpu_mmc_init(struct bd_info *bis)
|
|
{
|
|
#ifdef CONFIG_FSL_ESDHC
|
|
return fsl_esdhc_mmc_init(bis);
|
|
#else
|
|
return 0;
|
|
#endif
|
|
}
|
|
|
|
/*
|
|
* Print out the state of various machine registers.
|
|
* Currently prints out LAWs, BR0/OR0 for LBC, CSPR/CSOR/Timing
|
|
* parameters for IFC and TLBs
|
|
*/
|
|
void print_reginfo(void)
|
|
{
|
|
print_tlbcam();
|
|
#ifdef CONFIG_FSL_LAW
|
|
print_laws();
|
|
#endif
|
|
#if defined(CONFIG_FSL_LBC)
|
|
print_lbc_regs();
|
|
#endif
|
|
#ifdef CONFIG_FSL_IFC
|
|
print_ifc_regs();
|
|
#endif
|
|
|
|
}
|
|
|
|
/* Common ddr init for non-corenet fsl 85xx platforms */
|
|
#ifndef CONFIG_FSL_CORENET
|
|
#if (defined(CONFIG_SYS_RAMBOOT) || defined(CONFIG_SPL)) && \
|
|
!defined(CONFIG_SYS_INIT_L2_ADDR)
|
|
int dram_init(void)
|
|
{
|
|
#if defined(CONFIG_SPD_EEPROM) || defined(CONFIG_DDR_SPD) || \
|
|
defined(CONFIG_ARCH_QEMU_E500)
|
|
gd->ram_size = fsl_ddr_sdram_size();
|
|
#else
|
|
gd->ram_size = (phys_size_t)CONFIG_SYS_SDRAM_SIZE * 1024 * 1024;
|
|
#endif
|
|
|
|
return 0;
|
|
}
|
|
#else /* CONFIG_SYS_RAMBOOT */
|
|
int dram_init(void)
|
|
{
|
|
phys_size_t dram_size = 0;
|
|
|
|
#if defined(CONFIG_SYS_FSL_ERRATUM_DDR_MSYNC_IN)
|
|
{
|
|
ccsr_gur_t *gur = (void *)(CONFIG_SYS_MPC85xx_GUTS_ADDR);
|
|
unsigned int x = 10;
|
|
unsigned int i;
|
|
|
|
/*
|
|
* Work around to stabilize DDR DLL
|
|
*/
|
|
out_be32(&gur->ddrdllcr, 0x81000000);
|
|
asm("sync;isync;msync");
|
|
udelay(200);
|
|
while (in_be32(&gur->ddrdllcr) != 0x81000100) {
|
|
setbits_be32(&gur->devdisr, 0x00010000);
|
|
for (i = 0; i < x; i++)
|
|
;
|
|
clrbits_be32(&gur->devdisr, 0x00010000);
|
|
x++;
|
|
}
|
|
}
|
|
#endif
|
|
|
|
#if defined(CONFIG_SPD_EEPROM) || \
|
|
defined(CONFIG_DDR_SPD) || \
|
|
defined(CONFIG_SYS_DDR_RAW_TIMING)
|
|
dram_size = fsl_ddr_sdram();
|
|
#else
|
|
dram_size = fixed_sdram();
|
|
#endif
|
|
dram_size = setup_ddr_tlbs(dram_size / 0x100000);
|
|
dram_size *= 0x100000;
|
|
|
|
#if defined(CONFIG_DDR_ECC) && !defined(CONFIG_ECC_INIT_VIA_DDRCONTROLLER)
|
|
/*
|
|
* Initialize and enable DDR ECC.
|
|
*/
|
|
ddr_enable_ecc(dram_size);
|
|
#endif
|
|
|
|
#if defined(CONFIG_FSL_LBC)
|
|
/* Some boards also have sdram on the lbc */
|
|
lbc_sdram_init();
|
|
#endif
|
|
|
|
debug("DDR: ");
|
|
gd->ram_size = dram_size;
|
|
|
|
return 0;
|
|
}
|
|
#endif /* CONFIG_SYS_RAMBOOT */
|
|
#endif
|
|
|
|
#if CONFIG_POST & CONFIG_SYS_POST_MEMORY
|
|
|
|
/* Board-specific functions defined in each board's ddr.c */
|
|
void fsl_ddr_get_spd(generic_spd_eeprom_t *ctrl_dimms_spd,
|
|
unsigned int ctrl_num, unsigned int dimm_slots_per_ctrl);
|
|
void read_tlbcam_entry(int idx, u32 *valid, u32 *tsize, unsigned long *epn,
|
|
phys_addr_t *rpn);
|
|
unsigned int
|
|
setup_ddr_tlbs_phys(phys_addr_t p_addr, unsigned int memsize_in_meg);
|
|
|
|
void clear_ddr_tlbs_phys(phys_addr_t p_addr, unsigned int memsize_in_meg);
|
|
|
|
static void dump_spd_ddr_reg(void)
|
|
{
|
|
int i, j, k, m;
|
|
u8 *p_8;
|
|
u32 *p_32;
|
|
struct ccsr_ddr __iomem *ddr[CONFIG_SYS_NUM_DDR_CTLRS];
|
|
generic_spd_eeprom_t
|
|
spd[CONFIG_SYS_NUM_DDR_CTLRS][CONFIG_DIMM_SLOTS_PER_CTLR];
|
|
|
|
for (i = 0; i < CONFIG_SYS_NUM_DDR_CTLRS; i++)
|
|
fsl_ddr_get_spd(spd[i], i, CONFIG_DIMM_SLOTS_PER_CTLR);
|
|
|
|
puts("SPD data of all dimms (zero value is omitted)...\n");
|
|
puts("Byte (hex) ");
|
|
k = 1;
|
|
for (i = 0; i < CONFIG_SYS_NUM_DDR_CTLRS; i++) {
|
|
for (j = 0; j < CONFIG_DIMM_SLOTS_PER_CTLR; j++)
|
|
printf("Dimm%d ", k++);
|
|
}
|
|
puts("\n");
|
|
for (k = 0; k < sizeof(generic_spd_eeprom_t); k++) {
|
|
m = 0;
|
|
printf("%3d (0x%02x) ", k, k);
|
|
for (i = 0; i < CONFIG_SYS_NUM_DDR_CTLRS; i++) {
|
|
for (j = 0; j < CONFIG_DIMM_SLOTS_PER_CTLR; j++) {
|
|
p_8 = (u8 *) &spd[i][j];
|
|
if (p_8[k]) {
|
|
printf("0x%02x ", p_8[k]);
|
|
m++;
|
|
} else
|
|
puts(" ");
|
|
}
|
|
}
|
|
if (m)
|
|
puts("\n");
|
|
else
|
|
puts("\r");
|
|
}
|
|
|
|
for (i = 0; i < CONFIG_SYS_NUM_DDR_CTLRS; i++) {
|
|
switch (i) {
|
|
case 0:
|
|
ddr[i] = (void *)CONFIG_SYS_FSL_DDR_ADDR;
|
|
break;
|
|
#if defined(CONFIG_SYS_FSL_DDR2_ADDR) && (CONFIG_SYS_NUM_DDR_CTLRS > 1)
|
|
case 1:
|
|
ddr[i] = (void *)CONFIG_SYS_FSL_DDR2_ADDR;
|
|
break;
|
|
#endif
|
|
#if defined(CONFIG_SYS_FSL_DDR3_ADDR) && (CONFIG_SYS_NUM_DDR_CTLRS > 2)
|
|
case 2:
|
|
ddr[i] = (void *)CONFIG_SYS_FSL_DDR3_ADDR;
|
|
break;
|
|
#endif
|
|
#if defined(CONFIG_SYS_FSL_DDR4_ADDR) && (CONFIG_SYS_NUM_DDR_CTLRS > 3)
|
|
case 3:
|
|
ddr[i] = (void *)CONFIG_SYS_FSL_DDR4_ADDR;
|
|
break;
|
|
#endif
|
|
default:
|
|
printf("%s unexpected controller number = %u\n",
|
|
__func__, i);
|
|
return;
|
|
}
|
|
}
|
|
printf("DDR registers dump for all controllers "
|
|
"(zero value is omitted)...\n");
|
|
puts("Offset (hex) ");
|
|
for (i = 0; i < CONFIG_SYS_NUM_DDR_CTLRS; i++)
|
|
printf(" Base + 0x%04x", (u32)ddr[i] & 0xFFFF);
|
|
puts("\n");
|
|
for (k = 0; k < sizeof(struct ccsr_ddr)/4; k++) {
|
|
m = 0;
|
|
printf("%6d (0x%04x)", k * 4, k * 4);
|
|
for (i = 0; i < CONFIG_SYS_NUM_DDR_CTLRS; i++) {
|
|
p_32 = (u32 *) ddr[i];
|
|
if (p_32[k]) {
|
|
printf(" 0x%08x", p_32[k]);
|
|
m++;
|
|
} else
|
|
puts(" ");
|
|
}
|
|
if (m)
|
|
puts("\n");
|
|
else
|
|
puts("\r");
|
|
}
|
|
puts("\n");
|
|
}
|
|
|
|
/* invalid the TLBs for DDR and setup new ones to cover p_addr */
|
|
static int reset_tlb(phys_addr_t p_addr, u32 size, phys_addr_t *phys_offset)
|
|
{
|
|
u32 vstart = CONFIG_SYS_DDR_SDRAM_BASE;
|
|
unsigned long epn;
|
|
u32 tsize, valid, ptr;
|
|
int ddr_esel;
|
|
|
|
clear_ddr_tlbs_phys(p_addr, size>>20);
|
|
|
|
/* Setup new tlb to cover the physical address */
|
|
setup_ddr_tlbs_phys(p_addr, size>>20);
|
|
|
|
ptr = vstart;
|
|
ddr_esel = find_tlb_idx((void *)ptr, 1);
|
|
if (ddr_esel != -1) {
|
|
read_tlbcam_entry(ddr_esel, &valid, &tsize, &epn, phys_offset);
|
|
} else {
|
|
printf("TLB error in function %s\n", __func__);
|
|
return -1;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* slide the testing window up to test another area
|
|
* for 32_bit system, the maximum testable memory is limited to
|
|
* CONFIG_MAX_MEM_MAPPED
|
|
*/
|
|
int arch_memory_test_advance(u32 *vstart, u32 *size, phys_addr_t *phys_offset)
|
|
{
|
|
phys_addr_t test_cap, p_addr;
|
|
phys_size_t p_size = min(gd->ram_size, CONFIG_MAX_MEM_MAPPED);
|
|
|
|
#if !defined(CONFIG_PHYS_64BIT) || \
|
|
!defined(CONFIG_SYS_INIT_RAM_ADDR_PHYS) || \
|
|
(CONFIG_SYS_INIT_RAM_ADDR_PHYS < 0x100000000ull)
|
|
test_cap = p_size;
|
|
#else
|
|
test_cap = gd->ram_size;
|
|
#endif
|
|
p_addr = (*vstart) + (*size) + (*phys_offset);
|
|
if (p_addr < test_cap - 1) {
|
|
p_size = min(test_cap - p_addr, CONFIG_MAX_MEM_MAPPED);
|
|
if (reset_tlb(p_addr, p_size, phys_offset) == -1)
|
|
return -1;
|
|
*vstart = CONFIG_SYS_DDR_SDRAM_BASE;
|
|
*size = (u32) p_size;
|
|
printf("Testing 0x%08llx - 0x%08llx\n",
|
|
(u64)(*vstart) + (*phys_offset),
|
|
(u64)(*vstart) + (*phys_offset) + (*size) - 1);
|
|
} else
|
|
return 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* initialization for testing area */
|
|
int arch_memory_test_prepare(u32 *vstart, u32 *size, phys_addr_t *phys_offset)
|
|
{
|
|
phys_size_t p_size = min(gd->ram_size, CONFIG_MAX_MEM_MAPPED);
|
|
|
|
*vstart = CONFIG_SYS_DDR_SDRAM_BASE;
|
|
*size = (u32) p_size; /* CONFIG_MAX_MEM_MAPPED < 4G */
|
|
*phys_offset = 0;
|
|
|
|
#if !defined(CONFIG_PHYS_64BIT) || \
|
|
!defined(CONFIG_SYS_INIT_RAM_ADDR_PHYS) || \
|
|
(CONFIG_SYS_INIT_RAM_ADDR_PHYS < 0x100000000ull)
|
|
if (gd->ram_size > CONFIG_MAX_MEM_MAPPED) {
|
|
puts("Cannot test more than ");
|
|
print_size(CONFIG_MAX_MEM_MAPPED,
|
|
" without proper 36BIT support.\n");
|
|
}
|
|
#endif
|
|
printf("Testing 0x%08llx - 0x%08llx\n",
|
|
(u64)(*vstart) + (*phys_offset),
|
|
(u64)(*vstart) + (*phys_offset) + (*size) - 1);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* invalid TLBs for DDR and remap as normal after testing */
|
|
int arch_memory_test_cleanup(u32 *vstart, u32 *size, phys_addr_t *phys_offset)
|
|
{
|
|
unsigned long epn;
|
|
u32 tsize, valid, ptr;
|
|
phys_addr_t rpn = 0;
|
|
int ddr_esel;
|
|
|
|
/* disable the TLBs for this testing */
|
|
ptr = *vstart;
|
|
|
|
while (ptr < (*vstart) + (*size)) {
|
|
ddr_esel = find_tlb_idx((void *)ptr, 1);
|
|
if (ddr_esel != -1) {
|
|
read_tlbcam_entry(ddr_esel, &valid, &tsize, &epn, &rpn);
|
|
disable_tlb(ddr_esel);
|
|
}
|
|
ptr += TSIZE_TO_BYTES(tsize);
|
|
}
|
|
|
|
puts("Remap DDR ");
|
|
setup_ddr_tlbs(gd->ram_size>>20);
|
|
puts("\n");
|
|
|
|
return 0;
|
|
}
|
|
|
|
void arch_memory_failure_handle(void)
|
|
{
|
|
dump_spd_ddr_reg();
|
|
}
|
|
#endif
|