1
2
3
4
5
6
7
8
9
10#include <common.h>
11#include <bootstage.h>
12#include <cpu_func.h>
13#include <env.h>
14#include <init.h>
15#include <lmb.h>
16#include <log.h>
17#include <watchdog.h>
18#include <command.h>
19#include <image.h>
20#include <malloc.h>
21#include <asm/global_data.h>
22#include <u-boot/zlib.h>
23#include <bzlib.h>
24#include <asm/byteorder.h>
25#include <asm/mp.h>
26#include <bootm.h>
27#include <vxworks.h>
28
29#if defined(CONFIG_OF_LIBFDT)
30#include <linux/libfdt.h>
31#include <fdt_support.h>
32#endif
33
34#ifdef CONFIG_SYS_INIT_RAM_LOCK
35#include <asm/cache.h>
36#endif
37
38DECLARE_GLOBAL_DATA_PTR;
39
40static ulong get_sp (void);
41extern void ft_fixup_num_cores(void *blob);
42static void set_clocks_in_mhz (struct bd_info *kbd);
43
44#ifndef CFG_SYS_LINUX_LOWMEM_MAX_SIZE
45#define CFG_SYS_LINUX_LOWMEM_MAX_SIZE (768*1024*1024)
46#endif
47
48static void boot_jump_linux(struct bootm_headers *images)
49{
50 void (*kernel)(struct bd_info *, ulong r4, ulong r5, ulong r6,
51 ulong r7, ulong r8, ulong r9);
52#ifdef CONFIG_OF_LIBFDT
53 char *of_flat_tree = images->ft_addr;
54#endif
55
56 kernel = (void (*)(struct bd_info *, ulong, ulong, ulong,
57 ulong, ulong, ulong))images->ep;
58 debug("## Transferring control to Linux (at address %08lx) ...\n",
59 (ulong)kernel);
60
61 bootstage_mark(BOOTSTAGE_ID_RUN_OS);
62
63#ifdef CONFIG_BOOTSTAGE_FDT
64 bootstage_fdt_add_report();
65#endif
66#ifdef CONFIG_BOOTSTAGE_REPORT
67 bootstage_report();
68#endif
69
70#if defined(CONFIG_SYS_INIT_RAM_LOCK) && !defined(CONFIG_E500)
71 unlock_ram_in_cache();
72#endif
73
74#if defined(CONFIG_OF_LIBFDT)
75 if (of_flat_tree) {
76
77
78
79
80
81
82
83
84
85
86 debug(" Booting using OF flat tree...\n");
87 schedule();
88 (*kernel) ((struct bd_info *)of_flat_tree, 0, 0, EPAPR_MAGIC,
89 env_get_bootm_mapsize(), 0, 0);
90
91 } else
92#endif
93 {
94
95
96
97
98
99
100
101
102
103
104 ulong cmd_start = images->cmdline_start;
105 ulong cmd_end = images->cmdline_end;
106 ulong initrd_start = images->initrd_start;
107 ulong initrd_end = images->initrd_end;
108 struct bd_info *kbd = images->kbd;
109
110 debug(" Booting using board info...\n");
111 schedule();
112 (*kernel) (kbd, initrd_start, initrd_end,
113 cmd_start, cmd_end, 0, 0);
114
115 }
116 return;
117}
118
119void arch_lmb_reserve(struct lmb *lmb)
120{
121 phys_size_t bootm_size;
122 ulong size, bootmap_base;
123
124 bootmap_base = env_get_bootm_low();
125 bootm_size = env_get_bootm_size();
126
127#ifdef DEBUG
128 if (((u64)bootmap_base + bootm_size) >
129 (CFG_SYS_SDRAM_BASE + (u64)gd->ram_size))
130 puts("WARNING: bootm_low + bootm_size exceed total memory\n");
131 if ((bootmap_base + bootm_size) > get_effective_memsize())
132 puts("WARNING: bootm_low + bootm_size exceed eff. memory\n");
133#endif
134
135 size = min(bootm_size, get_effective_memsize());
136 size = min(size, (ulong)CFG_SYS_LINUX_LOWMEM_MAX_SIZE);
137
138 if (size < bootm_size) {
139 ulong base = bootmap_base + size;
140 printf("WARNING: adjusting available memory from 0x%lx to 0x%llx\n",
141 size, (unsigned long long)bootm_size);
142 lmb_reserve(lmb, base, bootm_size - size);
143 }
144
145 arch_lmb_reserve_generic(lmb, get_sp(), gd->ram_top, 4096);
146
147#ifdef CONFIG_MP
148 cpu_mp_lmb_reserve(lmb);
149#endif
150
151 return;
152}
153
154static void boot_prep_linux(struct bootm_headers *images)
155{
156#ifdef CONFIG_MP
157
158
159
160
161
162 flush_cache((unsigned long)images->ft_addr, images->ft_len);
163#endif
164}
165
166static int boot_cmdline_linux(struct bootm_headers *images)
167{
168 ulong of_size = images->ft_len;
169 struct lmb *lmb = &images->lmb;
170 ulong *cmd_start = &images->cmdline_start;
171 ulong *cmd_end = &images->cmdline_end;
172
173 int ret = 0;
174
175 if (!of_size) {
176
177 ret = boot_get_cmdline (lmb, cmd_start, cmd_end);
178 if (ret) {
179 puts("ERROR with allocation of cmdline\n");
180 return ret;
181 }
182 }
183
184 return ret;
185}
186
187static int boot_bd_t_linux(struct bootm_headers *images)
188{
189 ulong of_size = images->ft_len;
190 struct lmb *lmb = &images->lmb;
191 struct bd_info **kbd = &images->kbd;
192
193 int ret = 0;
194
195 if (!of_size) {
196
197 ret = boot_get_kbd (lmb, kbd);
198 if (ret) {
199 puts("ERROR with allocation of kernel bd\n");
200 return ret;
201 }
202 set_clocks_in_mhz(*kbd);
203 }
204
205 return ret;
206}
207
208static int boot_body_linux(struct bootm_headers *images)
209{
210 int ret;
211
212
213 ret = boot_bd_t_linux(images);
214 if (ret)
215 return ret;
216
217 if (IS_ENABLED(CONFIG_LMB)) {
218 ret = image_setup_linux(images);
219 if (ret)
220 return ret;
221 }
222
223 return 0;
224}
225
226noinline int do_bootm_linux(int flag, int argc, char *const argv[],
227 struct bootm_headers *images)
228{
229 int ret;
230
231 if (flag & BOOTM_STATE_OS_CMDLINE) {
232 boot_cmdline_linux(images);
233 return 0;
234 }
235
236 if (flag & BOOTM_STATE_OS_BD_T) {
237 boot_bd_t_linux(images);
238 return 0;
239 }
240
241 if (flag & BOOTM_STATE_OS_PREP) {
242 boot_prep_linux(images);
243 return 0;
244 }
245
246 boot_prep_linux(images);
247 ret = boot_body_linux(images);
248 if (ret)
249 return ret;
250 boot_jump_linux(images);
251
252 return 0;
253}
254
255static ulong get_sp (void)
256{
257 ulong sp;
258
259 asm( "mr %0,1": "=r"(sp) : );
260 return sp;
261}
262
263static void set_clocks_in_mhz (struct bd_info *kbd)
264{
265 char *s;
266
267 s = env_get("clocks_in_mhz");
268 if (s) {
269
270 kbd->bi_intfreq /= 1000000L;
271 kbd->bi_busfreq /= 1000000L;
272 }
273}
274
275#if defined(CONFIG_BOOTM_VXWORKS)
276void boot_prep_vxworks(struct bootm_headers *images)
277{
278#if defined(CONFIG_OF_LIBFDT)
279 int off;
280 u64 base, size;
281
282 if (!images->ft_addr)
283 return;
284
285 base = (u64)gd->ram_base;
286 size = (u64)gd->ram_size;
287
288 off = fdt_path_offset(images->ft_addr, "/memory");
289 if (off < 0)
290 fdt_fixup_memory(images->ft_addr, base, size);
291
292#if defined(CONFIG_MP)
293#if defined(CONFIG_MPC85xx)
294 ft_fixup_cpu(images->ft_addr, base + size);
295 ft_fixup_num_cores(images->ft_addr);
296#elif defined(CONFIG_MPC86xx)
297 off = fdt_add_mem_rsv(images->ft_addr,
298 determine_mp_bootpg(NULL), (u64)4096);
299 if (off < 0)
300 printf("## WARNING %s: %s\n", __func__, fdt_strerror(off));
301 ft_fixup_num_cores(images->ft_addr);
302#endif
303 flush_cache((unsigned long)images->ft_addr, images->ft_len);
304#endif
305#endif
306}
307
308void boot_jump_vxworks(struct bootm_headers *images)
309{
310
311
312
313
314
315
316
317
318
319
320
321
322 schedule();
323
324 ((void (*)(void *, ulong, ulong, ulong,
325 ulong, ulong, ulong))images->ep)(images->ft_addr,
326 0, 0, EPAPR_MAGIC, env_get_bootm_mapsize(), 0, 0);
327}
328#endif
329