wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 1 | /* |
wdenk | d4ca31c | 2004-01-02 14:00:00 +0000 | [diff] [blame] | 2 | * (C) Copyright 2000-2004 |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 3 | * Wolfgang Denk, DENX Software Engineering, wd@denx.de. |
| 4 | * |
| 5 | * See file CREDITS for list of people who contributed to this |
| 6 | * project. |
| 7 | * |
| 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. |
| 12 | * |
| 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. |
| 17 | * |
| 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, |
| 21 | * MA 02111-1307 USA |
| 22 | */ |
| 23 | |
| 24 | #include <common.h> |
| 25 | #include <watchdog.h> |
| 26 | #include <command.h> |
| 27 | #include <malloc.h> |
| 28 | #include <devices.h> |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 29 | #ifdef CONFIG_8xx |
| 30 | #include <mpc8xx.h> |
| 31 | #endif |
wdenk | 0db5bca | 2003-03-31 17:27:09 +0000 | [diff] [blame] | 32 | #ifdef CONFIG_5xx |
| 33 | #include <mpc5xx.h> |
| 34 | #endif |
wdenk | cbd8a35 | 2004-02-24 02:00:03 +0000 | [diff] [blame] | 35 | #ifdef CONFIG_MPC5xxx |
wdenk | 945af8d | 2003-07-16 21:53:01 +0000 | [diff] [blame] | 36 | #include <mpc5xxx.h> |
| 37 | #endif |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 38 | #if (CONFIG_COMMANDS & CFG_CMD_IDE) |
| 39 | #include <ide.h> |
| 40 | #endif |
| 41 | #if (CONFIG_COMMANDS & CFG_CMD_SCSI) |
| 42 | #include <scsi.h> |
| 43 | #endif |
| 44 | #if (CONFIG_COMMANDS & CFG_CMD_KGDB) |
| 45 | #include <kgdb.h> |
| 46 | #endif |
| 47 | #ifdef CONFIG_STATUS_LED |
| 48 | #include <status_led.h> |
| 49 | #endif |
| 50 | #include <net.h> |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 51 | #include <serial.h> |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 52 | #ifdef CFG_ALLOC_DPRAM |
Jon Loeliger | 9c4c5ae | 2005-07-23 10:37:35 -0500 | [diff] [blame] | 53 | #if !defined(CONFIG_CPM2) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 54 | #include <commproc.h> |
| 55 | #endif |
wdenk | 7aa7861 | 2003-05-03 15:50:43 +0000 | [diff] [blame] | 56 | #endif |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 57 | #include <version.h> |
| 58 | #if defined(CONFIG_BAB7xx) |
| 59 | #include <w83c553f.h> |
| 60 | #endif |
| 61 | #include <dtt.h> |
| 62 | #if defined(CONFIG_POST) |
| 63 | #include <post.h> |
| 64 | #endif |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 65 | #if defined(CONFIG_LOGBUFFER) |
| 66 | #include <logbuff.h> |
| 67 | #endif |
wdenk | 42d1f03 | 2003-10-15 23:53:47 +0000 | [diff] [blame] | 68 | #if defined(CFG_INIT_RAM_LOCK) && defined(CONFIG_E500) |
| 69 | #include <asm/cache.h> |
| 70 | #endif |
wdenk | 1c43771 | 2004-01-16 00:30:56 +0000 | [diff] [blame] | 71 | #ifdef CONFIG_PS2KBD |
| 72 | #include <keyboard.h> |
| 73 | #endif |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 74 | |
| 75 | #if (CONFIG_COMMANDS & CFG_CMD_DOC) |
| 76 | void doc_init (void); |
| 77 | #endif |
| 78 | #if defined(CONFIG_HARD_I2C) || \ |
| 79 | defined(CONFIG_SOFT_I2C) |
| 80 | #include <i2c.h> |
| 81 | #endif |
stroese | bedc497 | 2003-05-23 11:16:49 +0000 | [diff] [blame] | 82 | #if (CONFIG_COMMANDS & CFG_CMD_NAND) |
| 83 | void nand_init (void); |
| 84 | #endif |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 85 | |
| 86 | static char *failed = "*** failed ***\n"; |
| 87 | |
wdenk | 17d704e | 2004-04-10 20:43:50 +0000 | [diff] [blame] | 88 | #if defined(CONFIG_OXC) || defined(CONFIG_PCU_E) || defined(CONFIG_RMU) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 89 | extern flash_info_t flash_info[]; |
wdenk | 17d704e | 2004-04-10 20:43:50 +0000 | [diff] [blame] | 90 | #endif |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 91 | |
| 92 | #include <environment.h> |
Wolfgang Denk | bce84c4 | 2005-08-30 14:13:23 +0200 | [diff] [blame] | 93 | DECLARE_GLOBAL_DATA_PTR; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 94 | |
wdenk | 7e78036 | 2004-04-08 22:31:29 +0000 | [diff] [blame] | 95 | #if defined(CFG_ENV_IS_EMBEDDED) |
| 96 | #define TOTAL_MALLOC_LEN CFG_MALLOC_LEN |
| 97 | #elif ( ((CFG_ENV_ADDR+CFG_ENV_SIZE) < CFG_MONITOR_BASE) || \ |
wdenk | 04a85b3 | 2004-04-15 18:22:41 +0000 | [diff] [blame] | 98 | (CFG_ENV_ADDR >= (CFG_MONITOR_BASE + CFG_MONITOR_LEN)) ) || \ |
wdenk | 7e78036 | 2004-04-08 22:31:29 +0000 | [diff] [blame] | 99 | defined(CFG_ENV_IS_IN_NVRAM) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 100 | #define TOTAL_MALLOC_LEN (CFG_MALLOC_LEN + CFG_ENV_SIZE) |
| 101 | #else |
| 102 | #define TOTAL_MALLOC_LEN CFG_MALLOC_LEN |
| 103 | #endif |
| 104 | |
wdenk | 3b57fe0 | 2003-05-30 12:48:29 +0000 | [diff] [blame] | 105 | extern ulong __init_end; |
| 106 | extern ulong _end; |
wdenk | 3b57fe0 | 2003-05-30 12:48:29 +0000 | [diff] [blame] | 107 | ulong monitor_flash_len; |
| 108 | |
wdenk | 8bde7f7 | 2003-06-27 21:31:46 +0000 | [diff] [blame] | 109 | #if (CONFIG_COMMANDS & CFG_CMD_BEDBUG) |
| 110 | #include <bedbug/type.h> |
| 111 | #endif |
| 112 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 113 | /* |
| 114 | * Begin and End of memory area for malloc(), and current "brk" |
| 115 | */ |
| 116 | static ulong mem_malloc_start = 0; |
| 117 | static ulong mem_malloc_end = 0; |
| 118 | static ulong mem_malloc_brk = 0; |
| 119 | |
| 120 | /************************************************************************ |
| 121 | * Utilities * |
| 122 | ************************************************************************ |
| 123 | */ |
| 124 | |
| 125 | /* |
| 126 | * The Malloc area is immediately below the monitor copy in DRAM |
| 127 | */ |
| 128 | static void mem_malloc_init (void) |
| 129 | { |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 130 | ulong dest_addr = CFG_MONITOR_BASE + gd->reloc_off; |
| 131 | |
| 132 | mem_malloc_end = dest_addr; |
| 133 | mem_malloc_start = dest_addr - TOTAL_MALLOC_LEN; |
| 134 | mem_malloc_brk = mem_malloc_start; |
| 135 | |
| 136 | memset ((void *) mem_malloc_start, |
| 137 | 0, |
| 138 | mem_malloc_end - mem_malloc_start); |
| 139 | } |
| 140 | |
| 141 | void *sbrk (ptrdiff_t increment) |
| 142 | { |
| 143 | ulong old = mem_malloc_brk; |
| 144 | ulong new = old + increment; |
| 145 | |
| 146 | if ((new < mem_malloc_start) || (new > mem_malloc_end)) { |
| 147 | return (NULL); |
| 148 | } |
| 149 | mem_malloc_brk = new; |
| 150 | return ((void *) old); |
| 151 | } |
| 152 | |
| 153 | char *strmhz (char *buf, long hz) |
| 154 | { |
| 155 | long l, n; |
| 156 | long m; |
| 157 | |
| 158 | n = hz / 1000000L; |
| 159 | l = sprintf (buf, "%ld", n); |
| 160 | m = (hz % 1000000L) / 1000L; |
| 161 | if (m != 0) |
| 162 | sprintf (buf + l, ".%03ld", m); |
| 163 | return (buf); |
| 164 | } |
| 165 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 166 | /* |
| 167 | * All attempts to come up with a "common" initialization sequence |
| 168 | * that works for all boards and architectures failed: some of the |
| 169 | * requirements are just _too_ different. To get rid of the resulting |
| 170 | * mess of board dependend #ifdef'ed code we now make the whole |
| 171 | * initialization sequence configurable to the user. |
| 172 | * |
| 173 | * The requirements for any new initalization function is simple: it |
| 174 | * receives a pointer to the "global data" structure as it's only |
| 175 | * argument, and returns an integer return code, where 0 means |
| 176 | * "continue" and != 0 means "fatal error, hang the system". |
| 177 | */ |
| 178 | typedef int (init_fnc_t) (void); |
| 179 | |
| 180 | /************************************************************************ |
| 181 | * Init Utilities * |
| 182 | ************************************************************************ |
| 183 | * Some of this code should be moved into the core functions, |
| 184 | * but let's get it working (again) first... |
| 185 | */ |
| 186 | |
| 187 | static int init_baudrate (void) |
| 188 | { |
Wolfgang Denk | 77ddac9 | 2005-10-13 16:45:02 +0200 | [diff] [blame] | 189 | char tmp[64]; /* long enough for environment variables */ |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 190 | int i = getenv_r ("baudrate", tmp, sizeof (tmp)); |
| 191 | |
| 192 | gd->baudrate = (i > 0) |
| 193 | ? (int) simple_strtoul (tmp, NULL, 10) |
| 194 | : CONFIG_BAUDRATE; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 195 | return (0); |
| 196 | } |
| 197 | |
| 198 | /***********************************************************************/ |
| 199 | |
Stefan Roese | d96f41e | 2005-11-30 13:06:40 +0100 | [diff] [blame] | 200 | #ifdef CONFIG_ADD_RAM_INFO |
| 201 | void board_add_ram_info(int); |
| 202 | #endif |
| 203 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 204 | static int init_func_ram (void) |
| 205 | { |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 206 | #ifdef CONFIG_BOARD_TYPES |
| 207 | int board_type = gd->board_type; |
| 208 | #else |
| 209 | int board_type = 0; /* use dummy arg */ |
| 210 | #endif |
| 211 | puts ("DRAM: "); |
| 212 | |
| 213 | if ((gd->ram_size = initdram (board_type)) > 0) { |
Stefan Roese | d96f41e | 2005-11-30 13:06:40 +0100 | [diff] [blame] | 214 | print_size (gd->ram_size, ""); |
| 215 | #ifdef CONFIG_ADD_RAM_INFO |
| 216 | board_add_ram_info(0); |
| 217 | #endif |
| 218 | putc('\n'); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 219 | return (0); |
| 220 | } |
| 221 | puts (failed); |
| 222 | return (1); |
| 223 | } |
| 224 | |
| 225 | /***********************************************************************/ |
| 226 | |
| 227 | #if defined(CONFIG_HARD_I2C) || defined(CONFIG_SOFT_I2C) |
| 228 | static int init_func_i2c (void) |
| 229 | { |
| 230 | puts ("I2C: "); |
| 231 | i2c_init (CFG_I2C_SPEED, CFG_I2C_SLAVE); |
| 232 | puts ("ready\n"); |
| 233 | return (0); |
| 234 | } |
| 235 | #endif |
| 236 | |
| 237 | /***********************************************************************/ |
| 238 | |
| 239 | #if defined(CONFIG_WATCHDOG) |
| 240 | static int init_func_watchdog_init (void) |
| 241 | { |
| 242 | puts (" Watchdog enabled\n"); |
| 243 | WATCHDOG_RESET (); |
| 244 | return (0); |
| 245 | } |
| 246 | # define INIT_FUNC_WATCHDOG_INIT init_func_watchdog_init, |
| 247 | |
| 248 | static int init_func_watchdog_reset (void) |
| 249 | { |
| 250 | WATCHDOG_RESET (); |
| 251 | return (0); |
| 252 | } |
| 253 | # define INIT_FUNC_WATCHDOG_RESET init_func_watchdog_reset, |
| 254 | #else |
| 255 | # define INIT_FUNC_WATCHDOG_INIT /* undef */ |
| 256 | # define INIT_FUNC_WATCHDOG_RESET /* undef */ |
| 257 | #endif /* CONFIG_WATCHDOG */ |
| 258 | |
| 259 | /************************************************************************ |
| 260 | * Initialization sequence * |
| 261 | ************************************************************************ |
| 262 | */ |
| 263 | |
| 264 | init_fnc_t *init_sequence[] = { |
| 265 | |
wdenk | c837dcb | 2004-01-20 23:12:12 +0000 | [diff] [blame] | 266 | #if defined(CONFIG_BOARD_EARLY_INIT_F) |
| 267 | board_early_init_f, |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 268 | #endif |
wdenk | c178d3d | 2004-01-24 20:25:54 +0000 | [diff] [blame] | 269 | |
wdenk | 66ca92a | 2004-09-28 17:59:53 +0000 | [diff] [blame] | 270 | #if !defined(CONFIG_8xx_CPUCLK_DEFAULT) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 271 | get_clocks, /* get CPU and bus clocks (etc.) */ |
wdenk | e9132ea | 2004-04-24 23:23:30 +0000 | [diff] [blame] | 272 | #if defined(CONFIG_TQM8xxL) && !defined(CONFIG_TQM866M) |
| 273 | adjust_sdram_tbs_8xx, |
| 274 | #endif |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 275 | init_timebase, |
wdenk | c178d3d | 2004-01-24 20:25:54 +0000 | [diff] [blame] | 276 | #endif |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 277 | #ifdef CFG_ALLOC_DPRAM |
Jon Loeliger | 9c4c5ae | 2005-07-23 10:37:35 -0500 | [diff] [blame] | 278 | #if !defined(CONFIG_CPM2) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 279 | dpram_init, |
| 280 | #endif |
wdenk | 7aa7861 | 2003-05-03 15:50:43 +0000 | [diff] [blame] | 281 | #endif |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 282 | #if defined(CONFIG_BOARD_POSTCLK_INIT) |
| 283 | board_postclk_init, |
| 284 | #endif |
| 285 | env_init, |
wdenk | 66ca92a | 2004-09-28 17:59:53 +0000 | [diff] [blame] | 286 | #if defined(CONFIG_8xx_CPUCLK_DEFAULT) |
wdenk | c178d3d | 2004-01-24 20:25:54 +0000 | [diff] [blame] | 287 | get_clocks_866, /* get CPU and bus clocks according to the environment variable */ |
| 288 | sdram_adjust_866, /* adjust sdram refresh rate according to the new clock */ |
| 289 | init_timebase, |
| 290 | #endif |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 291 | init_baudrate, |
| 292 | serial_init, |
| 293 | console_init_f, |
| 294 | display_options, |
| 295 | #if defined(CONFIG_8260) |
| 296 | prt_8260_rsr, |
| 297 | prt_8260_clks, |
| 298 | #endif /* CONFIG_8260 */ |
Eran Liberty | f046ccd | 2005-07-28 10:08:46 -0500 | [diff] [blame] | 299 | |
| 300 | #if defined(CONFIG_MPC83XX) |
| 301 | print_clock_conf, |
| 302 | #endif |
| 303 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 304 | checkcpu, |
wdenk | cbd8a35 | 2004-02-24 02:00:03 +0000 | [diff] [blame] | 305 | #if defined(CONFIG_MPC5xxx) |
wdenk | 945af8d | 2003-07-16 21:53:01 +0000 | [diff] [blame] | 306 | prt_mpc5xxx_clks, |
wdenk | cbd8a35 | 2004-02-24 02:00:03 +0000 | [diff] [blame] | 307 | #endif /* CONFIG_MPC5xxx */ |
wdenk | 983fda8 | 2004-10-28 00:09:35 +0000 | [diff] [blame] | 308 | #if defined(CONFIG_MPC8220) |
| 309 | prt_mpc8220_clks, |
| 310 | #endif |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 311 | checkboard, |
| 312 | INIT_FUNC_WATCHDOG_INIT |
wdenk | c837dcb | 2004-01-20 23:12:12 +0000 | [diff] [blame] | 313 | #if defined(CONFIG_MISC_INIT_F) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 314 | misc_init_f, |
| 315 | #endif |
| 316 | INIT_FUNC_WATCHDOG_RESET |
| 317 | #if defined(CONFIG_HARD_I2C) || defined(CONFIG_SOFT_I2C) |
| 318 | init_func_i2c, |
| 319 | #endif |
| 320 | #if defined(CONFIG_DTT) /* Digital Thermometers and Thermostats */ |
| 321 | dtt_init, |
| 322 | #endif |
wdenk | 4532cb6 | 2003-04-27 22:52:51 +0000 | [diff] [blame] | 323 | #ifdef CONFIG_POST |
| 324 | post_init_f, |
| 325 | #endif |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 326 | INIT_FUNC_WATCHDOG_RESET |
| 327 | init_func_ram, |
| 328 | #if defined(CFG_DRAM_TEST) |
| 329 | testdram, |
| 330 | #endif /* CFG_DRAM_TEST */ |
| 331 | INIT_FUNC_WATCHDOG_RESET |
| 332 | |
| 333 | NULL, /* Terminate this list */ |
| 334 | }; |
| 335 | |
| 336 | /************************************************************************ |
| 337 | * |
| 338 | * This is the first part of the initialization sequence that is |
| 339 | * implemented in C, but still running from ROM. |
| 340 | * |
| 341 | * The main purpose is to provide a (serial) console interface as |
| 342 | * soon as possible (so we can see any error messages), and to |
| 343 | * initialize the RAM so that we can relocate the monitor code to |
| 344 | * RAM. |
| 345 | * |
| 346 | * Be aware of the restrictions: global data is read-only, BSS is not |
| 347 | * initialized, and stack space is limited to a few kB. |
| 348 | * |
| 349 | ************************************************************************ |
| 350 | */ |
| 351 | |
| 352 | void board_init_f (ulong bootflag) |
| 353 | { |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 354 | bd_t *bd; |
| 355 | ulong len, addr, addr_sp; |
Wolfgang Denk | 7bc5ee0 | 2005-08-26 01:36:03 +0200 | [diff] [blame] | 356 | ulong *s; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 357 | gd_t *id; |
| 358 | init_fnc_t **init_fnc_ptr; |
| 359 | #ifdef CONFIG_PRAM |
| 360 | int i; |
| 361 | ulong reg; |
| 362 | uchar tmp[64]; /* long enough for environment variables */ |
| 363 | #endif |
| 364 | |
| 365 | /* Pointer is writable since we allocated a register for it */ |
| 366 | gd = (gd_t *) (CFG_INIT_RAM_ADDR + CFG_GBL_DATA_OFFSET); |
wdenk | 93f6a67 | 2004-07-01 20:28:03 +0000 | [diff] [blame] | 367 | /* compiler optimization barrier needed for GCC >= 3.4 */ |
| 368 | __asm__ __volatile__("": : :"memory"); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 369 | |
Jon Loeliger | 9c4c5ae | 2005-07-23 10:37:35 -0500 | [diff] [blame] | 370 | #if !defined(CONFIG_CPM2) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 371 | /* Clear initial global data */ |
| 372 | memset ((void *) gd, 0, sizeof (gd_t)); |
| 373 | #endif |
| 374 | |
| 375 | for (init_fnc_ptr = init_sequence; *init_fnc_ptr; ++init_fnc_ptr) { |
| 376 | if ((*init_fnc_ptr) () != 0) { |
| 377 | hang (); |
| 378 | } |
| 379 | } |
| 380 | |
| 381 | /* |
| 382 | * Now that we have DRAM mapped and working, we can |
| 383 | * relocate the code and continue running from DRAM. |
| 384 | * |
| 385 | * Reserve memory at end of RAM for (top down in that order): |
wdenk | 8bde7f7 | 2003-06-27 21:31:46 +0000 | [diff] [blame] | 386 | * - kernel log buffer |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 387 | * - protected RAM |
| 388 | * - LCD framebuffer |
| 389 | * - monitor code |
| 390 | * - board info struct |
| 391 | */ |
wdenk | 3b57fe0 | 2003-05-30 12:48:29 +0000 | [diff] [blame] | 392 | len = (ulong)&_end - CFG_MONITOR_BASE; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 393 | |
| 394 | #ifndef CONFIG_VERY_BIG_RAM |
| 395 | addr = CFG_SDRAM_BASE + gd->ram_size; |
| 396 | #else |
| 397 | /* only allow stack below 256M */ |
| 398 | addr = CFG_SDRAM_BASE + |
| 399 | (gd->ram_size > 256 << 20) ? 256 << 20 : gd->ram_size; |
| 400 | #endif |
| 401 | |
wdenk | 228f29a | 2002-12-08 09:53:23 +0000 | [diff] [blame] | 402 | #ifdef CONFIG_LOGBUFFER |
| 403 | /* reserve kernel log buffer */ |
| 404 | addr -= (LOGBUFF_RESERVE); |
wdenk | 9d2b18a | 2003-06-28 23:11:04 +0000 | [diff] [blame] | 405 | debug ("Reserving %dk for kernel logbuffer at %08lx\n", LOGBUFF_LEN, addr); |
wdenk | 228f29a | 2002-12-08 09:53:23 +0000 | [diff] [blame] | 406 | #endif |
| 407 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 408 | #ifdef CONFIG_PRAM |
| 409 | /* |
| 410 | * reserve protected RAM |
| 411 | */ |
Wolfgang Denk | 77ddac9 | 2005-10-13 16:45:02 +0200 | [diff] [blame] | 412 | i = getenv_r ("pram", (char *)tmp, sizeof (tmp)); |
| 413 | reg = (i > 0) ? simple_strtoul ((const char *)tmp, NULL, 10) : CONFIG_PRAM; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 414 | addr -= (reg << 10); /* size is in kB */ |
wdenk | 9d2b18a | 2003-06-28 23:11:04 +0000 | [diff] [blame] | 415 | debug ("Reserving %ldk for protected RAM at %08lx\n", reg, addr); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 416 | #endif /* CONFIG_PRAM */ |
| 417 | |
| 418 | /* round down to next 4 kB limit */ |
| 419 | addr &= ~(4096 - 1); |
wdenk | 9d2b18a | 2003-06-28 23:11:04 +0000 | [diff] [blame] | 420 | debug ("Top of RAM usable for U-Boot at: %08lx\n", addr); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 421 | |
| 422 | #ifdef CONFIG_LCD |
| 423 | /* reserve memory for LCD display (always full pages) */ |
| 424 | addr = lcd_setmem (addr); |
| 425 | gd->fb_base = addr; |
| 426 | #endif /* CONFIG_LCD */ |
| 427 | |
| 428 | #if defined(CONFIG_VIDEO) && defined(CONFIG_8xx) |
| 429 | /* reserve memory for video display (always full pages) */ |
| 430 | addr = video_setmem (addr); |
| 431 | gd->fb_base = addr; |
| 432 | #endif /* CONFIG_VIDEO */ |
| 433 | |
| 434 | /* |
| 435 | * reserve memory for U-Boot code, data & bss |
wdenk | 682011f | 2003-06-03 23:54:09 +0000 | [diff] [blame] | 436 | * round down to next 4 kB limit |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 437 | */ |
| 438 | addr -= len; |
wdenk | 682011f | 2003-06-03 23:54:09 +0000 | [diff] [blame] | 439 | addr &= ~(4096 - 1); |
Wolfgang Denk | 7d31499 | 2005-10-05 00:00:54 +0200 | [diff] [blame] | 440 | #ifdef CONFIG_E500 |
| 441 | /* round down to next 64 kB limit so that IVPR stays aligned */ |
| 442 | addr &= ~(65536 - 1); |
| 443 | #endif |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 444 | |
wdenk | 9d2b18a | 2003-06-28 23:11:04 +0000 | [diff] [blame] | 445 | debug ("Reserving %ldk for U-Boot at: %08lx\n", len >> 10, addr); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 446 | |
wdenk | c7de829 | 2002-11-19 11:04:11 +0000 | [diff] [blame] | 447 | #ifdef CONFIG_AMIGAONEG3SE |
| 448 | gd->relocaddr = addr; |
| 449 | #endif |
| 450 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 451 | /* |
| 452 | * reserve memory for malloc() arena |
| 453 | */ |
| 454 | addr_sp = addr - TOTAL_MALLOC_LEN; |
wdenk | 9d2b18a | 2003-06-28 23:11:04 +0000 | [diff] [blame] | 455 | debug ("Reserving %dk for malloc() at: %08lx\n", |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 456 | TOTAL_MALLOC_LEN >> 10, addr_sp); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 457 | |
| 458 | /* |
| 459 | * (permanently) allocate a Board Info struct |
| 460 | * and a permanent copy of the "global" data |
| 461 | */ |
| 462 | addr_sp -= sizeof (bd_t); |
| 463 | bd = (bd_t *) addr_sp; |
| 464 | gd->bd = bd; |
wdenk | 9d2b18a | 2003-06-28 23:11:04 +0000 | [diff] [blame] | 465 | debug ("Reserving %d Bytes for Board Info at: %08lx\n", |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 466 | sizeof (bd_t), addr_sp); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 467 | addr_sp -= sizeof (gd_t); |
| 468 | id = (gd_t *) addr_sp; |
wdenk | 9d2b18a | 2003-06-28 23:11:04 +0000 | [diff] [blame] | 469 | debug ("Reserving %d Bytes for Global Data at: %08lx\n", |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 470 | sizeof (gd_t), addr_sp); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 471 | |
| 472 | /* |
| 473 | * Finally, we set up a new (bigger) stack. |
| 474 | * |
| 475 | * Leave some safety gap for SP, force alignment on 16 byte boundary |
| 476 | * Clear initial stack frame |
| 477 | */ |
| 478 | addr_sp -= 16; |
| 479 | addr_sp &= ~0xF; |
Wolfgang Denk | 7bc5ee0 | 2005-08-26 01:36:03 +0200 | [diff] [blame] | 480 | s = (ulong *)addr_sp; |
| 481 | *s-- = 0; |
| 482 | *s-- = 0; |
| 483 | addr_sp = (ulong)s; |
wdenk | 9d2b18a | 2003-06-28 23:11:04 +0000 | [diff] [blame] | 484 | debug ("Stack Pointer at: %08lx\n", addr_sp); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 485 | |
| 486 | /* |
| 487 | * Save local variables to board info struct |
| 488 | */ |
| 489 | |
wdenk | c837dcb | 2004-01-20 23:12:12 +0000 | [diff] [blame] | 490 | bd->bi_memstart = CFG_SDRAM_BASE; /* start of DRAM memory */ |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 491 | bd->bi_memsize = gd->ram_size; /* size of DRAM memory in bytes */ |
| 492 | |
| 493 | #ifdef CONFIG_IP860 |
wdenk | c837dcb | 2004-01-20 23:12:12 +0000 | [diff] [blame] | 494 | bd->bi_sramstart = SRAM_BASE; /* start of SRAM memory */ |
| 495 | bd->bi_sramsize = SRAM_SIZE; /* size of SRAM memory */ |
wdenk | 983fda8 | 2004-10-28 00:09:35 +0000 | [diff] [blame] | 496 | #elif defined CONFIG_MPC8220 |
| 497 | bd->bi_sramstart = CFG_SRAM_BASE; /* start of SRAM memory */ |
| 498 | bd->bi_sramsize = CFG_SRAM_SIZE; /* size of SRAM memory */ |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 499 | #else |
wdenk | c837dcb | 2004-01-20 23:12:12 +0000 | [diff] [blame] | 500 | bd->bi_sramstart = 0; /* FIXME */ /* start of SRAM memory */ |
| 501 | bd->bi_sramsize = 0; /* FIXME */ /* size of SRAM memory */ |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 502 | #endif |
| 503 | |
wdenk | 42d1f03 | 2003-10-15 23:53:47 +0000 | [diff] [blame] | 504 | #if defined(CONFIG_8xx) || defined(CONFIG_8260) || defined(CONFIG_5xx) || \ |
| 505 | defined(CONFIG_E500) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 506 | bd->bi_immr_base = CFG_IMMR; /* base of IMMR register */ |
| 507 | #endif |
wdenk | cbd8a35 | 2004-02-24 02:00:03 +0000 | [diff] [blame] | 508 | #if defined(CONFIG_MPC5xxx) |
wdenk | 945af8d | 2003-07-16 21:53:01 +0000 | [diff] [blame] | 509 | bd->bi_mbar_base = CFG_MBAR; /* base of internal registers */ |
| 510 | #endif |
Eran Liberty | f046ccd | 2005-07-28 10:08:46 -0500 | [diff] [blame] | 511 | #if defined(CONFIG_MPC83XX) |
| 512 | bd->bi_immrbar = CFG_IMMRBAR; |
| 513 | #endif |
wdenk | 983fda8 | 2004-10-28 00:09:35 +0000 | [diff] [blame] | 514 | #if defined(CONFIG_MPC8220) |
| 515 | bd->bi_mbar_base = CFG_MBAR; /* base of internal registers */ |
| 516 | bd->bi_inpfreq = gd->inp_clk; |
| 517 | bd->bi_pcifreq = gd->pci_clk; |
| 518 | bd->bi_vcofreq = gd->vco_clk; |
| 519 | bd->bi_pevfreq = gd->pev_clk; |
| 520 | bd->bi_flbfreq = gd->flb_clk; |
| 521 | |
| 522 | /* store bootparam to sram (backward compatible), here? */ |
| 523 | { |
wdenk | 9d5028c | 2004-11-21 00:06:33 +0000 | [diff] [blame] | 524 | u32 *sram = (u32 *)CFG_SRAM_BASE; |
| 525 | *sram++ = gd->ram_size; |
| 526 | *sram++ = gd->bus_clk; |
| 527 | *sram++ = gd->inp_clk; |
| 528 | *sram++ = gd->cpu_clk; |
| 529 | *sram++ = gd->vco_clk; |
| 530 | *sram++ = gd->flb_clk; |
| 531 | *sram++ = 0xb8c3ba11; /* boot signature */ |
wdenk | 983fda8 | 2004-10-28 00:09:35 +0000 | [diff] [blame] | 532 | } |
| 533 | #endif |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 534 | |
| 535 | bd->bi_bootflags = bootflag; /* boot / reboot flag (for LynxOS) */ |
| 536 | |
| 537 | WATCHDOG_RESET (); |
| 538 | bd->bi_intfreq = gd->cpu_clk; /* Internal Freq, in Hz */ |
| 539 | bd->bi_busfreq = gd->bus_clk; /* Bus Freq, in Hz */ |
Jon Loeliger | 9c4c5ae | 2005-07-23 10:37:35 -0500 | [diff] [blame] | 540 | #if defined(CONFIG_CPM2) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 541 | bd->bi_cpmfreq = gd->cpm_clk; |
| 542 | bd->bi_brgfreq = gd->brg_clk; |
| 543 | bd->bi_sccfreq = gd->scc_clk; |
| 544 | bd->bi_vco = gd->vco_out; |
Jon Loeliger | 9c4c5ae | 2005-07-23 10:37:35 -0500 | [diff] [blame] | 545 | #endif /* CONFIG_CPM2 */ |
wdenk | cbd8a35 | 2004-02-24 02:00:03 +0000 | [diff] [blame] | 546 | #if defined(CONFIG_MPC5xxx) |
wdenk | 945af8d | 2003-07-16 21:53:01 +0000 | [diff] [blame] | 547 | bd->bi_ipbfreq = gd->ipb_clk; |
| 548 | bd->bi_pcifreq = gd->pci_clk; |
wdenk | cbd8a35 | 2004-02-24 02:00:03 +0000 | [diff] [blame] | 549 | #endif /* CONFIG_MPC5xxx */ |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 550 | bd->bi_baudrate = gd->baudrate; /* Console Baudrate */ |
| 551 | |
| 552 | #ifdef CFG_EXTBDINFO |
Wolfgang Denk | 77ddac9 | 2005-10-13 16:45:02 +0200 | [diff] [blame] | 553 | strncpy ((char *)bd->bi_s_version, "1.2", sizeof (bd->bi_s_version)); |
| 554 | strncpy ((char *)bd->bi_r_version, U_BOOT_VERSION, sizeof (bd->bi_r_version)); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 555 | |
| 556 | bd->bi_procfreq = gd->cpu_clk; /* Processor Speed, In Hz */ |
| 557 | bd->bi_plb_busfreq = gd->bus_clk; |
Stefan Roese | 846b0dd | 2005-08-08 12:42:22 +0200 | [diff] [blame] | 558 | #if defined(CONFIG_405GP) || defined(CONFIG_405EP) || defined(CONFIG_440EP) || defined(CONFIG_440GR) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 559 | bd->bi_pci_busfreq = get_PCI_freq (); |
wdenk | 109c0e3 | 2004-03-23 21:43:07 +0000 | [diff] [blame] | 560 | bd->bi_opbfreq = get_OPB_freq (); |
wdenk | 028ab6b | 2004-02-23 23:54:43 +0000 | [diff] [blame] | 561 | #elif defined(CONFIG_XILINX_ML300) |
| 562 | bd->bi_pci_busfreq = get_PCI_freq (); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 563 | #endif |
| 564 | #endif |
| 565 | |
wdenk | 9d2b18a | 2003-06-28 23:11:04 +0000 | [diff] [blame] | 566 | debug ("New Stack Pointer is: %08lx\n", addr_sp); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 567 | |
| 568 | WATCHDOG_RESET (); |
| 569 | |
| 570 | #ifdef CONFIG_POST |
| 571 | post_bootmode_init(); |
wdenk | 6dff552 | 2003-07-15 07:45:49 +0000 | [diff] [blame] | 572 | post_run (NULL, POST_ROM | post_bootmode_get(0)); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 573 | #endif |
| 574 | |
| 575 | WATCHDOG_RESET(); |
| 576 | |
wdenk | 27b207f | 2003-07-24 23:38:38 +0000 | [diff] [blame] | 577 | memcpy (id, (void *)gd, sizeof (gd_t)); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 578 | |
| 579 | relocate_code (addr_sp, id, addr); |
| 580 | |
| 581 | /* NOTREACHED - relocate_code() does not return */ |
| 582 | } |
| 583 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 584 | /************************************************************************ |
| 585 | * |
| 586 | * This is the next part if the initialization sequence: we are now |
| 587 | * running from RAM and have a "normal" C environment, i. e. global |
| 588 | * data can be written, BSS has been cleared, the stack size in not |
| 589 | * that critical any more, etc. |
| 590 | * |
| 591 | ************************************************************************ |
| 592 | */ |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 593 | void board_init_r (gd_t *id, ulong dest_addr) |
| 594 | { |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 595 | cmd_tbl_t *cmdtp; |
| 596 | char *s, *e; |
| 597 | bd_t *bd; |
| 598 | int i; |
| 599 | extern void malloc_bin_reloc (void); |
| 600 | #ifndef CFG_ENV_IS_NOWHERE |
| 601 | extern char * env_name_spec; |
| 602 | #endif |
| 603 | |
| 604 | #ifndef CFG_NO_FLASH |
| 605 | ulong flash_size; |
| 606 | #endif |
| 607 | |
| 608 | gd = id; /* initialize RAM version of global data */ |
| 609 | bd = gd->bd; |
| 610 | |
| 611 | gd->flags |= GD_FLG_RELOC; /* tell others: relocation done */ |
| 612 | |
wdenk | 9d2b18a | 2003-06-28 23:11:04 +0000 | [diff] [blame] | 613 | debug ("Now running in RAM - U-Boot at: %08lx\n", dest_addr); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 614 | |
| 615 | WATCHDOG_RESET (); |
| 616 | |
wdenk | c837dcb | 2004-01-20 23:12:12 +0000 | [diff] [blame] | 617 | #if defined(CONFIG_BOARD_EARLY_INIT_R) |
| 618 | board_early_init_r (); |
| 619 | #endif |
| 620 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 621 | gd->reloc_off = dest_addr - CFG_MONITOR_BASE; |
wdenk | 8bde7f7 | 2003-06-27 21:31:46 +0000 | [diff] [blame] | 622 | |
wdenk | 3b57fe0 | 2003-05-30 12:48:29 +0000 | [diff] [blame] | 623 | monitor_flash_len = (ulong)&__init_end - dest_addr; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 624 | |
wdenk | 281e00a | 2004-08-01 22:48:16 +0000 | [diff] [blame] | 625 | #ifdef CONFIG_SERIAL_MULTI |
| 626 | serial_initialize(); |
| 627 | #endif |
| 628 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 629 | /* |
| 630 | * We have to relocate the command table manually |
| 631 | */ |
wdenk | 8bde7f7 | 2003-06-27 21:31:46 +0000 | [diff] [blame] | 632 | for (cmdtp = &__u_boot_cmd_start; cmdtp != &__u_boot_cmd_end; cmdtp++) { |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 633 | ulong addr; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 634 | addr = (ulong) (cmdtp->cmd) + gd->reloc_off; |
| 635 | #if 0 |
| 636 | printf ("Command \"%s\": 0x%08lx => 0x%08lx\n", |
| 637 | cmdtp->name, (ulong) (cmdtp->cmd), addr); |
| 638 | #endif |
| 639 | cmdtp->cmd = |
| 640 | (int (*)(struct cmd_tbl_s *, int, int, char *[]))addr; |
| 641 | |
| 642 | addr = (ulong)(cmdtp->name) + gd->reloc_off; |
| 643 | cmdtp->name = (char *)addr; |
| 644 | |
| 645 | if (cmdtp->usage) { |
| 646 | addr = (ulong)(cmdtp->usage) + gd->reloc_off; |
| 647 | cmdtp->usage = (char *)addr; |
| 648 | } |
| 649 | #ifdef CFG_LONGHELP |
| 650 | if (cmdtp->help) { |
| 651 | addr = (ulong)(cmdtp->help) + gd->reloc_off; |
| 652 | cmdtp->help = (char *)addr; |
| 653 | } |
| 654 | #endif |
| 655 | } |
| 656 | /* there are some other pointer constants we must deal with */ |
| 657 | #ifndef CFG_ENV_IS_NOWHERE |
| 658 | env_name_spec += gd->reloc_off; |
| 659 | #endif |
| 660 | |
| 661 | WATCHDOG_RESET (); |
| 662 | |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 663 | #ifdef CONFIG_LOGBUFFER |
wdenk | 228f29a | 2002-12-08 09:53:23 +0000 | [diff] [blame] | 664 | logbuff_init_ptrs (); |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 665 | #endif |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 666 | #ifdef CONFIG_POST |
wdenk | 228f29a | 2002-12-08 09:53:23 +0000 | [diff] [blame] | 667 | post_output_backlog (); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 668 | post_reloc (); |
| 669 | #endif |
| 670 | |
| 671 | WATCHDOG_RESET(); |
| 672 | |
Kumar Gala | 2688e2f | 2006-02-10 15:40:06 -0600 | [diff] [blame^] | 673 | #if defined(CONFIG_IP860) || defined(CONFIG_PCU_E) || \ |
| 674 | defined (CONFIG_FLAGADM) || defined(CONFIG_MPC83XX) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 675 | icache_enable (); /* it's time to enable the instruction cache */ |
| 676 | #endif |
| 677 | |
wdenk | 42d1f03 | 2003-10-15 23:53:47 +0000 | [diff] [blame] | 678 | #if defined(CFG_INIT_RAM_LOCK) && defined(CONFIG_E500) |
wdenk | c837dcb | 2004-01-20 23:12:12 +0000 | [diff] [blame] | 679 | unlock_ram_in_cache(); /* it's time to unlock D-cache in e500 */ |
wdenk | 42d1f03 | 2003-10-15 23:53:47 +0000 | [diff] [blame] | 680 | #endif |
| 681 | |
wdenk | 3bac351 | 2003-03-12 10:41:04 +0000 | [diff] [blame] | 682 | #if defined(CONFIG_BAB7xx) || defined(CONFIG_CPC45) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 683 | /* |
wdenk | 3bac351 | 2003-03-12 10:41:04 +0000 | [diff] [blame] | 684 | * Do PCI configuration on BAB7xx and CPC45 _before_ the flash |
| 685 | * gets initialised, because we need the ISA resp. PCI_to_LOCAL bus |
| 686 | * bridge there. |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 687 | */ |
| 688 | pci_init (); |
wdenk | 3bac351 | 2003-03-12 10:41:04 +0000 | [diff] [blame] | 689 | #endif |
| 690 | #if defined(CONFIG_BAB7xx) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 691 | /* |
| 692 | * Initialise the ISA bridge |
| 693 | */ |
| 694 | initialise_w83c553f (); |
| 695 | #endif |
| 696 | |
| 697 | asm ("sync ; isync"); |
| 698 | |
| 699 | /* |
| 700 | * Setup trap handlers |
| 701 | */ |
| 702 | trap_init (dest_addr); |
| 703 | |
| 704 | #if !defined(CFG_NO_FLASH) |
| 705 | puts ("FLASH: "); |
| 706 | |
| 707 | if ((flash_size = flash_init ()) > 0) { |
wdenk | 0cb61d7 | 2003-08-30 00:05:50 +0000 | [diff] [blame] | 708 | # ifdef CFG_FLASH_CHECKSUM |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 709 | print_size (flash_size, ""); |
| 710 | /* |
| 711 | * Compute and print flash CRC if flashchecksum is set to 'y' |
| 712 | * |
| 713 | * NOTE: Maybe we should add some WATCHDOG_RESET()? XXX |
| 714 | */ |
| 715 | s = getenv ("flashchecksum"); |
| 716 | if (s && (*s == 'y')) { |
| 717 | printf (" CRC: %08lX", |
wdenk | 7e78036 | 2004-04-08 22:31:29 +0000 | [diff] [blame] | 718 | crc32 (0, (const unsigned char *) CFG_FLASH_BASE, flash_size) |
| 719 | ); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 720 | } |
| 721 | putc ('\n'); |
wdenk | 0cb61d7 | 2003-08-30 00:05:50 +0000 | [diff] [blame] | 722 | # else /* !CFG_FLASH_CHECKSUM */ |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 723 | print_size (flash_size, "\n"); |
wdenk | 0cb61d7 | 2003-08-30 00:05:50 +0000 | [diff] [blame] | 724 | # endif /* CFG_FLASH_CHECKSUM */ |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 725 | } else { |
| 726 | puts (failed); |
| 727 | hang (); |
| 728 | } |
| 729 | |
| 730 | bd->bi_flashstart = CFG_FLASH_BASE; /* update start of FLASH memory */ |
| 731 | bd->bi_flashsize = flash_size; /* size of FLASH memory (final value) */ |
wdenk | 7e78036 | 2004-04-08 22:31:29 +0000 | [diff] [blame] | 732 | # if defined(CONFIG_PCU_E) || defined(CONFIG_OXC) || defined(CONFIG_RMU) |
| 733 | /* flash mapped at end of memory map */ |
| 734 | bd->bi_flashoffset = TEXT_BASE + flash_size; |
wdenk | 0cb61d7 | 2003-08-30 00:05:50 +0000 | [diff] [blame] | 735 | # elif CFG_MONITOR_BASE == CFG_FLASH_BASE |
wdenk | 3b57fe0 | 2003-05-30 12:48:29 +0000 | [diff] [blame] | 736 | bd->bi_flashoffset = monitor_flash_len; /* reserved area for startup monitor */ |
wdenk | 0cb61d7 | 2003-08-30 00:05:50 +0000 | [diff] [blame] | 737 | # else |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 738 | bd->bi_flashoffset = 0; |
wdenk | 0cb61d7 | 2003-08-30 00:05:50 +0000 | [diff] [blame] | 739 | # endif |
| 740 | #else /* CFG_NO_FLASH */ |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 741 | |
| 742 | bd->bi_flashsize = 0; |
| 743 | bd->bi_flashstart = 0; |
| 744 | bd->bi_flashoffset = 0; |
| 745 | #endif /* !CFG_NO_FLASH */ |
| 746 | |
| 747 | WATCHDOG_RESET (); |
| 748 | |
| 749 | /* initialize higher level parts of CPU like time base and timers */ |
| 750 | cpu_init_r (); |
| 751 | |
| 752 | WATCHDOG_RESET (); |
| 753 | |
| 754 | /* initialize malloc() area */ |
| 755 | mem_malloc_init (); |
| 756 | malloc_bin_reloc (); |
| 757 | |
| 758 | #ifdef CONFIG_SPI |
| 759 | # if !defined(CFG_ENV_IS_IN_EEPROM) |
| 760 | spi_init_f (); |
| 761 | # endif |
| 762 | spi_init_r (); |
| 763 | #endif |
| 764 | |
| 765 | /* relocate environment function pointers etc. */ |
| 766 | env_relocate (); |
| 767 | |
| 768 | /* |
| 769 | * Fill in missing fields of bd_info. |
wdenk | 8bde7f7 | 2003-06-27 21:31:46 +0000 | [diff] [blame] | 770 | * We do this here, where we have "normal" access to the |
| 771 | * environment; we used to do this still running from ROM, |
| 772 | * where had to use getenv_r(), which can be pretty slow when |
| 773 | * the environment is in EEPROM. |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 774 | */ |
wdenk | 7abf0c5 | 2004-04-18 21:45:42 +0000 | [diff] [blame] | 775 | |
| 776 | #if defined(CFG_EXTBDINFO) |
| 777 | #if defined(CONFIG_405GP) || defined(CONFIG_405EP) |
| 778 | #if defined(CONFIG_I2CFAST) |
| 779 | /* |
| 780 | * set bi_iic_fast for linux taking environment variable |
| 781 | * "i2cfast" into account |
| 782 | */ |
| 783 | { |
| 784 | char *s = getenv ("i2cfast"); |
| 785 | if (s && ((*s == 'y') || (*s == 'Y'))) { |
| 786 | bd->bi_iic_fast[0] = 1; |
| 787 | bd->bi_iic_fast[1] = 1; |
| 788 | } else { |
| 789 | bd->bi_iic_fast[0] = 0; |
| 790 | bd->bi_iic_fast[1] = 0; |
| 791 | } |
| 792 | } |
| 793 | #else |
| 794 | bd->bi_iic_fast[0] = 0; |
| 795 | bd->bi_iic_fast[1] = 0; |
| 796 | #endif /* CONFIG_I2CFAST */ |
| 797 | #endif /* CONFIG_405GP, CONFIG_405EP */ |
| 798 | #endif /* CFG_EXTBDINFO */ |
| 799 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 800 | s = getenv ("ethaddr"); |
| 801 | #if defined (CONFIG_MBX) || defined (CONFIG_RPXCLASSIC) || defined(CONFIG_IAD210) |
| 802 | if (s == NULL) |
| 803 | board_get_enetaddr (bd->bi_enetaddr); |
| 804 | else |
| 805 | #endif |
| 806 | for (i = 0; i < 6; ++i) { |
| 807 | bd->bi_enetaddr[i] = s ? simple_strtoul (s, &e, 16) : 0; |
| 808 | if (s) |
| 809 | s = (*e) ? e + 1 : e; |
| 810 | } |
| 811 | #ifdef CONFIG_HERMES |
| 812 | if ((gd->board_type >> 16) == 2) |
| 813 | bd->bi_ethspeed = gd->board_type & 0xFFFF; |
| 814 | else |
| 815 | bd->bi_ethspeed = 0xFFFF; |
| 816 | #endif |
| 817 | |
| 818 | #ifdef CONFIG_NX823 |
| 819 | load_sernum_ethaddr (); |
| 820 | #endif |
| 821 | |
wdenk | e2ffd59 | 2004-12-31 09:32:47 +0000 | [diff] [blame] | 822 | #ifdef CONFIG_HAS_ETH1 |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 823 | /* handle the 2nd ethernet address */ |
| 824 | |
| 825 | s = getenv ("eth1addr"); |
| 826 | |
| 827 | for (i = 0; i < 6; ++i) { |
| 828 | bd->bi_enet1addr[i] = s ? simple_strtoul (s, &e, 16) : 0; |
| 829 | if (s) |
| 830 | s = (*e) ? e + 1 : e; |
| 831 | } |
| 832 | #endif |
wdenk | e2ffd59 | 2004-12-31 09:32:47 +0000 | [diff] [blame] | 833 | #ifdef CONFIG_HAS_ETH2 |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 834 | /* handle the 3rd ethernet address */ |
| 835 | |
| 836 | s = getenv ("eth2addr"); |
Stefan Roese | b79316f | 2005-08-15 12:31:23 +0200 | [diff] [blame] | 837 | #if defined(CONFIG_XPEDITE1K) || defined(CONFIG_METROBOX) || defined(CONFIG_KAREF) |
wdenk | ba56f62 | 2004-02-06 23:19:44 +0000 | [diff] [blame] | 838 | if (s == NULL) |
| 839 | board_get_enetaddr(bd->bi_enet2addr); |
| 840 | else |
| 841 | #endif |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 842 | for (i = 0; i < 6; ++i) { |
| 843 | bd->bi_enet2addr[i] = s ? simple_strtoul (s, &e, 16) : 0; |
| 844 | if (s) |
| 845 | s = (*e) ? e + 1 : e; |
| 846 | } |
| 847 | #endif |
| 848 | |
wdenk | e2ffd59 | 2004-12-31 09:32:47 +0000 | [diff] [blame] | 849 | #ifdef CONFIG_HAS_ETH3 |
wdenk | ba56f62 | 2004-02-06 23:19:44 +0000 | [diff] [blame] | 850 | /* handle 4th ethernet address */ |
| 851 | s = getenv("eth3addr"); |
Stefan Roese | b79316f | 2005-08-15 12:31:23 +0200 | [diff] [blame] | 852 | #if defined(CONFIG_XPEDITE1K) || defined(CONFIG_METROBOX) || defined(CONFIG_KAREF) |
wdenk | ba56f62 | 2004-02-06 23:19:44 +0000 | [diff] [blame] | 853 | if (s == NULL) |
| 854 | board_get_enetaddr(bd->bi_enet3addr); |
| 855 | else |
| 856 | #endif |
| 857 | for (i = 0; i < 6; ++i) { |
| 858 | bd->bi_enet3addr[i] = s ? simple_strtoul (s, &e, 16) : 0; |
| 859 | if (s) |
| 860 | s = (*e) ? e + 1 : e; |
| 861 | } |
| 862 | #endif |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 863 | |
| 864 | #if defined(CONFIG_TQM8xxL) || defined(CONFIG_TQM8260) || \ |
wdenk | 02b11f8 | 2004-05-12 22:54:36 +0000 | [diff] [blame] | 865 | defined(CONFIG_CCM) || defined(CONFIG_KUP4K) || defined(CONFIG_KUP4X) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 866 | load_sernum_ethaddr (); |
| 867 | #endif |
| 868 | /* IP Address */ |
| 869 | bd->bi_ip_addr = getenv_IPaddr ("ipaddr"); |
| 870 | |
| 871 | WATCHDOG_RESET (); |
| 872 | |
wdenk | 979bdbc | 2004-06-01 21:08:17 +0000 | [diff] [blame] | 873 | #if defined(CONFIG_PCI) && !defined(CONFIG_BAB7xx) && !defined(CONFIG_CPC45) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 874 | /* |
| 875 | * Do pci configuration |
| 876 | */ |
| 877 | pci_init (); |
| 878 | #endif |
| 879 | |
| 880 | /** leave this here (after malloc(), environment and PCI are working) **/ |
| 881 | /* Initialize devices */ |
| 882 | devices_init (); |
| 883 | |
wdenk | 27b207f | 2003-07-24 23:38:38 +0000 | [diff] [blame] | 884 | /* Initialize the jump table for applications */ |
| 885 | jumptable_init (); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 886 | |
| 887 | /* Initialize the console (after the relocation and devices init) */ |
| 888 | console_init_r (); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 889 | |
| 890 | #if defined(CONFIG_CCM) || \ |
| 891 | defined(CONFIG_COGENT) || \ |
| 892 | defined(CONFIG_CPCI405) || \ |
| 893 | defined(CONFIG_EVB64260) || \ |
wdenk | 56f94be | 2002-11-05 16:35:14 +0000 | [diff] [blame] | 894 | defined(CONFIG_KUP4K) || \ |
wdenk | 0608e04 | 2004-03-25 19:29:38 +0000 | [diff] [blame] | 895 | defined(CONFIG_KUP4X) || \ |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 896 | defined(CONFIG_LWMON) || \ |
| 897 | defined(CONFIG_PCU_E) || \ |
| 898 | defined(CONFIG_W7O) || \ |
| 899 | defined(CONFIG_MISC_INIT_R) |
| 900 | /* miscellaneous platform dependent initialisations */ |
| 901 | misc_init_r (); |
| 902 | #endif |
| 903 | |
| 904 | #ifdef CONFIG_HERMES |
| 905 | if (bd->bi_ethspeed != 0xFFFF) |
| 906 | hermes_start_lxt980 ((int) bd->bi_ethspeed); |
| 907 | #endif |
| 908 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 909 | #if (CONFIG_COMMANDS & CFG_CMD_KGDB) |
| 910 | WATCHDOG_RESET (); |
| 911 | puts ("KGDB: "); |
| 912 | kgdb_init (); |
| 913 | #endif |
| 914 | |
wdenk | 9d2b18a | 2003-06-28 23:11:04 +0000 | [diff] [blame] | 915 | debug ("U-Boot relocated to %08lx\n", dest_addr); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 916 | |
| 917 | /* |
| 918 | * Enable Interrupts |
| 919 | */ |
| 920 | interrupt_init (); |
| 921 | |
| 922 | /* Must happen after interrupts are initialized since |
| 923 | * an irq handler gets installed |
| 924 | */ |
wdenk | 42dfe7a | 2004-03-14 22:25:36 +0000 | [diff] [blame] | 925 | #ifdef CONFIG_SERIAL_SOFTWARE_FIFO |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 926 | serial_buffered_init(); |
| 927 | #endif |
| 928 | |
| 929 | #ifdef CONFIG_STATUS_LED |
| 930 | status_led_set (STATUS_LED_BOOT, STATUS_LED_BLINKING); |
| 931 | #endif |
| 932 | |
| 933 | udelay (20); |
| 934 | |
| 935 | set_timer (0); |
| 936 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 937 | /* Initialize from environment */ |
| 938 | if ((s = getenv ("loadaddr")) != NULL) { |
| 939 | load_addr = simple_strtoul (s, NULL, 16); |
| 940 | } |
| 941 | #if (CONFIG_COMMANDS & CFG_CMD_NET) |
| 942 | if ((s = getenv ("bootfile")) != NULL) { |
| 943 | copy_filename (BootFile, s, sizeof (BootFile)); |
| 944 | } |
| 945 | #endif /* CFG_CMD_NET */ |
| 946 | |
| 947 | WATCHDOG_RESET (); |
| 948 | |
| 949 | #if (CONFIG_COMMANDS & CFG_CMD_SCSI) |
| 950 | WATCHDOG_RESET (); |
| 951 | puts ("SCSI: "); |
| 952 | scsi_init (); |
| 953 | #endif |
| 954 | |
| 955 | #if (CONFIG_COMMANDS & CFG_CMD_DOC) |
| 956 | WATCHDOG_RESET (); |
| 957 | puts ("DOC: "); |
| 958 | doc_init (); |
| 959 | #endif |
| 960 | |
stroese | bedc497 | 2003-05-23 11:16:49 +0000 | [diff] [blame] | 961 | #if (CONFIG_COMMANDS & CFG_CMD_NAND) |
| 962 | WATCHDOG_RESET (); |
stroese | b7eaad8 | 2004-12-16 17:53:17 +0000 | [diff] [blame] | 963 | puts ("NAND: "); |
stroese | bedc497 | 2003-05-23 11:16:49 +0000 | [diff] [blame] | 964 | nand_init(); /* go init the NAND */ |
| 965 | #endif |
| 966 | |
Marian Balakowicz | 63ff004 | 2005-10-28 22:30:33 +0200 | [diff] [blame] | 967 | #if (CONFIG_COMMANDS & CFG_CMD_NET) |
| 968 | #if defined(CONFIG_NET_MULTI) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 969 | WATCHDOG_RESET (); |
| 970 | puts ("Net: "); |
Marian Balakowicz | 63ff004 | 2005-10-28 22:30:33 +0200 | [diff] [blame] | 971 | #endif |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 972 | eth_initialize (bd); |
| 973 | #endif |
| 974 | |
Marian Balakowicz | 63ff004 | 2005-10-28 22:30:33 +0200 | [diff] [blame] | 975 | #if (CONFIG_COMMANDS & CFG_CMD_NET) && ( \ |
| 976 | defined(CONFIG_CCM) || \ |
| 977 | defined(CONFIG_ELPT860) || \ |
| 978 | defined(CONFIG_EP8260) || \ |
| 979 | defined(CONFIG_IP860) || \ |
| 980 | defined(CONFIG_IVML24) || \ |
| 981 | defined(CONFIG_IVMS8) || \ |
| 982 | defined(CONFIG_MPC8260ADS) || \ |
| 983 | defined(CONFIG_MPC8266ADS) || \ |
| 984 | defined(CONFIG_MPC8560ADS) || \ |
| 985 | defined(CONFIG_PCU_E) || \ |
| 986 | defined(CONFIG_RPXSUPER) || \ |
| 987 | defined(CONFIG_STXGP3) || \ |
| 988 | defined(CONFIG_SPD823TS) || \ |
| 989 | defined(CONFIG_RESET_PHY_R) ) |
| 990 | |
| 991 | WATCHDOG_RESET (); |
| 992 | debug ("Reset Ethernet PHY\n"); |
| 993 | reset_phy (); |
| 994 | #endif |
| 995 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 996 | #ifdef CONFIG_POST |
wdenk | 6dff552 | 2003-07-15 07:45:49 +0000 | [diff] [blame] | 997 | post_run (NULL, POST_RAM | post_bootmode_get(0)); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 998 | #endif |
| 999 | |
| 1000 | #if (CONFIG_COMMANDS & CFG_CMD_PCMCIA) && !(CONFIG_COMMANDS & CFG_CMD_IDE) |
| 1001 | WATCHDOG_RESET (); |
| 1002 | puts ("PCMCIA:"); |
| 1003 | pcmcia_init (); |
| 1004 | #endif |
| 1005 | |
| 1006 | #if (CONFIG_COMMANDS & CFG_CMD_IDE) |
| 1007 | WATCHDOG_RESET (); |
| 1008 | # ifdef CONFIG_IDE_8xx_PCCARD |
| 1009 | puts ("PCMCIA:"); |
| 1010 | # else |
| 1011 | puts ("IDE: "); |
| 1012 | #endif |
| 1013 | ide_init (); |
| 1014 | #endif /* CFG_CMD_IDE */ |
| 1015 | |
| 1016 | #ifdef CONFIG_LAST_STAGE_INIT |
| 1017 | WATCHDOG_RESET (); |
| 1018 | /* |
| 1019 | * Some parts can be only initialized if all others (like |
| 1020 | * Interrupts) are up and running (i.e. the PC-style ISA |
| 1021 | * keyboard). |
| 1022 | */ |
| 1023 | last_stage_init (); |
| 1024 | #endif |
| 1025 | |
| 1026 | #if (CONFIG_COMMANDS & CFG_CMD_BEDBUG) |
| 1027 | WATCHDOG_RESET (); |
| 1028 | bedbug_init (); |
| 1029 | #endif |
| 1030 | |
wdenk | 228f29a | 2002-12-08 09:53:23 +0000 | [diff] [blame] | 1031 | #if defined(CONFIG_PRAM) || defined(CONFIG_LOGBUFFER) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 1032 | /* |
| 1033 | * Export available size of memory for Linux, |
| 1034 | * taking into account the protected RAM at top of memory |
| 1035 | */ |
| 1036 | { |
| 1037 | ulong pram; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 1038 | uchar memsz[32]; |
wdenk | 228f29a | 2002-12-08 09:53:23 +0000 | [diff] [blame] | 1039 | #ifdef CONFIG_PRAM |
| 1040 | char *s; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 1041 | |
| 1042 | if ((s = getenv ("pram")) != NULL) { |
| 1043 | pram = simple_strtoul (s, NULL, 10); |
| 1044 | } else { |
| 1045 | pram = CONFIG_PRAM; |
| 1046 | } |
wdenk | 228f29a | 2002-12-08 09:53:23 +0000 | [diff] [blame] | 1047 | #else |
| 1048 | pram=0; |
| 1049 | #endif |
| 1050 | #ifdef CONFIG_LOGBUFFER |
| 1051 | /* Also take the logbuffer into account (pram is in kB) */ |
| 1052 | pram += (LOGBUFF_LEN+LOGBUFF_OVERHEAD)/1024; |
| 1053 | #endif |
Wolfgang Denk | 77ddac9 | 2005-10-13 16:45:02 +0200 | [diff] [blame] | 1054 | sprintf ((char *)memsz, "%ldk", (bd->bi_memsize / 1024) - pram); |
| 1055 | setenv ("mem", (char *)memsz); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 1056 | } |
| 1057 | #endif |
| 1058 | |
wdenk | 1c43771 | 2004-01-16 00:30:56 +0000 | [diff] [blame] | 1059 | #ifdef CONFIG_PS2KBD |
| 1060 | puts ("PS/2: "); |
| 1061 | kbd_init(); |
| 1062 | #endif |
| 1063 | |
wdenk | 4532cb6 | 2003-04-27 22:52:51 +0000 | [diff] [blame] | 1064 | #ifdef CONFIG_MODEM_SUPPORT |
| 1065 | { |
| 1066 | extern int do_mdm_init; |
| 1067 | do_mdm_init = gd->do_mdm_init; |
| 1068 | } |
| 1069 | #endif |
| 1070 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 1071 | /* Initialization complete - start the monitor */ |
| 1072 | |
| 1073 | /* main_loop() can return to retry autoboot, if so just run it again. */ |
| 1074 | for (;;) { |
| 1075 | WATCHDOG_RESET (); |
| 1076 | main_loop (); |
| 1077 | } |
| 1078 | |
| 1079 | /* NOTREACHED - no way out of command loop except booting */ |
| 1080 | } |
| 1081 | |
| 1082 | void hang (void) |
| 1083 | { |
| 1084 | puts ("### ERROR ### Please RESET the board ###\n"); |
wdenk | 63e73c9 | 2004-02-23 22:22:28 +0000 | [diff] [blame] | 1085 | #ifdef CONFIG_SHOW_BOOT_PROGRESS |
| 1086 | show_boot_progress(-30); |
| 1087 | #endif |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 1088 | for (;;); |
| 1089 | } |
| 1090 | |
wdenk | 4532cb6 | 2003-04-27 22:52:51 +0000 | [diff] [blame] | 1091 | #ifdef CONFIG_MODEM_SUPPORT |
| 1092 | /* called from main loop (common/main.c) */ |
Wolfgang Denk | 77ddac9 | 2005-10-13 16:45:02 +0200 | [diff] [blame] | 1093 | /* 'inline' - We have to do it fast */ |
| 1094 | static inline void mdm_readline(char *buf, int bufsiz) |
| 1095 | { |
| 1096 | char c; |
| 1097 | char *p; |
| 1098 | int n; |
| 1099 | |
| 1100 | n = 0; |
| 1101 | p = buf; |
| 1102 | for(;;) { |
| 1103 | c = serial_getc(); |
| 1104 | |
| 1105 | /* dbg("(%c)", c); */ |
| 1106 | |
| 1107 | switch(c) { |
| 1108 | case '\r': |
| 1109 | break; |
| 1110 | case '\n': |
| 1111 | *p = '\0'; |
| 1112 | return; |
| 1113 | |
| 1114 | default: |
| 1115 | if(n++ > bufsiz) { |
| 1116 | *p = '\0'; |
| 1117 | return; /* sanity check */ |
| 1118 | } |
| 1119 | *p = c; |
| 1120 | p++; |
| 1121 | break; |
| 1122 | } |
| 1123 | } |
| 1124 | } |
| 1125 | |
wdenk | 4532cb6 | 2003-04-27 22:52:51 +0000 | [diff] [blame] | 1126 | extern void dbg(const char *fmt, ...); |
| 1127 | int mdm_init (void) |
| 1128 | { |
| 1129 | char env_str[16]; |
| 1130 | char *init_str; |
| 1131 | int i; |
| 1132 | extern char console_buffer[]; |
wdenk | 4532cb6 | 2003-04-27 22:52:51 +0000 | [diff] [blame] | 1133 | extern void enable_putc(void); |
| 1134 | extern int hwflow_onoff(int); |
| 1135 | |
| 1136 | enable_putc(); /* enable serial_putc() */ |
| 1137 | |
| 1138 | #ifdef CONFIG_HWFLOW |
| 1139 | init_str = getenv("mdm_flow_control"); |
| 1140 | if (init_str && (strcmp(init_str, "rts/cts") == 0)) |
| 1141 | hwflow_onoff (1); |
| 1142 | else |
| 1143 | hwflow_onoff(-1); |
| 1144 | #endif |
| 1145 | |
| 1146 | for (i = 1;;i++) { |
| 1147 | sprintf(env_str, "mdm_init%d", i); |
| 1148 | if ((init_str = getenv(env_str)) != NULL) { |
| 1149 | serial_puts(init_str); |
| 1150 | serial_puts("\n"); |
| 1151 | for(;;) { |
| 1152 | mdm_readline(console_buffer, CFG_CBSIZE); |
| 1153 | dbg("ini%d: [%s]", i, console_buffer); |
| 1154 | |
| 1155 | if ((strcmp(console_buffer, "OK") == 0) || |
| 1156 | (strcmp(console_buffer, "ERROR") == 0)) { |
| 1157 | dbg("ini%d: cmd done", i); |
| 1158 | break; |
| 1159 | } else /* in case we are originating call ... */ |
| 1160 | if (strncmp(console_buffer, "CONNECT", 7) == 0) { |
| 1161 | dbg("ini%d: connect", i); |
| 1162 | return 0; |
| 1163 | } |
| 1164 | } |
| 1165 | } else |
| 1166 | break; /* no init string - stop modem init */ |
| 1167 | |
| 1168 | udelay(100000); |
| 1169 | } |
| 1170 | |
| 1171 | udelay(100000); |
| 1172 | |
| 1173 | /* final stage - wait for connect */ |
| 1174 | for(;i > 1;) { /* if 'i' > 1 - wait for connection |
| 1175 | message from modem */ |
| 1176 | mdm_readline(console_buffer, CFG_CBSIZE); |
| 1177 | dbg("ini_f: [%s]", console_buffer); |
| 1178 | if (strncmp(console_buffer, "CONNECT", 7) == 0) { |
| 1179 | dbg("ini_f: connected"); |
| 1180 | return 0; |
| 1181 | } |
| 1182 | } |
| 1183 | |
| 1184 | return 0; |
| 1185 | } |
| 1186 | |
wdenk | 4532cb6 | 2003-04-27 22:52:51 +0000 | [diff] [blame] | 1187 | #endif |
| 1188 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 1189 | #if 0 /* We could use plain global data, but the resulting code is bigger */ |
| 1190 | /* |
| 1191 | * Pointer to initial global data area |
| 1192 | * |
| 1193 | * Here we initialize it. |
| 1194 | */ |
| 1195 | #undef XTRN_DECLARE_GLOBAL_DATA_PTR |
| 1196 | #define XTRN_DECLARE_GLOBAL_DATA_PTR /* empty = allocate here */ |
| 1197 | DECLARE_GLOBAL_DATA_PTR = (gd_t *) (CFG_INIT_RAM_ADDR + CFG_GBL_DATA_OFFSET); |
| 1198 | #endif /* 0 */ |
| 1199 | |
| 1200 | /************************************************************************/ |