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