Merge git://git.denx.de/u-boot-socfpga
[platform/kernel/u-boot.git] / common / board_f.c
1 /*
2  * Copyright (c) 2011 The Chromium OS Authors.
3  * (C) Copyright 2002-2006
4  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
5  *
6  * (C) Copyright 2002
7  * Sysgo Real-Time Solutions, GmbH <www.elinos.com>
8  * Marius Groeger <mgroeger@sysgo.de>
9  *
10  * SPDX-License-Identifier:     GPL-2.0+
11  */
12
13 #include <common.h>
14 #include <linux/compiler.h>
15 #include <version.h>
16 #include <environment.h>
17 #include <dm.h>
18 #include <fdtdec.h>
19 #include <fs.h>
20 #if defined(CONFIG_CMD_IDE)
21 #include <ide.h>
22 #endif
23 #include <i2c.h>
24 #include <initcall.h>
25 #include <logbuff.h>
26
27 /* TODO: Can we move these into arch/ headers? */
28 #ifdef CONFIG_8xx
29 #include <mpc8xx.h>
30 #endif
31 #ifdef CONFIG_5xx
32 #include <mpc5xx.h>
33 #endif
34 #ifdef CONFIG_MPC5xxx
35 #include <mpc5xxx.h>
36 #endif
37 #if defined(CONFIG_MP) && (defined(CONFIG_MPC86xx) || defined(CONFIG_E500))
38 #include <asm/mp.h>
39 #endif
40
41 #include <os.h>
42 #include <post.h>
43 #include <spi.h>
44 #include <status_led.h>
45 #include <trace.h>
46 #include <watchdog.h>
47 #include <asm/errno.h>
48 #include <asm/io.h>
49 #include <asm/sections.h>
50 #ifdef CONFIG_X86
51 #include <asm/init_helpers.h>
52 #include <asm/relocate.h>
53 #endif
54 #ifdef CONFIG_SANDBOX
55 #include <asm/state.h>
56 #endif
57 #include <dm/root.h>
58 #include <linux/compiler.h>
59
60 /*
61  * Pointer to initial global data area
62  *
63  * Here we initialize it if needed.
64  */
65 #ifdef XTRN_DECLARE_GLOBAL_DATA_PTR
66 #undef  XTRN_DECLARE_GLOBAL_DATA_PTR
67 #define XTRN_DECLARE_GLOBAL_DATA_PTR    /* empty = allocate here */
68 DECLARE_GLOBAL_DATA_PTR = (gd_t *) (CONFIG_SYS_INIT_GD_ADDR);
69 #else
70 DECLARE_GLOBAL_DATA_PTR;
71 #endif
72
73 /*
74  * sjg: IMO this code should be
75  * refactored to a single function, something like:
76  *
77  * void led_set_state(enum led_colour_t colour, int on);
78  */
79 /************************************************************************
80  * Coloured LED functionality
81  ************************************************************************
82  * May be supplied by boards if desired
83  */
84 __weak void coloured_LED_init(void) {}
85 __weak void red_led_on(void) {}
86 __weak void red_led_off(void) {}
87 __weak void green_led_on(void) {}
88 __weak void green_led_off(void) {}
89 __weak void yellow_led_on(void) {}
90 __weak void yellow_led_off(void) {}
91 __weak void blue_led_on(void) {}
92 __weak void blue_led_off(void) {}
93
94 /*
95  * Why is gd allocated a register? Prior to reloc it might be better to
96  * just pass it around to each function in this file?
97  *
98  * After reloc one could argue that it is hardly used and doesn't need
99  * to be in a register. Or if it is it should perhaps hold pointers to all
100  * global data for all modules, so that post-reloc we can avoid the massive
101  * literal pool we get on ARM. Or perhaps just encourage each module to use
102  * a structure...
103  */
104
105 /*
106  * Could the CONFIG_SPL_BUILD infection become a flag in gd?
107  */
108
109 #if defined(CONFIG_WATCHDOG) || defined(CONFIG_HW_WATCHDOG)
110 static int init_func_watchdog_init(void)
111 {
112 # if defined(CONFIG_HW_WATCHDOG) && (defined(CONFIG_BLACKFIN) || \
113         defined(CONFIG_M68K) || defined(CONFIG_MICROBLAZE) || \
114         defined(CONFIG_SH) || defined(CONFIG_AT91SAM9_WATCHDOG))
115         hw_watchdog_init();
116 # endif
117         puts("       Watchdog enabled\n");
118         WATCHDOG_RESET();
119
120         return 0;
121 }
122
123 int init_func_watchdog_reset(void)
124 {
125         WATCHDOG_RESET();
126
127         return 0;
128 }
129 #endif /* CONFIG_WATCHDOG */
130
131 __weak void board_add_ram_info(int use_default)
132 {
133         /* please define platform specific board_add_ram_info() */
134 }
135
136 static int init_baud_rate(void)
137 {
138         gd->baudrate = getenv_ulong("baudrate", 10, CONFIG_BAUDRATE);
139         return 0;
140 }
141
142 static int display_text_info(void)
143 {
144 #ifndef CONFIG_SANDBOX
145         ulong bss_start, bss_end, text_base;
146
147         bss_start = (ulong)&__bss_start;
148         bss_end = (ulong)&__bss_end;
149
150 #ifdef CONFIG_SYS_TEXT_BASE
151         text_base = CONFIG_SYS_TEXT_BASE;
152 #else
153         text_base = CONFIG_SYS_MONITOR_BASE;
154 #endif
155
156         debug("U-Boot code: %08lX -> %08lX  BSS: -> %08lX\n",
157                 text_base, bss_start, bss_end);
158 #endif
159
160 #ifdef CONFIG_MODEM_SUPPORT
161         debug("Modem Support enabled\n");
162 #endif
163 #ifdef CONFIG_USE_IRQ
164         debug("IRQ Stack: %08lx\n", IRQ_STACK_START);
165         debug("FIQ Stack: %08lx\n", FIQ_STACK_START);
166 #endif
167
168         return 0;
169 }
170
171 static int announce_dram_init(void)
172 {
173         puts("DRAM:  ");
174         return 0;
175 }
176
177 #if defined(CONFIG_MIPS) || defined(CONFIG_PPC) || defined(CONFIG_M68K)
178 static int init_func_ram(void)
179 {
180 #ifdef  CONFIG_BOARD_TYPES
181         int board_type = gd->board_type;
182 #else
183         int board_type = 0;     /* use dummy arg */
184 #endif
185
186         gd->ram_size = initdram(board_type);
187
188         if (gd->ram_size > 0)
189                 return 0;
190
191         puts("*** failed ***\n");
192         return 1;
193 }
194 #endif
195
196 static int show_dram_config(void)
197 {
198         unsigned long long size;
199
200 #ifdef CONFIG_NR_DRAM_BANKS
201         int i;
202
203         debug("\nRAM Configuration:\n");
204         for (i = size = 0; i < CONFIG_NR_DRAM_BANKS; i++) {
205                 size += gd->bd->bi_dram[i].size;
206                 debug("Bank #%d: %08lx ", i, gd->bd->bi_dram[i].start);
207 #ifdef DEBUG
208                 print_size(gd->bd->bi_dram[i].size, "\n");
209 #endif
210         }
211         debug("\nDRAM:  ");
212 #else
213         size = gd->ram_size;
214 #endif
215
216         print_size(size, "");
217         board_add_ram_info(0);
218         putc('\n');
219
220         return 0;
221 }
222
223 __weak void dram_init_banksize(void)
224 {
225 #if defined(CONFIG_NR_DRAM_BANKS) && defined(CONFIG_SYS_SDRAM_BASE)
226         gd->bd->bi_dram[0].start = CONFIG_SYS_SDRAM_BASE;
227         gd->bd->bi_dram[0].size = get_effective_memsize();
228 #endif
229 }
230
231 #if defined(CONFIG_HARD_I2C) || defined(CONFIG_SYS_I2C)
232 static int init_func_i2c(void)
233 {
234         puts("I2C:   ");
235 #ifdef CONFIG_SYS_I2C
236         i2c_init_all();
237 #else
238         i2c_init(CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE);
239 #endif
240         puts("ready\n");
241         return 0;
242 }
243 #endif
244
245 #if defined(CONFIG_HARD_SPI)
246 static int init_func_spi(void)
247 {
248         puts("SPI:   ");
249         spi_init();
250         puts("ready\n");
251         return 0;
252 }
253 #endif
254
255 __maybe_unused
256 static int zero_global_data(void)
257 {
258         memset((void *)gd, '\0', sizeof(gd_t));
259
260         return 0;
261 }
262
263 static int setup_mon_len(void)
264 {
265 #if defined(__ARM__) || defined(__MICROBLAZE__)
266         gd->mon_len = (ulong)&__bss_end - (ulong)_start;
267 #elif defined(CONFIG_SANDBOX)
268         gd->mon_len = (ulong)&_end - (ulong)_init;
269 #elif defined(CONFIG_BLACKFIN) || defined(CONFIG_NIOS2)
270         gd->mon_len = CONFIG_SYS_MONITOR_LEN;
271 #else
272         /* TODO: use (ulong)&__bss_end - (ulong)&__text_start; ? */
273         gd->mon_len = (ulong)&__bss_end - CONFIG_SYS_MONITOR_BASE;
274 #endif
275         return 0;
276 }
277
278 __weak int arch_cpu_init(void)
279 {
280         return 0;
281 }
282
283 #ifdef CONFIG_OF_HOSTFILE
284
285 static int read_fdt_from_file(void)
286 {
287         struct sandbox_state *state = state_get_current();
288         const char *fname = state->fdt_fname;
289         void *blob;
290         loff_t size;
291         int err;
292         int fd;
293
294         blob = map_sysmem(CONFIG_SYS_FDT_LOAD_ADDR, 0);
295         if (!state->fdt_fname) {
296                 err = fdt_create_empty_tree(blob, 256);
297                 if (!err)
298                         goto done;
299                 printf("Unable to create empty FDT: %s\n", fdt_strerror(err));
300                 return -EINVAL;
301         }
302
303         err = os_get_filesize(fname, &size);
304         if (err < 0) {
305                 printf("Failed to file FDT file '%s'\n", fname);
306                 return err;
307         }
308         fd = os_open(fname, OS_O_RDONLY);
309         if (fd < 0) {
310                 printf("Failed to open FDT file '%s'\n", fname);
311                 return -EACCES;
312         }
313         if (os_read(fd, blob, size) != size) {
314                 os_close(fd);
315                 return -EIO;
316         }
317         os_close(fd);
318
319 done:
320         gd->fdt_blob = blob;
321
322         return 0;
323 }
324 #endif
325
326 #ifdef CONFIG_SANDBOX
327 static int setup_ram_buf(void)
328 {
329         struct sandbox_state *state = state_get_current();
330
331         gd->arch.ram_buf = state->ram_buf;
332         gd->ram_size = state->ram_size;
333
334         return 0;
335 }
336 #endif
337
338 static int setup_fdt(void)
339 {
340 #ifdef CONFIG_OF_CONTROL
341 # ifdef CONFIG_OF_EMBED
342         /* Get a pointer to the FDT */
343         gd->fdt_blob = __dtb_dt_begin;
344 # elif defined CONFIG_OF_SEPARATE
345         /* FDT is at end of image */
346         gd->fdt_blob = (ulong *)&_end;
347 # elif defined(CONFIG_OF_HOSTFILE)
348         if (read_fdt_from_file()) {
349                 puts("Failed to read control FDT\n");
350                 return -1;
351         }
352 # endif
353         /* Allow the early environment to override the fdt address */
354         gd->fdt_blob = (void *)getenv_ulong("fdtcontroladdr", 16,
355                                                 (uintptr_t)gd->fdt_blob);
356 #endif
357         return 0;
358 }
359
360 /* Get the top of usable RAM */
361 __weak ulong board_get_usable_ram_top(ulong total_size)
362 {
363         return gd->ram_top;
364 }
365
366 static int setup_dest_addr(void)
367 {
368         debug("Monitor len: %08lX\n", gd->mon_len);
369         /*
370          * Ram is setup, size stored in gd !!
371          */
372         debug("Ram size: %08lX\n", (ulong)gd->ram_size);
373 #if defined(CONFIG_SYS_MEM_TOP_HIDE)
374         /*
375          * Subtract specified amount of memory to hide so that it won't
376          * get "touched" at all by U-Boot. By fixing up gd->ram_size
377          * the Linux kernel should now get passed the now "corrected"
378          * memory size and won't touch it either. This should work
379          * for arch/ppc and arch/powerpc. Only Linux board ports in
380          * arch/powerpc with bootwrapper support, that recalculate the
381          * memory size from the SDRAM controller setup will have to
382          * get fixed.
383          */
384         gd->ram_size -= CONFIG_SYS_MEM_TOP_HIDE;
385 #endif
386 #ifdef CONFIG_SYS_SDRAM_BASE
387         gd->ram_top = CONFIG_SYS_SDRAM_BASE;
388 #endif
389         gd->ram_top += get_effective_memsize();
390         gd->ram_top = board_get_usable_ram_top(gd->mon_len);
391         gd->relocaddr = gd->ram_top;
392         debug("Ram top: %08lX\n", (ulong)gd->ram_top);
393 #if defined(CONFIG_MP) && (defined(CONFIG_MPC86xx) || defined(CONFIG_E500))
394         /*
395          * We need to make sure the location we intend to put secondary core
396          * boot code is reserved and not used by any part of u-boot
397          */
398         if (gd->relocaddr > determine_mp_bootpg(NULL)) {
399                 gd->relocaddr = determine_mp_bootpg(NULL);
400                 debug("Reserving MP boot page to %08lx\n", gd->relocaddr);
401         }
402 #endif
403         return 0;
404 }
405
406 #if defined(CONFIG_LOGBUFFER) && !defined(CONFIG_ALT_LB_ADDR)
407 static int reserve_logbuffer(void)
408 {
409         /* reserve kernel log buffer */
410         gd->relocaddr -= LOGBUFF_RESERVE;
411         debug("Reserving %dk for kernel logbuffer at %08lx\n", LOGBUFF_LEN,
412                 gd->relocaddr);
413         return 0;
414 }
415 #endif
416
417 #ifdef CONFIG_PRAM
418 /* reserve protected RAM */
419 static int reserve_pram(void)
420 {
421         ulong reg;
422
423         reg = getenv_ulong("pram", 10, CONFIG_PRAM);
424         gd->relocaddr -= (reg << 10);           /* size is in kB */
425         debug("Reserving %ldk for protected RAM at %08lx\n", reg,
426               gd->relocaddr);
427         return 0;
428 }
429 #endif /* CONFIG_PRAM */
430
431 /* Round memory pointer down to next 4 kB limit */
432 static int reserve_round_4k(void)
433 {
434         gd->relocaddr &= ~(4096 - 1);
435         return 0;
436 }
437
438 #if !(defined(CONFIG_SYS_ICACHE_OFF) && defined(CONFIG_SYS_DCACHE_OFF)) && \
439                 defined(CONFIG_ARM)
440 static int reserve_mmu(void)
441 {
442         /* reserve TLB table */
443         gd->arch.tlb_size = PGTABLE_SIZE;
444         gd->relocaddr -= gd->arch.tlb_size;
445
446         /* round down to next 64 kB limit */
447         gd->relocaddr &= ~(0x10000 - 1);
448
449         gd->arch.tlb_addr = gd->relocaddr;
450         debug("TLB table from %08lx to %08lx\n", gd->arch.tlb_addr,
451               gd->arch.tlb_addr + gd->arch.tlb_size);
452         return 0;
453 }
454 #endif
455
456 #ifdef CONFIG_LCD
457 static int reserve_lcd(void)
458 {
459 #ifdef CONFIG_FB_ADDR
460         gd->fb_base = CONFIG_FB_ADDR;
461 #else
462         /* reserve memory for LCD display (always full pages) */
463         gd->relocaddr = lcd_setmem(gd->relocaddr);
464         gd->fb_base = gd->relocaddr;
465 #endif /* CONFIG_FB_ADDR */
466         return 0;
467 }
468 #endif /* CONFIG_LCD */
469
470 static int reserve_trace(void)
471 {
472 #ifdef CONFIG_TRACE
473         gd->relocaddr -= CONFIG_TRACE_BUFFER_SIZE;
474         gd->trace_buff = map_sysmem(gd->relocaddr, CONFIG_TRACE_BUFFER_SIZE);
475         debug("Reserving %dk for trace data at: %08lx\n",
476               CONFIG_TRACE_BUFFER_SIZE >> 10, gd->relocaddr);
477 #endif
478
479         return 0;
480 }
481
482 #if defined(CONFIG_VIDEO) && (!defined(CONFIG_PPC) || defined(CONFIG_8xx)) && \
483                 !defined(CONFIG_ARM) && !defined(CONFIG_X86) && \
484                 !defined(CONFIG_BLACKFIN)
485 static int reserve_video(void)
486 {
487         /* reserve memory for video display (always full pages) */
488         gd->relocaddr = video_setmem(gd->relocaddr);
489         gd->fb_base = gd->relocaddr;
490
491         return 0;
492 }
493 #endif
494
495 static int reserve_uboot(void)
496 {
497         /*
498          * reserve memory for U-Boot code, data & bss
499          * round down to next 4 kB limit
500          */
501         gd->relocaddr -= gd->mon_len;
502         gd->relocaddr &= ~(4096 - 1);
503 #ifdef CONFIG_E500
504         /* round down to next 64 kB limit so that IVPR stays aligned */
505         gd->relocaddr &= ~(65536 - 1);
506 #endif
507
508         debug("Reserving %ldk for U-Boot at: %08lx\n", gd->mon_len >> 10,
509               gd->relocaddr);
510
511         gd->start_addr_sp = gd->relocaddr;
512
513         return 0;
514 }
515
516 #ifndef CONFIG_SPL_BUILD
517 /* reserve memory for malloc() area */
518 static int reserve_malloc(void)
519 {
520         gd->start_addr_sp = gd->start_addr_sp - TOTAL_MALLOC_LEN;
521         debug("Reserving %dk for malloc() at: %08lx\n",
522                         TOTAL_MALLOC_LEN >> 10, gd->start_addr_sp);
523         return 0;
524 }
525
526 /* (permanently) allocate a Board Info struct */
527 static int reserve_board(void)
528 {
529         if (!gd->bd) {
530                 gd->start_addr_sp -= sizeof(bd_t);
531                 gd->bd = (bd_t *)map_sysmem(gd->start_addr_sp, sizeof(bd_t));
532                 memset(gd->bd, '\0', sizeof(bd_t));
533                 debug("Reserving %zu Bytes for Board Info at: %08lx\n",
534                       sizeof(bd_t), gd->start_addr_sp);
535         }
536         return 0;
537 }
538 #endif
539
540 static int setup_machine(void)
541 {
542 #ifdef CONFIG_MACH_TYPE
543         gd->bd->bi_arch_number = CONFIG_MACH_TYPE; /* board id for Linux */
544 #endif
545         return 0;
546 }
547
548 static int reserve_global_data(void)
549 {
550         gd->start_addr_sp -= sizeof(gd_t);
551         gd->new_gd = (gd_t *)map_sysmem(gd->start_addr_sp, sizeof(gd_t));
552         debug("Reserving %zu Bytes for Global Data at: %08lx\n",
553                         sizeof(gd_t), gd->start_addr_sp);
554         return 0;
555 }
556
557 static int reserve_fdt(void)
558 {
559         /*
560          * If the device tree is sitting immediate above our image then we
561          * must relocate it. If it is embedded in the data section, then it
562          * will be relocated with other data.
563          */
564         if (gd->fdt_blob) {
565                 gd->fdt_size = ALIGN(fdt_totalsize(gd->fdt_blob) + 0x1000, 32);
566
567                 gd->start_addr_sp -= gd->fdt_size;
568                 gd->new_fdt = map_sysmem(gd->start_addr_sp, gd->fdt_size);
569                 debug("Reserving %lu Bytes for FDT at: %08lx\n",
570                       gd->fdt_size, gd->start_addr_sp);
571         }
572
573         return 0;
574 }
575
576 int arch_reserve_stacks(void)
577 {
578         return 0;
579 }
580
581 static int reserve_stacks(void)
582 {
583         /* make stack pointer 16-byte aligned */
584         gd->start_addr_sp -= 16;
585         gd->start_addr_sp &= ~0xf;
586
587         /*
588          * let the architecture specific code tailor gd->start_addr_sp and
589          * gd->irq_sp
590          */
591         return arch_reserve_stacks();
592 }
593
594 static int display_new_sp(void)
595 {
596         debug("New Stack Pointer is: %08lx\n", gd->start_addr_sp);
597
598         return 0;
599 }
600
601 #if defined(CONFIG_PPC) || defined(CONFIG_M68K)
602 static int setup_board_part1(void)
603 {
604         bd_t *bd = gd->bd;
605
606         /*
607          * Save local variables to board info struct
608          */
609
610         bd->bi_memstart = CONFIG_SYS_SDRAM_BASE;        /* start of memory */
611         bd->bi_memsize = gd->ram_size;                  /* size in bytes */
612
613 #ifdef CONFIG_SYS_SRAM_BASE
614         bd->bi_sramstart = CONFIG_SYS_SRAM_BASE;        /* start of SRAM */
615         bd->bi_sramsize = CONFIG_SYS_SRAM_SIZE;         /* size  of SRAM */
616 #endif
617
618 #if defined(CONFIG_8xx) || defined(CONFIG_MPC8260) || defined(CONFIG_5xx) || \
619                 defined(CONFIG_E500) || defined(CONFIG_MPC86xx)
620         bd->bi_immr_base = CONFIG_SYS_IMMR;     /* base  of IMMR register     */
621 #endif
622 #if defined(CONFIG_MPC5xxx) || defined(CONFIG_M68K)
623         bd->bi_mbar_base = CONFIG_SYS_MBAR;     /* base of internal registers */
624 #endif
625 #if defined(CONFIG_MPC83xx)
626         bd->bi_immrbar = CONFIG_SYS_IMMR;
627 #endif
628
629         return 0;
630 }
631
632 static int setup_board_part2(void)
633 {
634         bd_t *bd = gd->bd;
635
636         bd->bi_intfreq = gd->cpu_clk;   /* Internal Freq, in Hz */
637         bd->bi_busfreq = gd->bus_clk;   /* Bus Freq,      in Hz */
638 #if defined(CONFIG_CPM2)
639         bd->bi_cpmfreq = gd->arch.cpm_clk;
640         bd->bi_brgfreq = gd->arch.brg_clk;
641         bd->bi_sccfreq = gd->arch.scc_clk;
642         bd->bi_vco = gd->arch.vco_out;
643 #endif /* CONFIG_CPM2 */
644 #if defined(CONFIG_MPC512X)
645         bd->bi_ipsfreq = gd->arch.ips_clk;
646 #endif /* CONFIG_MPC512X */
647 #if defined(CONFIG_MPC5xxx)
648         bd->bi_ipbfreq = gd->arch.ipb_clk;
649         bd->bi_pcifreq = gd->pci_clk;
650 #endif /* CONFIG_MPC5xxx */
651 #if defined(CONFIG_M68K) && defined(CONFIG_PCI)
652         bd->bi_pcifreq = gd->pci_clk;
653 #endif
654 #if defined(CONFIG_EXTRA_CLOCK)
655         bd->bi_inpfreq = gd->arch.inp_clk;      /* input Freq in Hz */
656         bd->bi_vcofreq = gd->arch.vco_clk;      /* vco Freq in Hz */
657         bd->bi_flbfreq = gd->arch.flb_clk;      /* flexbus Freq in Hz */
658 #endif
659
660         return 0;
661 }
662 #endif
663
664 #ifdef CONFIG_SYS_EXTBDINFO
665 static int setup_board_extra(void)
666 {
667         bd_t *bd = gd->bd;
668
669         strncpy((char *) bd->bi_s_version, "1.2", sizeof(bd->bi_s_version));
670         strncpy((char *) bd->bi_r_version, U_BOOT_VERSION,
671                 sizeof(bd->bi_r_version));
672
673         bd->bi_procfreq = gd->cpu_clk;  /* Processor Speed, In Hz */
674         bd->bi_plb_busfreq = gd->bus_clk;
675 #if defined(CONFIG_405GP) || defined(CONFIG_405EP) || \
676                 defined(CONFIG_440EP) || defined(CONFIG_440GR) || \
677                 defined(CONFIG_440EPX) || defined(CONFIG_440GRX)
678         bd->bi_pci_busfreq = get_PCI_freq();
679         bd->bi_opbfreq = get_OPB_freq();
680 #elif defined(CONFIG_XILINX_405)
681         bd->bi_pci_busfreq = get_PCI_freq();
682 #endif
683
684         return 0;
685 }
686 #endif
687
688 #ifdef CONFIG_POST
689 static int init_post(void)
690 {
691         post_bootmode_init();
692         post_run(NULL, POST_ROM | post_bootmode_get(0));
693
694         return 0;
695 }
696 #endif
697
698 static int setup_dram_config(void)
699 {
700         /* Ram is board specific, so move it to board code ... */
701         dram_init_banksize();
702
703         return 0;
704 }
705
706 static int reloc_fdt(void)
707 {
708         if (gd->new_fdt) {
709                 memcpy(gd->new_fdt, gd->fdt_blob, gd->fdt_size);
710                 gd->fdt_blob = gd->new_fdt;
711         }
712
713         return 0;
714 }
715
716 static int setup_reloc(void)
717 {
718 #ifdef CONFIG_SYS_TEXT_BASE
719         gd->reloc_off = gd->relocaddr - CONFIG_SYS_TEXT_BASE;
720 #ifdef CONFIG_M68K
721         /*
722          * On all ColdFire arch cpu, monitor code starts always
723          * just after the default vector table location, so at 0x400
724          */
725         gd->reloc_off = gd->relocaddr - (CONFIG_SYS_TEXT_BASE + 0x400);
726 #endif
727 #endif
728         memcpy(gd->new_gd, (char *)gd, sizeof(gd_t));
729
730         debug("Relocation Offset is: %08lx\n", gd->reloc_off);
731         debug("Relocating to %08lx, new gd at %08lx, sp at %08lx\n",
732               gd->relocaddr, (ulong)map_to_sysmem(gd->new_gd),
733               gd->start_addr_sp);
734
735         return 0;
736 }
737
738 /* ARM calls relocate_code from its crt0.S */
739 #if !defined(CONFIG_ARM) && !defined(CONFIG_SANDBOX)
740
741 static int jump_to_copy(void)
742 {
743         /*
744          * x86 is special, but in a nice way. It uses a trampoline which
745          * enables the dcache if possible.
746          *
747          * For now, other archs use relocate_code(), which is implemented
748          * similarly for all archs. When we do generic relocation, hopefully
749          * we can make all archs enable the dcache prior to relocation.
750          */
751 #ifdef CONFIG_X86
752         /*
753          * SDRAM and console are now initialised. The final stack can now
754          * be setup in SDRAM. Code execution will continue in Flash, but
755          * with the stack in SDRAM and Global Data in temporary memory
756          * (CPU cache)
757          */
758         board_init_f_r_trampoline(gd->start_addr_sp);
759 #else
760         relocate_code(gd->start_addr_sp, gd->new_gd, gd->relocaddr);
761 #endif
762
763         return 0;
764 }
765 #endif
766
767 /* Record the board_init_f() bootstage (after arch_cpu_init()) */
768 static int mark_bootstage(void)
769 {
770         bootstage_mark_name(BOOTSTAGE_ID_START_UBOOT_F, "board_init_f");
771
772         return 0;
773 }
774
775 static int initf_malloc(void)
776 {
777 #ifdef CONFIG_SYS_MALLOC_F_LEN
778         assert(gd->malloc_base);        /* Set up by crt0.S */
779         gd->malloc_limit = gd->malloc_base + CONFIG_SYS_MALLOC_F_LEN;
780         gd->malloc_ptr = 0;
781 #endif
782
783         return 0;
784 }
785
786 static int initf_dm(void)
787 {
788 #if defined(CONFIG_DM) && defined(CONFIG_SYS_MALLOC_F_LEN)
789         int ret;
790
791         ret = dm_init_and_scan(true);
792         if (ret)
793                 return ret;
794 #endif
795
796         return 0;
797 }
798
799 /* Architecture-specific memory reservation */
800 __weak int reserve_arch(void)
801 {
802         return 0;
803 }
804
805 static init_fnc_t init_sequence_f[] = {
806 #ifdef CONFIG_SANDBOX
807         setup_ram_buf,
808 #endif
809         setup_mon_len,
810         setup_fdt,
811 #ifdef CONFIG_TRACE
812         trace_early_init,
813 #endif
814         initf_malloc,
815 #if defined(CONFIG_MPC85xx) || defined(CONFIG_MPC86xx)
816         /* TODO: can this go into arch_cpu_init()? */
817         probecpu,
818 #endif
819         arch_cpu_init,          /* basic arch cpu dependent setup */
820         mark_bootstage,
821 #ifdef CONFIG_OF_CONTROL
822         fdtdec_check_fdt,
823 #endif
824         initf_dm,
825 #if defined(CONFIG_BOARD_EARLY_INIT_F)
826         board_early_init_f,
827 #endif
828         /* TODO: can any of this go into arch_cpu_init()? */
829 #if defined(CONFIG_PPC) && !defined(CONFIG_8xx_CPUCLK_DEFAULT)
830         get_clocks,             /* get CPU and bus clocks (etc.) */
831 #if defined(CONFIG_TQM8xxL) && !defined(CONFIG_TQM866M) \
832                 && !defined(CONFIG_TQM885D)
833         adjust_sdram_tbs_8xx,
834 #endif
835         /* TODO: can we rename this to timer_init()? */
836         init_timebase,
837 #endif
838 #if defined(CONFIG_ARM) || defined(CONFIG_MIPS) || defined(CONFIG_BLACKFIN)
839         timer_init,             /* initialize timer */
840 #endif
841 #ifdef CONFIG_SYS_ALLOC_DPRAM
842 #if !defined(CONFIG_CPM2)
843         dpram_init,
844 #endif
845 #endif
846 #if defined(CONFIG_BOARD_POSTCLK_INIT)
847         board_postclk_init,
848 #endif
849 #ifdef CONFIG_FSL_ESDHC
850         get_clocks,
851 #endif
852 #ifdef CONFIG_M68K
853         get_clocks,
854 #endif
855         env_init,               /* initialize environment */
856 #if defined(CONFIG_8xx_CPUCLK_DEFAULT)
857         /* get CPU and bus clocks according to the environment variable */
858         get_clocks_866,
859         /* adjust sdram refresh rate according to the new clock */
860         sdram_adjust_866,
861         init_timebase,
862 #endif
863         init_baud_rate,         /* initialze baudrate settings */
864         serial_init,            /* serial communications setup */
865         console_init_f,         /* stage 1 init of console */
866 #ifdef CONFIG_SANDBOX
867         sandbox_early_getopt_check,
868 #endif
869 #ifdef CONFIG_OF_CONTROL
870         fdtdec_prepare_fdt,
871 #endif
872         display_options,        /* say that we are here */
873         display_text_info,      /* show debugging info if required */
874 #if defined(CONFIG_MPC8260)
875         prt_8260_rsr,
876         prt_8260_clks,
877 #endif /* CONFIG_MPC8260 */
878 #if defined(CONFIG_MPC83xx)
879         prt_83xx_rsr,
880 #endif
881 #if defined(CONFIG_PPC) || defined(CONFIG_M68K)
882         checkcpu,
883 #endif
884         print_cpuinfo,          /* display cpu info (and speed) */
885 #if defined(CONFIG_MPC5xxx)
886         prt_mpc5xxx_clks,
887 #endif /* CONFIG_MPC5xxx */
888 #if defined(CONFIG_DISPLAY_BOARDINFO)
889         show_board_info,
890 #endif
891         INIT_FUNC_WATCHDOG_INIT
892 #if defined(CONFIG_MISC_INIT_F)
893         misc_init_f,
894 #endif
895         INIT_FUNC_WATCHDOG_RESET
896 #if defined(CONFIG_HARD_I2C) || defined(CONFIG_SYS_I2C)
897         init_func_i2c,
898 #endif
899 #if defined(CONFIG_HARD_SPI)
900         init_func_spi,
901 #endif
902         announce_dram_init,
903         /* TODO: unify all these dram functions? */
904 #if defined(CONFIG_ARM) || defined(CONFIG_X86) || defined(CONFIG_MICROBLAZE) || defined(CONFIG_AVR32)
905         dram_init,              /* configure available RAM banks */
906 #endif
907 #if defined(CONFIG_MIPS) || defined(CONFIG_PPC) || defined(CONFIG_M68K)
908         init_func_ram,
909 #endif
910 #ifdef CONFIG_POST
911         post_init_f,
912 #endif
913         INIT_FUNC_WATCHDOG_RESET
914 #if defined(CONFIG_SYS_DRAM_TEST)
915         testdram,
916 #endif /* CONFIG_SYS_DRAM_TEST */
917         INIT_FUNC_WATCHDOG_RESET
918
919 #ifdef CONFIG_POST
920         init_post,
921 #endif
922         INIT_FUNC_WATCHDOG_RESET
923         /*
924          * Now that we have DRAM mapped and working, we can
925          * relocate the code and continue running from DRAM.
926          *
927          * Reserve memory at end of RAM for (top down in that order):
928          *  - area that won't get touched by U-Boot and Linux (optional)
929          *  - kernel log buffer
930          *  - protected RAM
931          *  - LCD framebuffer
932          *  - monitor code
933          *  - board info struct
934          */
935         setup_dest_addr,
936 #if defined(CONFIG_BLACKFIN) || defined(CONFIG_NIOS2)
937         /* Blackfin u-boot monitor should be on top of the ram */
938         reserve_uboot,
939 #endif
940 #if defined(CONFIG_LOGBUFFER) && !defined(CONFIG_ALT_LB_ADDR)
941         reserve_logbuffer,
942 #endif
943 #ifdef CONFIG_PRAM
944         reserve_pram,
945 #endif
946         reserve_round_4k,
947 #if !(defined(CONFIG_SYS_ICACHE_OFF) && defined(CONFIG_SYS_DCACHE_OFF)) && \
948                 defined(CONFIG_ARM)
949         reserve_mmu,
950 #endif
951 #ifdef CONFIG_LCD
952         reserve_lcd,
953 #endif
954         reserve_trace,
955         /* TODO: Why the dependency on CONFIG_8xx? */
956 #if defined(CONFIG_VIDEO) && (!defined(CONFIG_PPC) || defined(CONFIG_8xx)) && \
957                 !defined(CONFIG_ARM) && !defined(CONFIG_X86) && \
958                 !defined(CONFIG_BLACKFIN)
959         reserve_video,
960 #endif
961 #if !defined(CONFIG_BLACKFIN) && !defined(CONFIG_NIOS2)
962         reserve_uboot,
963 #endif
964 #ifndef CONFIG_SPL_BUILD
965         reserve_malloc,
966         reserve_board,
967 #endif
968         setup_machine,
969         reserve_global_data,
970         reserve_fdt,
971         reserve_arch,
972         reserve_stacks,
973         setup_dram_config,
974         show_dram_config,
975 #if defined(CONFIG_PPC) || defined(CONFIG_M68K)
976         setup_board_part1,
977         INIT_FUNC_WATCHDOG_RESET
978         setup_board_part2,
979 #endif
980         display_new_sp,
981 #ifdef CONFIG_SYS_EXTBDINFO
982         setup_board_extra,
983 #endif
984         INIT_FUNC_WATCHDOG_RESET
985         reloc_fdt,
986         setup_reloc,
987 #ifdef CONFIG_X86
988         copy_uboot_to_ram,
989         clear_bss,
990         do_elf_reloc_fixups,
991 #endif
992 #if !defined(CONFIG_ARM) && !defined(CONFIG_SANDBOX)
993         jump_to_copy,
994 #endif
995         NULL,
996 };
997
998 void board_init_f(ulong boot_flags)
999 {
1000 #ifdef CONFIG_SYS_GENERIC_GLOBAL_DATA
1001         /*
1002          * For some archtectures, global data is initialized and used before
1003          * calling this function. The data should be preserved. For others,
1004          * CONFIG_SYS_GENERIC_GLOBAL_DATA should be defined and use the stack
1005          * here to host global data until relocation.
1006          */
1007         gd_t data;
1008
1009         gd = &data;
1010
1011         /*
1012          * Clear global data before it is accessed at debug print
1013          * in initcall_run_list. Otherwise the debug print probably
1014          * get the wrong vaule of gd->have_console.
1015          */
1016         zero_global_data();
1017 #endif
1018
1019         gd->flags = boot_flags;
1020         gd->have_console = 0;
1021
1022         if (initcall_run_list(init_sequence_f))
1023                 hang();
1024
1025 #if !defined(CONFIG_ARM) && !defined(CONFIG_SANDBOX)
1026         /* NOTREACHED - jump_to_copy() does not return */
1027         hang();
1028 #endif
1029 }
1030
1031 #ifdef CONFIG_X86
1032 /*
1033  * For now this code is only used on x86.
1034  *
1035  * init_sequence_f_r is the list of init functions which are run when
1036  * U-Boot is executing from Flash with a semi-limited 'C' environment.
1037  * The following limitations must be considered when implementing an
1038  * '_f_r' function:
1039  *  - 'static' variables are read-only
1040  *  - Global Data (gd->xxx) is read/write
1041  *
1042  * The '_f_r' sequence must, as a minimum, copy U-Boot to RAM (if
1043  * supported).  It _should_, if possible, copy global data to RAM and
1044  * initialise the CPU caches (to speed up the relocation process)
1045  *
1046  * NOTE: At present only x86 uses this route, but it is intended that
1047  * all archs will move to this when generic relocation is implemented.
1048  */
1049 static init_fnc_t init_sequence_f_r[] = {
1050         init_cache_f_r,
1051
1052         NULL,
1053 };
1054
1055 void board_init_f_r(void)
1056 {
1057         if (initcall_run_list(init_sequence_f_r))
1058                 hang();
1059
1060         /*
1061          * U-Boot has been copied into SDRAM, the BSS has been cleared etc.
1062          * Transfer execution from Flash to RAM by calculating the address
1063          * of the in-RAM copy of board_init_r() and calling it
1064          */
1065         (board_init_r + gd->reloc_off)((gd_t *)gd, gd->relocaddr);
1066
1067         /* NOTREACHED - board_init_r() does not return */
1068         hang();
1069 }
1070 #else
1071 ulong board_init_f_mem(ulong top)
1072 {
1073         /* Leave space for the stack we are running with now */
1074         top -= 0x40;
1075
1076         top -= sizeof(struct global_data);
1077         top = ALIGN(top, 16);
1078         gd = (struct global_data *)top;
1079         memset((void *)gd, '\0', sizeof(*gd));
1080
1081 #ifdef CONFIG_SYS_MALLOC_F_LEN
1082         top -= CONFIG_SYS_MALLOC_F_LEN;
1083         gd->malloc_base = top;
1084 #endif
1085
1086         return top;
1087 }
1088 #endif /* CONFIG_X86 */