Tom Rini | 10e4779 | 2018-05-06 17:58:06 -0400 | [diff] [blame] | 1 | // SPDX-License-Identifier: GPL-2.0+ |
wdenk | 9c53f40 | 2003-10-15 23:53:47 +0000 | [diff] [blame] | 2 | /* |
Dipen Dudhat | 5d51bf9 | 2011-01-19 12:46:27 +0530 | [diff] [blame] | 3 | * Copyright 2004,2007-2011 Freescale Semiconductor, Inc. |
wdenk | 9c53f40 | 2003-10-15 23:53:47 +0000 | [diff] [blame] | 4 | * (C) Copyright 2002, 2003 Motorola Inc. |
| 5 | * Xianghua Xiao (X.Xiao@motorola.com) |
| 6 | * |
| 7 | * (C) Copyright 2000 |
| 8 | * Wolfgang Denk, DENX Software Engineering, wd@denx.de. |
wdenk | 9c53f40 | 2003-10-15 23:53:47 +0000 | [diff] [blame] | 9 | */ |
| 10 | |
Andy Fleming | fecff2b | 2008-08-31 16:33:26 -0500 | [diff] [blame] | 11 | #include <config.h> |
wdenk | 9c53f40 | 2003-10-15 23:53:47 +0000 | [diff] [blame] | 12 | #include <common.h> |
Simon Glass | 970b61e | 2019-11-14 12:57:09 -0700 | [diff] [blame] | 13 | #include <cpu_func.h> |
Tom Rini | f7246c2 | 2021-08-21 13:50:17 -0400 | [diff] [blame] | 14 | #include <clock_legacy.h> |
Simon Glass | 1ab1692 | 2022-07-31 12:28:48 -0600 | [diff] [blame] | 15 | #include <display_options.h> |
Simon Glass | 9758973 | 2020-05-10 11:40:02 -0600 | [diff] [blame] | 16 | #include <init.h> |
Simon Glass | 8f3f761 | 2019-11-14 12:57:42 -0700 | [diff] [blame] | 17 | #include <irq_func.h> |
Simon Glass | 0f2af88 | 2020-05-10 11:40:05 -0600 | [diff] [blame] | 18 | #include <log.h> |
Simon Glass | a9dc068 | 2019-12-28 10:44:59 -0700 | [diff] [blame] | 19 | #include <time.h> |
Simon Glass | f5c208d | 2019-11-14 12:57:20 -0700 | [diff] [blame] | 20 | #include <vsprintf.h> |
wdenk | 9c53f40 | 2003-10-15 23:53:47 +0000 | [diff] [blame] | 21 | #include <watchdog.h> |
| 22 | #include <command.h> |
Andy Fleming | 6843a6e | 2008-10-30 16:51:33 -0500 | [diff] [blame] | 23 | #include <fsl_esdhc.h> |
wdenk | 9c53f40 | 2003-10-15 23:53:47 +0000 | [diff] [blame] | 24 | #include <asm/cache.h> |
Simon Glass | 3ba929a | 2020-10-30 21:38:53 -0600 | [diff] [blame] | 25 | #include <asm/global_data.h> |
Sergei Poselenov | ddc1a47 | 2008-06-06 15:42:40 +0200 | [diff] [blame] | 26 | #include <asm/io.h> |
Becky Bruce | ee888da | 2010-06-17 11:37:25 -0500 | [diff] [blame] | 27 | #include <asm/mmu.h> |
York Sun | 37562f6 | 2013-10-22 12:39:02 -0700 | [diff] [blame] | 28 | #include <fsl_ifc.h> |
Becky Bruce | ee888da | 2010-06-17 11:37:25 -0500 | [diff] [blame] | 29 | #include <asm/fsl_law.h> |
Becky Bruce | 5e35d8a | 2010-12-17 17:17:56 -0600 | [diff] [blame] | 30 | #include <asm/fsl_lbc.h> |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 31 | #include <post.h> |
| 32 | #include <asm/processor.h> |
York Sun | f062659 | 2013-09-30 09:22:09 -0700 | [diff] [blame] | 33 | #include <fsl_ddr_sdram.h> |
Christophe Leroy | 31f6e93 | 2017-07-13 15:09:54 +0200 | [diff] [blame] | 34 | #include <asm/ppc.h> |
Simon Glass | dbd7954 | 2020-05-10 11:40:11 -0600 | [diff] [blame] | 35 | #include <linux/delay.h> |
wdenk | 9c53f40 | 2003-10-15 23:53:47 +0000 | [diff] [blame] | 36 | |
James Yang | 957b191 | 2008-02-08 16:44:53 -0600 | [diff] [blame] | 37 | DECLARE_GLOBAL_DATA_PTR; |
| 38 | |
Ira W. Snyder | a85994c | 2011-11-21 13:20:32 -0800 | [diff] [blame] | 39 | /* |
| 40 | * Default board reset function |
| 41 | */ |
| 42 | static void |
| 43 | __board_reset(void) |
| 44 | { |
| 45 | /* Do nothing */ |
| 46 | } |
Pali Rohár | 779f652 | 2022-08-01 15:31:46 +0200 | [diff] [blame] | 47 | void board_reset_prepare(void) __attribute__((weak, alias("__board_reset"))); |
Ira W. Snyder | a85994c | 2011-11-21 13:20:32 -0800 | [diff] [blame] | 48 | void board_reset(void) __attribute__((weak, alias("__board_reset"))); |
Pali Rohár | c13f4fb | 2022-08-01 15:31:45 +0200 | [diff] [blame] | 49 | void board_reset_last(void) __attribute__((weak, alias("__board_reset"))); |
Ira W. Snyder | a85994c | 2011-11-21 13:20:32 -0800 | [diff] [blame] | 50 | |
wdenk | 9c53f40 | 2003-10-15 23:53:47 +0000 | [diff] [blame] | 51 | int checkcpu (void) |
| 52 | { |
wdenk | a445ddf | 2004-06-09 00:34:46 +0000 | [diff] [blame] | 53 | sys_info_t sysinfo; |
wdenk | a445ddf | 2004-06-09 00:34:46 +0000 | [diff] [blame] | 54 | uint pvr, svr; |
| 55 | uint ver; |
| 56 | uint major, minor; |
Kumar Gala | 8ddf00c | 2008-06-10 16:53:46 -0500 | [diff] [blame] | 57 | struct cpu_type *cpu; |
Wolfgang Denk | 2059104 | 2008-10-19 02:35:49 +0200 | [diff] [blame] | 58 | char buf1[32], buf2[32]; |
Tom Rini | f7246c2 | 2021-08-21 13:50:17 -0400 | [diff] [blame] | 59 | #if defined(CONFIG_DYNAMIC_DDR_CLK_FREQ) || \ |
| 60 | defined(CONFIG_STATIC_DDR_CLK_FREQ) || defined(CONFIG_FSL_CORENET) |
York Sun | c87e81e | 2013-06-25 11:37:43 -0700 | [diff] [blame] | 61 | ccsr_gur_t __iomem *gur = |
Tom Rini | d5c3bf2 | 2022-10-28 20:27:12 -0400 | [diff] [blame] | 62 | (void __iomem *)(CFG_SYS_MPC85xx_GUTS_ADDR); |
York Sun | c87e81e | 2013-06-25 11:37:43 -0700 | [diff] [blame] | 63 | #endif |
York Sun | 3b5179f | 2012-10-08 07:44:31 +0000 | [diff] [blame] | 64 | |
| 65 | /* |
| 66 | * Cornet platforms use ddr sync bit in RCW to indicate sync vs async |
| 67 | * mode. Previous platform use ddr ratio to do the same. This |
| 68 | * information is only for display here. |
| 69 | */ |
Kumar Gala | dccd9e3 | 2009-03-19 02:46:19 -0500 | [diff] [blame] | 70 | #ifdef CONFIG_FSL_CORENET |
York Sun | 383f6f6 | 2012-10-08 07:44:16 +0000 | [diff] [blame] | 71 | #ifdef CONFIG_SYS_FSL_QORIQ_CHASSIS2 |
York Sun | 3b5179f | 2012-10-08 07:44:31 +0000 | [diff] [blame] | 72 | u32 ddr_sync = 0; /* only async mode is supported */ |
York Sun | 383f6f6 | 2012-10-08 07:44:16 +0000 | [diff] [blame] | 73 | #else |
York Sun | 3b5179f | 2012-10-08 07:44:31 +0000 | [diff] [blame] | 74 | u32 ddr_sync = ((gur->rcwsr[5]) & FSL_CORENET_RCWSR5_DDR_SYNC) |
Srikanth Srinivasan | f58c2a4 | 2010-02-10 17:32:43 +0800 | [diff] [blame] | 75 | >> FSL_CORENET_RCWSR5_DDR_SYNC_SHIFT; |
York Sun | 383f6f6 | 2012-10-08 07:44:16 +0000 | [diff] [blame] | 76 | #endif /* CONFIG_SYS_FSL_QORIQ_CHASSIS2 */ |
York Sun | 3b5179f | 2012-10-08 07:44:31 +0000 | [diff] [blame] | 77 | #else /* CONFIG_FSL_CORENET */ |
Tom Rini | f7246c2 | 2021-08-21 13:50:17 -0400 | [diff] [blame] | 78 | #if defined(CONFIG_DYNAMIC_DDR_CLK_FREQ) || defined(CONFIG_STATIC_DDR_CLK_FREQ) |
York Sun | 3b5179f | 2012-10-08 07:44:31 +0000 | [diff] [blame] | 79 | u32 ddr_ratio = ((gur->porpllsr) & MPC85xx_PORPLLSR_DDR_RATIO) |
| 80 | >> MPC85xx_PORPLLSR_DDR_RATIO_SHIFT; |
Kumar Gala | 54b6810 | 2008-05-29 01:21:24 -0500 | [diff] [blame] | 81 | #else |
| 82 | u32 ddr_ratio = 0; |
Tom Rini | f7246c2 | 2021-08-21 13:50:17 -0400 | [diff] [blame] | 83 | #endif /* CONFIG_DYNAMIC_DDR_CLK_FREQ || CONFIG_STATIC_DDR_CLK_FREQ */ |
York Sun | 3b5179f | 2012-10-08 07:44:31 +0000 | [diff] [blame] | 84 | #endif /* CONFIG_FSL_CORENET */ |
| 85 | |
Timur Tabi | 4728942 | 2011-08-05 16:15:24 -0500 | [diff] [blame] | 86 | unsigned int i, core, nr_cores = cpu_numcores(); |
| 87 | u32 mask = cpu_mask(); |
wdenk | 9c53f40 | 2003-10-15 23:53:47 +0000 | [diff] [blame] | 88 | |
Shaveta Leekha | dbf0bc8 | 2015-01-19 12:46:54 +0530 | [diff] [blame] | 89 | #ifdef CONFIG_HETROGENOUS_CLUSTERS |
| 90 | unsigned int j, dsp_core, dsp_numcores = cpu_num_dspcores(); |
| 91 | u32 dsp_mask = cpu_dsp_mask(); |
| 92 | #endif |
| 93 | |
wdenk | a445ddf | 2004-06-09 00:34:46 +0000 | [diff] [blame] | 94 | svr = get_svr(); |
wdenk | a445ddf | 2004-06-09 00:34:46 +0000 | [diff] [blame] | 95 | major = SVR_MAJ(svr); |
| 96 | minor = SVR_MIN(svr); |
| 97 | |
Shengzhou Liu | 26ed2d0 | 2014-04-25 16:31:22 +0800 | [diff] [blame] | 98 | #if defined(CONFIG_SYS_FSL_QORIQ_CHASSIS2) && defined(CONFIG_E6500) |
| 99 | if (SVR_SOC_VER(svr) == SVR_T4080) { |
| 100 | ccsr_rcpm_t *rcpm = |
Tom Rini | 376b88a | 2022-10-28 20:27:13 -0400 | [diff] [blame] | 101 | (void __iomem *)(CFG_SYS_FSL_CORENET_RCPM_ADDR); |
Shengzhou Liu | 26ed2d0 | 2014-04-25 16:31:22 +0800 | [diff] [blame] | 102 | |
| 103 | setbits_be32(&gur->devdisr2, FSL_CORENET_DEVDISR2_DTSEC1_6 || |
| 104 | FSL_CORENET_DEVDISR2_DTSEC1_9); |
| 105 | setbits_be32(&gur->devdisr3, FSL_CORENET_DEVDISR3_PCIE3); |
| 106 | setbits_be32(&gur->devdisr5, FSL_CORENET_DEVDISR5_DDR3); |
| 107 | |
| 108 | /* It needs SW to disable core4~7 as HW design sake on T4080 */ |
| 109 | for (i = 4; i < 8; i++) |
| 110 | cpu_disable(i); |
| 111 | |
| 112 | /* request core4~7 into PH20 state, prior to entering PCL10 |
| 113 | * state, all cores in cluster should be placed in PH20 state. |
| 114 | */ |
| 115 | setbits_be32(&rcpm->pcph20setr, 0xf0); |
| 116 | |
| 117 | /* put the 2nd cluster into PCL10 state */ |
| 118 | setbits_be32(&rcpm->clpcl10setr, 1 << 1); |
| 119 | } |
| 120 | #endif |
| 121 | |
Poonam Aggrwal | 4baef82 | 2009-07-31 12:08:14 +0530 | [diff] [blame] | 122 | if (cpu_numcores() > 1) { |
Poonam Aggrwal | 36a6843 | 2009-09-03 19:42:40 +0530 | [diff] [blame] | 123 | #ifndef CONFIG_MP |
| 124 | puts("Unicore software on multiprocessor system!!\n" |
| 125 | "To enable mutlticore build define CONFIG_MP\n"); |
| 126 | #endif |
Tom Rini | d5c3bf2 | 2022-10-28 20:27:12 -0400 | [diff] [blame] | 127 | volatile ccsr_pic_t *pic = (void *)(CFG_SYS_MPC8xxx_PIC_ADDR); |
Poonam Aggrwal | 4baef82 | 2009-07-31 12:08:14 +0530 | [diff] [blame] | 128 | printf("CPU%d: ", pic->whoami); |
| 129 | } else { |
| 130 | puts("CPU: "); |
| 131 | } |
Andy Fleming | f574097 | 2008-02-06 01:19:40 -0600 | [diff] [blame] | 132 | |
Simon Glass | a8b5739 | 2012-12-13 20:48:48 +0000 | [diff] [blame] | 133 | cpu = gd->arch.cpu; |
Andy Fleming | f574097 | 2008-02-06 01:19:40 -0600 | [diff] [blame] | 134 | |
Poonam Aggrwal | da6e1ca | 2009-09-02 13:35:21 +0530 | [diff] [blame] | 135 | puts(cpu->name); |
| 136 | if (IS_E_PROCESSOR(svr)) |
| 137 | puts("E"); |
Andy Fleming | f574097 | 2008-02-06 01:19:40 -0600 | [diff] [blame] | 138 | |
wdenk | a445ddf | 2004-06-09 00:34:46 +0000 | [diff] [blame] | 139 | printf(", Version: %d.%d, (0x%08x)\n", major, minor, svr); |
wdenk | 9c53f40 | 2003-10-15 23:53:47 +0000 | [diff] [blame] | 140 | |
wdenk | 3f3262b | 2005-03-15 22:56:53 +0000 | [diff] [blame] | 141 | pvr = get_pvr(); |
| 142 | ver = PVR_VER(pvr); |
| 143 | major = PVR_MAJ(pvr); |
| 144 | minor = PVR_MIN(pvr); |
| 145 | |
| 146 | printf("Core: "); |
Kumar Gala | e222ed3 | 2011-07-25 09:28:39 -0500 | [diff] [blame] | 147 | switch(ver) { |
| 148 | case PVR_VER_E500_V1: |
Pali Rohár | 62923c6 | 2022-04-03 00:05:10 +0200 | [diff] [blame] | 149 | puts("e500v1"); |
| 150 | break; |
Kumar Gala | e222ed3 | 2011-07-25 09:28:39 -0500 | [diff] [blame] | 151 | case PVR_VER_E500_V2: |
Pali Rohár | 62923c6 | 2022-04-03 00:05:10 +0200 | [diff] [blame] | 152 | puts("e500v2"); |
Kumar Gala | e222ed3 | 2011-07-25 09:28:39 -0500 | [diff] [blame] | 153 | break; |
| 154 | case PVR_VER_E500MC: |
Fabio Estevam | f4c557c | 2013-04-21 13:11:02 -0300 | [diff] [blame] | 155 | puts("e500mc"); |
Kumar Gala | e222ed3 | 2011-07-25 09:28:39 -0500 | [diff] [blame] | 156 | break; |
| 157 | case PVR_VER_E5500: |
Fabio Estevam | f4c557c | 2013-04-21 13:11:02 -0300 | [diff] [blame] | 158 | puts("e5500"); |
Kumar Gala | e222ed3 | 2011-07-25 09:28:39 -0500 | [diff] [blame] | 159 | break; |
Kumar Gala | c1abf4a | 2012-08-17 08:20:23 +0000 | [diff] [blame] | 160 | case PVR_VER_E6500: |
Fabio Estevam | f4c557c | 2013-04-21 13:11:02 -0300 | [diff] [blame] | 161 | puts("e6500"); |
Kumar Gala | c1abf4a | 2012-08-17 08:20:23 +0000 | [diff] [blame] | 162 | break; |
Kumar Gala | e222ed3 | 2011-07-25 09:28:39 -0500 | [diff] [blame] | 163 | default: |
Kumar Gala | bd2985c | 2009-10-21 13:23:54 -0500 | [diff] [blame] | 164 | puts("Unknown"); |
Kumar Gala | e222ed3 | 2011-07-25 09:28:39 -0500 | [diff] [blame] | 165 | break; |
wdenk | 3f3262b | 2005-03-15 22:56:53 +0000 | [diff] [blame] | 166 | } |
Kumar Gala | 9f4a689 | 2008-10-23 01:47:38 -0500 | [diff] [blame] | 167 | |
wdenk | 3f3262b | 2005-03-15 22:56:53 +0000 | [diff] [blame] | 168 | printf(", Version: %d.%d, (0x%08x)\n", major, minor, pvr); |
| 169 | |
York Sun | 908412d | 2012-10-08 07:44:10 +0000 | [diff] [blame] | 170 | if (nr_cores > CONFIG_MAX_CPUS) { |
| 171 | panic("\nUnexpected number of cores: %d, max is %d\n", |
| 172 | nr_cores, CONFIG_MAX_CPUS); |
| 173 | } |
| 174 | |
wdenk | a445ddf | 2004-06-09 00:34:46 +0000 | [diff] [blame] | 175 | get_sys_info(&sysinfo); |
| 176 | |
vijay rai | d84fd50 | 2014-04-15 11:34:12 +0530 | [diff] [blame] | 177 | #ifdef CONFIG_SYS_FSL_SINGLE_SOURCE_CLK |
| 178 | if (sysinfo.diff_sysclk == 1) |
| 179 | puts("Single Source Clock Configuration\n"); |
| 180 | #endif |
| 181 | |
Kumar Gala | f92794c | 2009-02-04 09:35:57 -0600 | [diff] [blame] | 182 | puts("Clock Configuration:"); |
Timur Tabi | 4728942 | 2011-08-05 16:15:24 -0500 | [diff] [blame] | 183 | for_each_cpu(i, core, nr_cores, mask) { |
Wolfgang Denk | 1f79d14 | 2009-02-19 00:41:08 +0100 | [diff] [blame] | 184 | if (!(i & 3)) |
| 185 | printf ("\n "); |
Timur Tabi | 4728942 | 2011-08-05 16:15:24 -0500 | [diff] [blame] | 186 | printf("CPU%d:%-4s MHz, ", core, |
Prabhakar Kushwaha | d169808 | 2013-08-16 14:52:26 +0530 | [diff] [blame] | 187 | strmhz(buf1, sysinfo.freq_processor[core])); |
Kumar Gala | f92794c | 2009-02-04 09:35:57 -0600 | [diff] [blame] | 188 | } |
Shaveta Leekha | dbf0bc8 | 2015-01-19 12:46:54 +0530 | [diff] [blame] | 189 | |
| 190 | #ifdef CONFIG_HETROGENOUS_CLUSTERS |
| 191 | for_each_cpu(j, dsp_core, dsp_numcores, dsp_mask) { |
| 192 | if (!(j & 3)) |
| 193 | printf("\n "); |
| 194 | printf("DSP CPU%d:%-4s MHz, ", j, |
| 195 | strmhz(buf1, sysinfo.freq_processor_dsp[dsp_core])); |
| 196 | } |
| 197 | #endif |
| 198 | |
Prabhakar Kushwaha | d169808 | 2013-08-16 14:52:26 +0530 | [diff] [blame] | 199 | printf("\n CCB:%-4s MHz,", strmhz(buf1, sysinfo.freq_systembus)); |
| 200 | printf("\n"); |
Kumar Gala | 54b6810 | 2008-05-29 01:21:24 -0500 | [diff] [blame] | 201 | |
Kumar Gala | dccd9e3 | 2009-03-19 02:46:19 -0500 | [diff] [blame] | 202 | #ifdef CONFIG_FSL_CORENET |
| 203 | if (ddr_sync == 1) { |
| 204 | printf(" DDR:%-4s MHz (%s MT/s data rate) " |
| 205 | "(Synchronous), ", |
Prabhakar Kushwaha | d169808 | 2013-08-16 14:52:26 +0530 | [diff] [blame] | 206 | strmhz(buf1, sysinfo.freq_ddrbus/2), |
| 207 | strmhz(buf2, sysinfo.freq_ddrbus)); |
Kumar Gala | dccd9e3 | 2009-03-19 02:46:19 -0500 | [diff] [blame] | 208 | } else { |
| 209 | printf(" DDR:%-4s MHz (%s MT/s data rate) " |
| 210 | "(Asynchronous), ", |
Prabhakar Kushwaha | d169808 | 2013-08-16 14:52:26 +0530 | [diff] [blame] | 211 | strmhz(buf1, sysinfo.freq_ddrbus/2), |
| 212 | strmhz(buf2, sysinfo.freq_ddrbus)); |
Kumar Gala | dccd9e3 | 2009-03-19 02:46:19 -0500 | [diff] [blame] | 213 | } |
| 214 | #else |
Kumar Gala | 07db170 | 2007-12-07 04:59:26 -0600 | [diff] [blame] | 215 | switch (ddr_ratio) { |
| 216 | case 0x0: |
Wolfgang Denk | 2059104 | 2008-10-19 02:35:49 +0200 | [diff] [blame] | 217 | printf(" DDR:%-4s MHz (%s MT/s data rate), ", |
Prabhakar Kushwaha | d169808 | 2013-08-16 14:52:26 +0530 | [diff] [blame] | 218 | strmhz(buf1, sysinfo.freq_ddrbus/2), |
| 219 | strmhz(buf2, sysinfo.freq_ddrbus)); |
Kumar Gala | 07db170 | 2007-12-07 04:59:26 -0600 | [diff] [blame] | 220 | break; |
| 221 | case 0x7: |
Kumar Gala | dccd9e3 | 2009-03-19 02:46:19 -0500 | [diff] [blame] | 222 | printf(" DDR:%-4s MHz (%s MT/s data rate) " |
| 223 | "(Synchronous), ", |
Prabhakar Kushwaha | d169808 | 2013-08-16 14:52:26 +0530 | [diff] [blame] | 224 | strmhz(buf1, sysinfo.freq_ddrbus/2), |
| 225 | strmhz(buf2, sysinfo.freq_ddrbus)); |
Kumar Gala | 07db170 | 2007-12-07 04:59:26 -0600 | [diff] [blame] | 226 | break; |
| 227 | default: |
Kumar Gala | dccd9e3 | 2009-03-19 02:46:19 -0500 | [diff] [blame] | 228 | printf(" DDR:%-4s MHz (%s MT/s data rate) " |
| 229 | "(Asynchronous), ", |
Prabhakar Kushwaha | d169808 | 2013-08-16 14:52:26 +0530 | [diff] [blame] | 230 | strmhz(buf1, sysinfo.freq_ddrbus/2), |
| 231 | strmhz(buf2, sysinfo.freq_ddrbus)); |
Kumar Gala | 07db170 | 2007-12-07 04:59:26 -0600 | [diff] [blame] | 232 | break; |
| 233 | } |
Kumar Gala | dccd9e3 | 2009-03-19 02:46:19 -0500 | [diff] [blame] | 234 | #endif |
wdenk | a445ddf | 2004-06-09 00:34:46 +0000 | [diff] [blame] | 235 | |
Dipen Dudhat | 5d51bf9 | 2011-01-19 12:46:27 +0530 | [diff] [blame] | 236 | #if defined(CONFIG_FSL_LBC) |
Prabhakar Kushwaha | d169808 | 2013-08-16 14:52:26 +0530 | [diff] [blame] | 237 | if (sysinfo.freq_localbus > LCRR_CLKDIV) { |
| 238 | printf("LBC:%-4s MHz\n", strmhz(buf1, sysinfo.freq_localbus)); |
Kumar Gala | dccd9e3 | 2009-03-19 02:46:19 -0500 | [diff] [blame] | 239 | } else { |
Trent Piepho | 0b691fc | 2008-12-03 15:16:37 -0800 | [diff] [blame] | 240 | printf("LBC: unknown (LCRR[CLKDIV] = 0x%02lx)\n", |
Prabhakar Kushwaha | d169808 | 2013-08-16 14:52:26 +0530 | [diff] [blame] | 241 | sysinfo.freq_localbus); |
Kumar Gala | dccd9e3 | 2009-03-19 02:46:19 -0500 | [diff] [blame] | 242 | } |
Dipen Dudhat | 5d51bf9 | 2011-01-19 12:46:27 +0530 | [diff] [blame] | 243 | #endif |
wdenk | a445ddf | 2004-06-09 00:34:46 +0000 | [diff] [blame] | 244 | |
Kumar Gala | 17ec6fa | 2012-10-08 07:44:06 +0000 | [diff] [blame] | 245 | #if defined(CONFIG_FSL_IFC) |
Prabhakar Kushwaha | d169808 | 2013-08-16 14:52:26 +0530 | [diff] [blame] | 246 | printf("IFC:%-4s MHz\n", strmhz(buf1, sysinfo.freq_localbus)); |
Kumar Gala | 17ec6fa | 2012-10-08 07:44:06 +0000 | [diff] [blame] | 247 | #endif |
| 248 | |
Haiying Wang | 6141468 | 2009-05-20 12:30:29 -0400 | [diff] [blame] | 249 | #ifdef CONFIG_QE |
Prabhakar Kushwaha | d169808 | 2013-08-16 14:52:26 +0530 | [diff] [blame] | 250 | printf(" QE:%-4s MHz\n", strmhz(buf1, sysinfo.freq_qe)); |
Haiying Wang | 6141468 | 2009-05-20 12:30:29 -0400 | [diff] [blame] | 251 | #endif |
| 252 | |
Shaveta Leekha | dbf0bc8 | 2015-01-19 12:46:54 +0530 | [diff] [blame] | 253 | #if defined(CONFIG_SYS_CPRI) |
| 254 | printf(" "); |
| 255 | printf("CPRI:%-4s MHz", strmhz(buf1, sysinfo.freq_cpri)); |
| 256 | #endif |
| 257 | |
| 258 | #if defined(CONFIG_SYS_MAPLE) |
| 259 | printf("\n "); |
| 260 | printf("MAPLE:%-4s MHz, ", strmhz(buf1, sysinfo.freq_maple)); |
| 261 | printf("MAPLE-ULB:%-4s MHz, ", strmhz(buf1, sysinfo.freq_maple_ulb)); |
| 262 | printf("MAPLE-eTVPE:%-4s MHz\n", |
| 263 | strmhz(buf1, sysinfo.freq_maple_etvpe)); |
| 264 | #endif |
| 265 | |
Kumar Gala | dccd9e3 | 2009-03-19 02:46:19 -0500 | [diff] [blame] | 266 | #ifdef CONFIG_SYS_DPAA_FMAN |
Tom Rini | 0a2bac7 | 2022-11-16 13:10:29 -0500 | [diff] [blame] | 267 | for (i = 0; i < CFG_SYS_NUM_FMAN; i++) { |
Emil Medve | 3a9ed2f | 2010-06-17 00:08:29 -0500 | [diff] [blame] | 268 | printf(" FMAN%d: %s MHz\n", i + 1, |
Prabhakar Kushwaha | d169808 | 2013-08-16 14:52:26 +0530 | [diff] [blame] | 269 | strmhz(buf1, sysinfo.freq_fman[i])); |
Kumar Gala | dccd9e3 | 2009-03-19 02:46:19 -0500 | [diff] [blame] | 270 | } |
| 271 | #endif |
| 272 | |
Haiying Wang | 09d0aa9 | 2012-10-11 07:13:39 +0000 | [diff] [blame] | 273 | #ifdef CONFIG_SYS_DPAA_QBMAN |
Prabhakar Kushwaha | d169808 | 2013-08-16 14:52:26 +0530 | [diff] [blame] | 274 | printf(" QMAN: %s MHz\n", strmhz(buf1, sysinfo.freq_qman)); |
Haiying Wang | 09d0aa9 | 2012-10-11 07:13:39 +0000 | [diff] [blame] | 275 | #endif |
| 276 | |
Kumar Gala | dccd9e3 | 2009-03-19 02:46:19 -0500 | [diff] [blame] | 277 | #ifdef CONFIG_SYS_DPAA_PME |
Prabhakar Kushwaha | d169808 | 2013-08-16 14:52:26 +0530 | [diff] [blame] | 278 | printf(" PME: %s MHz\n", strmhz(buf1, sysinfo.freq_pme)); |
Kumar Gala | dccd9e3 | 2009-03-19 02:46:19 -0500 | [diff] [blame] | 279 | #endif |
| 280 | |
Shruti Kanetkar | 8115936 | 2013-08-15 11:25:38 -0500 | [diff] [blame] | 281 | puts("L1: D-cache 32 KiB enabled\n I-cache 32 KiB enabled\n"); |
wdenk | 9c53f40 | 2003-10-15 23:53:47 +0000 | [diff] [blame] | 282 | |
York Sun | c87e81e | 2013-06-25 11:37:43 -0700 | [diff] [blame] | 283 | #ifdef CONFIG_FSL_CORENET |
| 284 | /* Display the RCW, so that no one gets confused as to what RCW |
| 285 | * we're actually using for this boot. |
| 286 | */ |
| 287 | puts("Reset Configuration Word (RCW):"); |
| 288 | for (i = 0; i < ARRAY_SIZE(gur->rcwsr); i++) { |
| 289 | u32 rcw = in_be32(&gur->rcwsr[i]); |
| 290 | |
| 291 | if ((i % 4) == 0) |
| 292 | printf("\n %08x:", i * 4); |
| 293 | printf(" %08x", rcw); |
| 294 | } |
| 295 | puts("\n"); |
| 296 | #endif |
| 297 | |
wdenk | 9c53f40 | 2003-10-15 23:53:47 +0000 | [diff] [blame] | 298 | return 0; |
| 299 | } |
| 300 | |
| 301 | |
| 302 | /* ------------------------------------------------------------------------- */ |
| 303 | |
Simon Glass | ed38aef | 2020-05-10 11:40:03 -0600 | [diff] [blame] | 304 | int do_reset(struct cmd_tbl *cmdtp, int flag, int argc, char *const argv[]) |
wdenk | 9c53f40 | 2003-10-15 23:53:47 +0000 | [diff] [blame] | 305 | { |
Kumar Gala | aff0153 | 2009-09-08 13:46:46 -0500 | [diff] [blame] | 306 | /* Everything after the first generation of PQ3 parts has RSTCR */ |
Tom Rini | 0b730a0 | 2021-05-14 21:34:21 -0400 | [diff] [blame] | 307 | #if defined(CONFIG_ARCH_MPC8540) || defined(CONFIG_ARCH_MPC8560) |
Sergei Poselenov | 2514742 | 2008-05-08 14:17:08 +0200 | [diff] [blame] | 308 | unsigned long val, msr; |
| 309 | |
wdenk | 9c53f40 | 2003-10-15 23:53:47 +0000 | [diff] [blame] | 310 | /* |
| 311 | * Initiate hard reset in debug control register DBCR0 |
Kumar Gala | aff0153 | 2009-09-08 13:46:46 -0500 | [diff] [blame] | 312 | * Make sure MSR[DE] = 1. This only resets the core. |
wdenk | 9c53f40 | 2003-10-15 23:53:47 +0000 | [diff] [blame] | 313 | */ |
Sergei Poselenov | 2514742 | 2008-05-08 14:17:08 +0200 | [diff] [blame] | 314 | msr = mfmsr (); |
| 315 | msr |= MSR_DE; |
| 316 | mtmsr (msr); |
urwithsughosh@gmail.com | 06c2fb9 | 2007-09-24 13:32:13 -0400 | [diff] [blame] | 317 | |
Sergei Poselenov | 2514742 | 2008-05-08 14:17:08 +0200 | [diff] [blame] | 318 | val = mfspr(DBCR0); |
| 319 | val |= 0x70000000; |
| 320 | mtspr(DBCR0,val); |
Kumar Gala | aff0153 | 2009-09-08 13:46:46 -0500 | [diff] [blame] | 321 | #else |
Tom Rini | d5c3bf2 | 2022-10-28 20:27:12 -0400 | [diff] [blame] | 322 | volatile ccsr_gur_t *gur = (void *)(CFG_SYS_MPC85xx_GUTS_ADDR); |
Ira W. Snyder | a85994c | 2011-11-21 13:20:32 -0800 | [diff] [blame] | 323 | |
Pali Rohár | 779f652 | 2022-08-01 15:31:46 +0200 | [diff] [blame] | 324 | /* Call board-specific preparation for reset */ |
| 325 | board_reset_prepare(); |
| 326 | |
Ira W. Snyder | a85994c | 2011-11-21 13:20:32 -0800 | [diff] [blame] | 327 | /* Attempt board-specific reset */ |
| 328 | board_reset(); |
| 329 | |
| 330 | /* Next try asserting HRESET_REQ */ |
| 331 | out_be32(&gur->rstcr, 0x2); |
Kumar Gala | aff0153 | 2009-09-08 13:46:46 -0500 | [diff] [blame] | 332 | udelay(100); |
Pali Rohár | c13f4fb | 2022-08-01 15:31:45 +0200 | [diff] [blame] | 333 | |
| 334 | /* Attempt last-stage board-specific reset */ |
| 335 | board_reset_last(); |
Kumar Gala | aff0153 | 2009-09-08 13:46:46 -0500 | [diff] [blame] | 336 | #endif |
Sergei Poselenov | 2514742 | 2008-05-08 14:17:08 +0200 | [diff] [blame] | 337 | |
wdenk | 9c53f40 | 2003-10-15 23:53:47 +0000 | [diff] [blame] | 338 | return 1; |
| 339 | } |
| 340 | |
| 341 | |
| 342 | /* |
| 343 | * Get timebase clock frequency |
| 344 | */ |
Simon Glass | a9dc068 | 2019-12-28 10:44:59 -0700 | [diff] [blame] | 345 | __weak unsigned long get_tbclk(void) |
wdenk | 9c53f40 | 2003-10-15 23:53:47 +0000 | [diff] [blame] | 346 | { |
Kumar Gala | f4fb90f | 2011-02-18 05:40:54 -0600 | [diff] [blame] | 347 | unsigned long tbclk_div = CONFIG_SYS_FSL_TBCLK_DIV; |
| 348 | |
| 349 | return (gd->bus_clk + (tbclk_div >> 1)) / tbclk_div; |
wdenk | 9c53f40 | 2003-10-15 23:53:47 +0000 | [diff] [blame] | 350 | } |
| 351 | |
| 352 | |
Pali Rohár | f6ac14e | 2022-04-28 13:31:43 +0200 | [diff] [blame] | 353 | #ifndef CONFIG_WDT |
wdenk | 9c53f40 | 2003-10-15 23:53:47 +0000 | [diff] [blame] | 354 | #if defined(CONFIG_WATCHDOG) |
Boschung, Rainer | f63c0dc1 | 2014-06-03 09:05:14 +0200 | [diff] [blame] | 355 | #define WATCHDOG_MASK (TCR_WP(63) | TCR_WRC(3) | TCR_WIE) |
| 356 | void |
| 357 | init_85xx_watchdog(void) |
| 358 | { |
| 359 | mtspr(SPRN_TCR, (mfspr(SPRN_TCR) & ~WATCHDOG_MASK) | |
| 360 | TCR_WP(CONFIG_WATCHDOG_PRESC) | TCR_WRC(CONFIG_WATCHDOG_RC)); |
| 361 | } |
| 362 | |
wdenk | 9c53f40 | 2003-10-15 23:53:47 +0000 | [diff] [blame] | 363 | void |
wdenk | 9c53f40 | 2003-10-15 23:53:47 +0000 | [diff] [blame] | 364 | reset_85xx_watchdog(void) |
| 365 | { |
| 366 | /* |
| 367 | * Clear TSR(WIS) bit by writing 1 |
| 368 | */ |
Mark Marshall | 10b13c9 | 2012-09-09 23:06:03 +0000 | [diff] [blame] | 369 | mtspr(SPRN_TSR, TSR_WIS); |
wdenk | 9c53f40 | 2003-10-15 23:53:47 +0000 | [diff] [blame] | 370 | } |
Horst Kronstorfer | f70831e | 2013-03-13 10:14:05 +0000 | [diff] [blame] | 371 | |
| 372 | void |
| 373 | watchdog_reset(void) |
| 374 | { |
| 375 | int re_enable = disable_interrupts(); |
| 376 | |
| 377 | reset_85xx_watchdog(); |
| 378 | if (re_enable) |
| 379 | enable_interrupts(); |
| 380 | } |
wdenk | 9c53f40 | 2003-10-15 23:53:47 +0000 | [diff] [blame] | 381 | #endif /* CONFIG_WATCHDOG */ |
Pali Rohár | f6ac14e | 2022-04-28 13:31:43 +0200 | [diff] [blame] | 382 | #endif |
wdenk | 9c53f40 | 2003-10-15 23:53:47 +0000 | [diff] [blame] | 383 | |
Sergei Poselenov | ddc1a47 | 2008-06-06 15:42:40 +0200 | [diff] [blame] | 384 | /* |
Andy Fleming | 6843a6e | 2008-10-30 16:51:33 -0500 | [diff] [blame] | 385 | * Initializes on-chip MMC controllers. |
| 386 | * to override, implement board_mmc_init() |
| 387 | */ |
Masahiro Yamada | f7ed78b | 2020-06-26 15:13:33 +0900 | [diff] [blame] | 388 | int cpu_mmc_init(struct bd_info *bis) |
Andy Fleming | 6843a6e | 2008-10-30 16:51:33 -0500 | [diff] [blame] | 389 | { |
| 390 | #ifdef CONFIG_FSL_ESDHC |
| 391 | return fsl_esdhc_mmc_init(bis); |
| 392 | #else |
| 393 | return 0; |
| 394 | #endif |
| 395 | } |
Becky Bruce | ee888da | 2010-06-17 11:37:25 -0500 | [diff] [blame] | 396 | |
| 397 | /* |
| 398 | * Print out the state of various machine registers. |
Dipen Dudhat | 00c4294 | 2011-01-20 16:29:35 +0530 | [diff] [blame] | 399 | * Currently prints out LAWs, BR0/OR0 for LBC, CSPR/CSOR/Timing |
| 400 | * parameters for IFC and TLBs |
Becky Bruce | ee888da | 2010-06-17 11:37:25 -0500 | [diff] [blame] | 401 | */ |
Christophe Leroy | 31f6e93 | 2017-07-13 15:09:54 +0200 | [diff] [blame] | 402 | void print_reginfo(void) |
Becky Bruce | ee888da | 2010-06-17 11:37:25 -0500 | [diff] [blame] | 403 | { |
| 404 | print_tlbcam(); |
Bin Meng | c39f340 | 2021-02-25 17:22:27 +0800 | [diff] [blame] | 405 | #ifdef CONFIG_FSL_LAW |
Becky Bruce | ee888da | 2010-06-17 11:37:25 -0500 | [diff] [blame] | 406 | print_laws(); |
Bin Meng | c39f340 | 2021-02-25 17:22:27 +0800 | [diff] [blame] | 407 | #endif |
Dipen Dudhat | 5d51bf9 | 2011-01-19 12:46:27 +0530 | [diff] [blame] | 408 | #if defined(CONFIG_FSL_LBC) |
Becky Bruce | ee888da | 2010-06-17 11:37:25 -0500 | [diff] [blame] | 409 | print_lbc_regs(); |
Dipen Dudhat | 5d51bf9 | 2011-01-19 12:46:27 +0530 | [diff] [blame] | 410 | #endif |
Dipen Dudhat | 00c4294 | 2011-01-20 16:29:35 +0530 | [diff] [blame] | 411 | #ifdef CONFIG_FSL_IFC |
| 412 | print_ifc_regs(); |
| 413 | #endif |
Dipen Dudhat | 5d51bf9 | 2011-01-19 12:46:27 +0530 | [diff] [blame] | 414 | |
Becky Bruce | ee888da | 2010-06-17 11:37:25 -0500 | [diff] [blame] | 415 | } |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 416 | |
Becky Bruce | 5e35d8a | 2010-12-17 17:17:56 -0600 | [diff] [blame] | 417 | /* Common ddr init for non-corenet fsl 85xx platforms */ |
| 418 | #ifndef CONFIG_FSL_CORENET |
Scott Wood | 095b712 | 2012-09-20 19:02:18 -0500 | [diff] [blame] | 419 | #if (defined(CONFIG_SYS_RAMBOOT) || defined(CONFIG_SPL)) && \ |
Tom Rini | 6a5dccc | 2022-11-16 13:10:41 -0500 | [diff] [blame] | 420 | !defined(CFG_SYS_INIT_L2_ADDR) |
Simon Glass | d35f338 | 2017-04-06 12:47:05 -0600 | [diff] [blame] | 421 | int dram_init(void) |
Becky Bruce | 5e35d8a | 2010-12-17 17:17:56 -0600 | [diff] [blame] | 422 | { |
Alexander Graf | c346848 | 2014-04-11 17:09:45 +0200 | [diff] [blame] | 423 | #if defined(CONFIG_SPD_EEPROM) || defined(CONFIG_DDR_SPD) || \ |
York Sun | 51e91e8 | 2016-11-18 12:29:51 -0800 | [diff] [blame] | 424 | defined(CONFIG_ARCH_QEMU_E500) |
Simon Glass | 39f90ba | 2017-03-31 08:40:25 -0600 | [diff] [blame] | 425 | gd->ram_size = fsl_ddr_sdram_size(); |
Zhao Chenhui | 1a35f3d | 2011-01-28 17:58:37 +0800 | [diff] [blame] | 426 | #else |
Tom Rini | bb4dd96 | 2022-11-16 13:10:37 -0500 | [diff] [blame] | 427 | gd->ram_size = (phys_size_t)CFG_SYS_SDRAM_SIZE * 1024 * 1024; |
Zhao Chenhui | 1a35f3d | 2011-01-28 17:58:37 +0800 | [diff] [blame] | 428 | #endif |
Simon Glass | 39f90ba | 2017-03-31 08:40:25 -0600 | [diff] [blame] | 429 | |
| 430 | return 0; |
Zhao Chenhui | 1a35f3d | 2011-01-28 17:58:37 +0800 | [diff] [blame] | 431 | } |
| 432 | #else /* CONFIG_SYS_RAMBOOT */ |
Simon Glass | d35f338 | 2017-04-06 12:47:05 -0600 | [diff] [blame] | 433 | int dram_init(void) |
Zhao Chenhui | 1a35f3d | 2011-01-28 17:58:37 +0800 | [diff] [blame] | 434 | { |
Becky Bruce | 5e35d8a | 2010-12-17 17:17:56 -0600 | [diff] [blame] | 435 | phys_size_t dram_size = 0; |
| 436 | |
Becky Bruce | 4212f23 | 2010-12-17 17:17:58 -0600 | [diff] [blame] | 437 | #if defined(CONFIG_SYS_FSL_ERRATUM_DDR_MSYNC_IN) |
Becky Bruce | 5e35d8a | 2010-12-17 17:17:56 -0600 | [diff] [blame] | 438 | { |
Tom Rini | d5c3bf2 | 2022-10-28 20:27:12 -0400 | [diff] [blame] | 439 | ccsr_gur_t *gur = (void *)(CFG_SYS_MPC85xx_GUTS_ADDR); |
Becky Bruce | 5e35d8a | 2010-12-17 17:17:56 -0600 | [diff] [blame] | 440 | unsigned int x = 10; |
| 441 | unsigned int i; |
| 442 | |
| 443 | /* |
| 444 | * Work around to stabilize DDR DLL |
| 445 | */ |
| 446 | out_be32(&gur->ddrdllcr, 0x81000000); |
| 447 | asm("sync;isync;msync"); |
| 448 | udelay(200); |
| 449 | while (in_be32(&gur->ddrdllcr) != 0x81000100) { |
| 450 | setbits_be32(&gur->devdisr, 0x00010000); |
| 451 | for (i = 0; i < x; i++) |
| 452 | ; |
| 453 | clrbits_be32(&gur->devdisr, 0x00010000); |
| 454 | x++; |
| 455 | } |
| 456 | } |
| 457 | #endif |
| 458 | |
York Sun | e73cc04 | 2011-06-07 09:42:16 +0800 | [diff] [blame] | 459 | #if defined(CONFIG_SPD_EEPROM) || \ |
| 460 | defined(CONFIG_DDR_SPD) || \ |
| 461 | defined(CONFIG_SYS_DDR_RAW_TIMING) |
Becky Bruce | 5e35d8a | 2010-12-17 17:17:56 -0600 | [diff] [blame] | 462 | dram_size = fsl_ddr_sdram(); |
| 463 | #else |
| 464 | dram_size = fixed_sdram(); |
| 465 | #endif |
| 466 | dram_size = setup_ddr_tlbs(dram_size / 0x100000); |
| 467 | dram_size *= 0x100000; |
| 468 | |
| 469 | #if defined(CONFIG_DDR_ECC) && !defined(CONFIG_ECC_INIT_VIA_DDRCONTROLLER) |
| 470 | /* |
| 471 | * Initialize and enable DDR ECC. |
| 472 | */ |
| 473 | ddr_enable_ecc(dram_size); |
| 474 | #endif |
| 475 | |
Dipen Dudhat | 5d51bf9 | 2011-01-19 12:46:27 +0530 | [diff] [blame] | 476 | #if defined(CONFIG_FSL_LBC) |
Becky Bruce | 5e35d8a | 2010-12-17 17:17:56 -0600 | [diff] [blame] | 477 | /* Some boards also have sdram on the lbc */ |
Becky Bruce | b88d3d0 | 2010-12-17 17:17:57 -0600 | [diff] [blame] | 478 | lbc_sdram_init(); |
Dipen Dudhat | 5d51bf9 | 2011-01-19 12:46:27 +0530 | [diff] [blame] | 479 | #endif |
Becky Bruce | 5e35d8a | 2010-12-17 17:17:56 -0600 | [diff] [blame] | 480 | |
Wolfgang Denk | f2bbb53 | 2011-07-25 10:13:53 +0200 | [diff] [blame] | 481 | debug("DDR: "); |
Simon Glass | 39f90ba | 2017-03-31 08:40:25 -0600 | [diff] [blame] | 482 | gd->ram_size = dram_size; |
| 483 | |
| 484 | return 0; |
Becky Bruce | 5e35d8a | 2010-12-17 17:17:56 -0600 | [diff] [blame] | 485 | } |
Zhao Chenhui | 1a35f3d | 2011-01-28 17:58:37 +0800 | [diff] [blame] | 486 | #endif /* CONFIG_SYS_RAMBOOT */ |
Becky Bruce | 5e35d8a | 2010-12-17 17:17:56 -0600 | [diff] [blame] | 487 | #endif |
| 488 | |
Tom Rini | 8eaa3c7 | 2022-11-19 18:45:44 -0500 | [diff] [blame] | 489 | #if CFG_POST & CFG_SYS_POST_MEMORY |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 490 | |
| 491 | /* Board-specific functions defined in each board's ddr.c */ |
| 492 | void fsl_ddr_get_spd(generic_spd_eeprom_t *ctrl_dimms_spd, |
York Sun | 79a779b | 2014-08-01 15:51:00 -0700 | [diff] [blame] | 493 | unsigned int ctrl_num, unsigned int dimm_slots_per_ctrl); |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 494 | void read_tlbcam_entry(int idx, u32 *valid, u32 *tsize, unsigned long *epn, |
| 495 | phys_addr_t *rpn); |
| 496 | unsigned int |
| 497 | setup_ddr_tlbs_phys(phys_addr_t p_addr, unsigned int memsize_in_meg); |
| 498 | |
Becky Bruce | 6969447 | 2011-07-18 18:49:15 -0500 | [diff] [blame] | 499 | void clear_ddr_tlbs_phys(phys_addr_t p_addr, unsigned int memsize_in_meg); |
| 500 | |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 501 | static void dump_spd_ddr_reg(void) |
| 502 | { |
| 503 | int i, j, k, m; |
| 504 | u8 *p_8; |
| 505 | u32 *p_32; |
York Sun | fe84507 | 2016-12-28 08:43:45 -0800 | [diff] [blame] | 506 | struct ccsr_ddr __iomem *ddr[CONFIG_SYS_NUM_DDR_CTLRS]; |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 507 | generic_spd_eeprom_t |
York Sun | fe84507 | 2016-12-28 08:43:45 -0800 | [diff] [blame] | 508 | spd[CONFIG_SYS_NUM_DDR_CTLRS][CONFIG_DIMM_SLOTS_PER_CTLR]; |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 509 | |
York Sun | fe84507 | 2016-12-28 08:43:45 -0800 | [diff] [blame] | 510 | for (i = 0; i < CONFIG_SYS_NUM_DDR_CTLRS; i++) |
York Sun | 79a779b | 2014-08-01 15:51:00 -0700 | [diff] [blame] | 511 | fsl_ddr_get_spd(spd[i], i, CONFIG_DIMM_SLOTS_PER_CTLR); |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 512 | |
Robert P. J. Day | c5b1e5d | 2016-09-07 14:27:59 -0400 | [diff] [blame] | 513 | puts("SPD data of all dimms (zero value is omitted)...\n"); |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 514 | puts("Byte (hex) "); |
| 515 | k = 1; |
York Sun | fe84507 | 2016-12-28 08:43:45 -0800 | [diff] [blame] | 516 | for (i = 0; i < CONFIG_SYS_NUM_DDR_CTLRS; i++) { |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 517 | for (j = 0; j < CONFIG_DIMM_SLOTS_PER_CTLR; j++) |
| 518 | printf("Dimm%d ", k++); |
| 519 | } |
| 520 | puts("\n"); |
| 521 | for (k = 0; k < sizeof(generic_spd_eeprom_t); k++) { |
| 522 | m = 0; |
| 523 | printf("%3d (0x%02x) ", k, k); |
York Sun | fe84507 | 2016-12-28 08:43:45 -0800 | [diff] [blame] | 524 | for (i = 0; i < CONFIG_SYS_NUM_DDR_CTLRS; i++) { |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 525 | for (j = 0; j < CONFIG_DIMM_SLOTS_PER_CTLR; j++) { |
| 526 | p_8 = (u8 *) &spd[i][j]; |
| 527 | if (p_8[k]) { |
| 528 | printf("0x%02x ", p_8[k]); |
| 529 | m++; |
| 530 | } else |
| 531 | puts(" "); |
| 532 | } |
| 533 | } |
| 534 | if (m) |
| 535 | puts("\n"); |
| 536 | else |
| 537 | puts("\r"); |
| 538 | } |
| 539 | |
York Sun | fe84507 | 2016-12-28 08:43:45 -0800 | [diff] [blame] | 540 | for (i = 0; i < CONFIG_SYS_NUM_DDR_CTLRS; i++) { |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 541 | switch (i) { |
| 542 | case 0: |
Tom Rini | 376b88a | 2022-10-28 20:27:13 -0400 | [diff] [blame] | 543 | ddr[i] = (void *)CFG_SYS_FSL_DDR_ADDR; |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 544 | break; |
Tom Rini | 376b88a | 2022-10-28 20:27:13 -0400 | [diff] [blame] | 545 | #if defined(CFG_SYS_FSL_DDR2_ADDR) && (CONFIG_SYS_NUM_DDR_CTLRS > 1) |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 546 | case 1: |
Tom Rini | 376b88a | 2022-10-28 20:27:13 -0400 | [diff] [blame] | 547 | ddr[i] = (void *)CFG_SYS_FSL_DDR2_ADDR; |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 548 | break; |
| 549 | #endif |
Tom Rini | 376b88a | 2022-10-28 20:27:13 -0400 | [diff] [blame] | 550 | #if defined(CFG_SYS_FSL_DDR3_ADDR) && (CONFIG_SYS_NUM_DDR_CTLRS > 2) |
York Sun | e8dc17b | 2012-08-17 08:22:39 +0000 | [diff] [blame] | 551 | case 2: |
Tom Rini | 376b88a | 2022-10-28 20:27:13 -0400 | [diff] [blame] | 552 | ddr[i] = (void *)CFG_SYS_FSL_DDR3_ADDR; |
York Sun | e8dc17b | 2012-08-17 08:22:39 +0000 | [diff] [blame] | 553 | break; |
| 554 | #endif |
York Sun | fe84507 | 2016-12-28 08:43:45 -0800 | [diff] [blame] | 555 | #if defined(CONFIG_SYS_FSL_DDR4_ADDR) && (CONFIG_SYS_NUM_DDR_CTLRS > 3) |
York Sun | e8dc17b | 2012-08-17 08:22:39 +0000 | [diff] [blame] | 556 | case 3: |
York Sun | f062659 | 2013-09-30 09:22:09 -0700 | [diff] [blame] | 557 | ddr[i] = (void *)CONFIG_SYS_FSL_DDR4_ADDR; |
York Sun | e8dc17b | 2012-08-17 08:22:39 +0000 | [diff] [blame] | 558 | break; |
| 559 | #endif |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 560 | default: |
| 561 | printf("%s unexpected controller number = %u\n", |
| 562 | __func__, i); |
| 563 | return; |
| 564 | } |
| 565 | } |
| 566 | printf("DDR registers dump for all controllers " |
Robert P. J. Day | c5b1e5d | 2016-09-07 14:27:59 -0400 | [diff] [blame] | 567 | "(zero value is omitted)...\n"); |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 568 | puts("Offset (hex) "); |
York Sun | fe84507 | 2016-12-28 08:43:45 -0800 | [diff] [blame] | 569 | for (i = 0; i < CONFIG_SYS_NUM_DDR_CTLRS; i++) |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 570 | printf(" Base + 0x%04x", (u32)ddr[i] & 0xFFFF); |
| 571 | puts("\n"); |
York Sun | a21803d | 2013-11-18 10:29:32 -0800 | [diff] [blame] | 572 | for (k = 0; k < sizeof(struct ccsr_ddr)/4; k++) { |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 573 | m = 0; |
| 574 | printf("%6d (0x%04x)", k * 4, k * 4); |
York Sun | fe84507 | 2016-12-28 08:43:45 -0800 | [diff] [blame] | 575 | for (i = 0; i < CONFIG_SYS_NUM_DDR_CTLRS; i++) { |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 576 | p_32 = (u32 *) ddr[i]; |
| 577 | if (p_32[k]) { |
| 578 | printf(" 0x%08x", p_32[k]); |
| 579 | m++; |
| 580 | } else |
| 581 | puts(" "); |
| 582 | } |
| 583 | if (m) |
| 584 | puts("\n"); |
| 585 | else |
| 586 | puts("\r"); |
| 587 | } |
| 588 | puts("\n"); |
| 589 | } |
| 590 | |
| 591 | /* invalid the TLBs for DDR and setup new ones to cover p_addr */ |
| 592 | static int reset_tlb(phys_addr_t p_addr, u32 size, phys_addr_t *phys_offset) |
| 593 | { |
Tom Rini | 6a5dccc | 2022-11-16 13:10:41 -0500 | [diff] [blame] | 594 | u32 vstart = CFG_SYS_DDR_SDRAM_BASE; |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 595 | unsigned long epn; |
| 596 | u32 tsize, valid, ptr; |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 597 | int ddr_esel; |
| 598 | |
Becky Bruce | 6969447 | 2011-07-18 18:49:15 -0500 | [diff] [blame] | 599 | clear_ddr_tlbs_phys(p_addr, size>>20); |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 600 | |
| 601 | /* Setup new tlb to cover the physical address */ |
| 602 | setup_ddr_tlbs_phys(p_addr, size>>20); |
| 603 | |
| 604 | ptr = vstart; |
| 605 | ddr_esel = find_tlb_idx((void *)ptr, 1); |
| 606 | if (ddr_esel != -1) { |
| 607 | read_tlbcam_entry(ddr_esel, &valid, &tsize, &epn, phys_offset); |
| 608 | } else { |
| 609 | printf("TLB error in function %s\n", __func__); |
| 610 | return -1; |
| 611 | } |
| 612 | |
| 613 | return 0; |
| 614 | } |
| 615 | |
| 616 | /* |
| 617 | * slide the testing window up to test another area |
| 618 | * for 32_bit system, the maximum testable memory is limited to |
Tom Rini | bc9d46b | 2022-12-04 10:04:50 -0500 | [diff] [blame] | 619 | * CFG_MAX_MEM_MAPPED |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 620 | */ |
| 621 | int arch_memory_test_advance(u32 *vstart, u32 *size, phys_addr_t *phys_offset) |
| 622 | { |
| 623 | phys_addr_t test_cap, p_addr; |
Tom Rini | bc9d46b | 2022-12-04 10:04:50 -0500 | [diff] [blame] | 624 | phys_size_t p_size = min(gd->ram_size, CFG_MAX_MEM_MAPPED); |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 625 | |
| 626 | #if !defined(CONFIG_PHYS_64BIT) || \ |
Tom Rini | 6a5dccc | 2022-11-16 13:10:41 -0500 | [diff] [blame] | 627 | !defined(CFG_SYS_INIT_RAM_ADDR_PHYS) || \ |
| 628 | (CFG_SYS_INIT_RAM_ADDR_PHYS < 0x100000000ull) |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 629 | test_cap = p_size; |
| 630 | #else |
| 631 | test_cap = gd->ram_size; |
| 632 | #endif |
| 633 | p_addr = (*vstart) + (*size) + (*phys_offset); |
| 634 | if (p_addr < test_cap - 1) { |
Tom Rini | bc9d46b | 2022-12-04 10:04:50 -0500 | [diff] [blame] | 635 | p_size = min(test_cap - p_addr, CFG_MAX_MEM_MAPPED); |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 636 | if (reset_tlb(p_addr, p_size, phys_offset) == -1) |
| 637 | return -1; |
Tom Rini | 6a5dccc | 2022-11-16 13:10:41 -0500 | [diff] [blame] | 638 | *vstart = CFG_SYS_DDR_SDRAM_BASE; |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 639 | *size = (u32) p_size; |
| 640 | printf("Testing 0x%08llx - 0x%08llx\n", |
| 641 | (u64)(*vstart) + (*phys_offset), |
| 642 | (u64)(*vstart) + (*phys_offset) + (*size) - 1); |
| 643 | } else |
| 644 | return 1; |
| 645 | |
| 646 | return 0; |
| 647 | } |
| 648 | |
| 649 | /* initialization for testing area */ |
| 650 | int arch_memory_test_prepare(u32 *vstart, u32 *size, phys_addr_t *phys_offset) |
| 651 | { |
Tom Rini | bc9d46b | 2022-12-04 10:04:50 -0500 | [diff] [blame] | 652 | phys_size_t p_size = min(gd->ram_size, CFG_MAX_MEM_MAPPED); |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 653 | |
Tom Rini | 6a5dccc | 2022-11-16 13:10:41 -0500 | [diff] [blame] | 654 | *vstart = CFG_SYS_DDR_SDRAM_BASE; |
Tom Rini | bc9d46b | 2022-12-04 10:04:50 -0500 | [diff] [blame] | 655 | *size = (u32) p_size; /* CFG_MAX_MEM_MAPPED < 4G */ |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 656 | *phys_offset = 0; |
| 657 | |
| 658 | #if !defined(CONFIG_PHYS_64BIT) || \ |
Tom Rini | 6a5dccc | 2022-11-16 13:10:41 -0500 | [diff] [blame] | 659 | !defined(CFG_SYS_INIT_RAM_ADDR_PHYS) || \ |
| 660 | (CFG_SYS_INIT_RAM_ADDR_PHYS < 0x100000000ull) |
Tom Rini | bc9d46b | 2022-12-04 10:04:50 -0500 | [diff] [blame] | 661 | if (gd->ram_size > CFG_MAX_MEM_MAPPED) { |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 662 | puts("Cannot test more than "); |
Tom Rini | bc9d46b | 2022-12-04 10:04:50 -0500 | [diff] [blame] | 663 | print_size(CFG_MAX_MEM_MAPPED, |
York Sun | c41b744 | 2010-09-28 15:20:33 -0700 | [diff] [blame] | 664 | " without proper 36BIT support.\n"); |
| 665 | } |
| 666 | #endif |
| 667 | printf("Testing 0x%08llx - 0x%08llx\n", |
| 668 | (u64)(*vstart) + (*phys_offset), |
| 669 | (u64)(*vstart) + (*phys_offset) + (*size) - 1); |
| 670 | |
| 671 | return 0; |
| 672 | } |
| 673 | |
| 674 | /* invalid TLBs for DDR and remap as normal after testing */ |
| 675 | int arch_memory_test_cleanup(u32 *vstart, u32 *size, phys_addr_t *phys_offset) |
| 676 | { |
| 677 | unsigned long epn; |
| 678 | u32 tsize, valid, ptr; |
| 679 | phys_addr_t rpn = 0; |
| 680 | int ddr_esel; |
| 681 | |
| 682 | /* disable the TLBs for this testing */ |
| 683 | ptr = *vstart; |
| 684 | |
| 685 | while (ptr < (*vstart) + (*size)) { |
| 686 | ddr_esel = find_tlb_idx((void *)ptr, 1); |
| 687 | if (ddr_esel != -1) { |
| 688 | read_tlbcam_entry(ddr_esel, &valid, &tsize, &epn, &rpn); |
| 689 | disable_tlb(ddr_esel); |
| 690 | } |
| 691 | ptr += TSIZE_TO_BYTES(tsize); |
| 692 | } |
| 693 | |
| 694 | puts("Remap DDR "); |
| 695 | setup_ddr_tlbs(gd->ram_size>>20); |
| 696 | puts("\n"); |
| 697 | |
| 698 | return 0; |
| 699 | } |
| 700 | |
| 701 | void arch_memory_failure_handle(void) |
| 702 | { |
| 703 | dump_spd_ddr_reg(); |
| 704 | } |
| 705 | #endif |