1
2
3
4
5
6
7#include <common.h>
8
9DECLARE_GLOBAL_DATA_PTR;
10
11static ulong get_sp(void)
12{
13 ulong ret;
14
15 asm("mov %0, sp" : "=r"(ret) : );
16 return ret;
17}
18
19void arch_lmb_reserve(struct lmb *lmb)
20{
21 ulong sp;
22
23
24
25
26
27
28
29
30
31
32 sp = get_sp();
33 debug("## Current stack ends at 0x%08lx ", sp);
34
35
36 sp -= 4096;
37 lmb_reserve(lmb, sp, (CONFIG_SYS_SDRAM_BASE + gd->ram_size - sp));
38}
39
40static int cleanup_before_linux(void)
41{
42 disable_interrupts();
43 flush_dcache_all();
44 invalidate_icache_all();
45
46 return 0;
47}
48
49
50static void boot_prep_linux(bootm_headers_t *images)
51{
52 if (image_setup_linux(images))
53 hang();
54}
55
56__weak void smp_set_core_boot_addr(unsigned long addr, int corenr) {}
57__weak void smp_kick_all_cpus(void) {}
58
59
60static void boot_jump_linux(bootm_headers_t *images, int flag)
61{
62 void (*kernel_entry)(int zero, int arch, uint params);
63 unsigned int r0, r2;
64 int fake = (flag & BOOTM_STATE_OS_FAKE_GO);
65
66 kernel_entry = (void (*)(int, int, uint))images->ep;
67
68 debug("## Transferring control to Linux (at address %08lx)...\n",
69 (ulong) kernel_entry);
70 bootstage_mark(BOOTSTAGE_ID_RUN_OS);
71
72 printf("\nStarting kernel ...%s\n\n", fake ?
73 "(fake run for tracing)" : "");
74 bootstage_mark_name(BOOTSTAGE_ID_BOOTM_HANDOFF, "start_kernel");
75
76 cleanup_before_linux();
77
78 if (IMAGE_ENABLE_OF_LIBFDT && images->ft_len) {
79 r0 = 2;
80 r2 = (unsigned int)images->ft_addr;
81 } else {
82 r0 = 1;
83 r2 = (unsigned int)getenv("bootargs");
84 }
85
86 smp_set_core_boot_addr((unsigned long)kernel_entry, -1);
87 smp_kick_all_cpus();
88
89 if (!fake)
90 kernel_entry(r0, 0, r2);
91}
92
93int do_bootm_linux(int flag, int argc, char *argv[], bootm_headers_t *images)
94{
95
96 if ((flag & BOOTM_STATE_OS_BD_T) || (flag & BOOTM_STATE_OS_CMDLINE))
97 return -1;
98
99 if (flag & BOOTM_STATE_OS_PREP) {
100 boot_prep_linux(images);
101 return 0;
102 }
103
104 if (flag & (BOOTM_STATE_OS_GO | BOOTM_STATE_OS_FAKE_GO)) {
105 boot_jump_linux(images, flag);
106 return 0;
107 }
108
109 boot_prep_linux(images);
110 boot_jump_linux(images, flag);
111 return 0;
112}
113