| // 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 <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(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: |
| case PVR_VER_E500_V2: |
| puts("e500"); |
| 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); |
| |
| /* Attempt board-specific reset */ |
| board_reset(); |
| |
| /* Next try asserting HRESET_REQ */ |
| out_be32(&gur->rstcr, 0x2); |
| udelay(100); |
| #endif |
| |
| return 1; |
| } |
| |
| |
| /* |
| * Get timebase clock frequency |
| */ |
| #ifndef CONFIG_SYS_FSL_TBCLK_DIV |
| #define CONFIG_SYS_FSL_TBCLK_DIV 8 |
| #endif |
| __weak unsigned long get_tbclk(void) |
| { |
| unsigned long tbclk_div = CONFIG_SYS_FSL_TBCLK_DIV; |
| |
| return (gd->bus_clk + (tbclk_div >> 1)) / tbclk_div; |
| } |
| |
| |
| #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 */ |
| |
| /* |
| * 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 |