1
2
3
4
5
6
7
8#include <common.h>
9#include <bootm.h>
10#include <fdt_support.h>
11#include <libfdt.h>
12#include <malloc.h>
13#include <vxworks.h>
14
15DECLARE_GLOBAL_DATA_PTR;
16
17static int do_bootm_standalone(int flag, int argc, char * const argv[],
18 bootm_headers_t *images)
19{
20 char *s;
21 int (*appl)(int, char *const[]);
22
23
24 s = env_get("autostart");
25 if ((s != NULL) && !strcmp(s, "no")) {
26 env_set_hex("filesize", images->os.image_len);
27 return 0;
28 }
29 appl = (int (*)(int, char * const []))images->ep;
30 appl(argc, argv);
31 return 0;
32}
33
34
35
36
37
38#if defined(CONFIG_BOOTM_NETBSD) || defined(CONFIG_BOOTM_PLAN9)
39static void copy_args(char *dest, int argc, char * const argv[], char delim)
40{
41 int i;
42
43 for (i = 0; i < argc; i++) {
44 if (i > 0)
45 *dest++ = delim;
46 strcpy(dest, argv[i]);
47 dest += strlen(argv[i]);
48 }
49}
50#endif
51
52#ifdef CONFIG_BOOTM_NETBSD
53static int do_bootm_netbsd(int flag, int argc, char * const argv[],
54 bootm_headers_t *images)
55{
56 void (*loader)(bd_t *, image_header_t *, char *, char *);
57 image_header_t *os_hdr, *hdr;
58 ulong kernel_data, kernel_len;
59 char *cmdline;
60
61 if (flag != BOOTM_STATE_OS_GO)
62 return 0;
63
64#if defined(CONFIG_FIT)
65 if (!images->legacy_hdr_valid) {
66 fit_unsupported_reset("NetBSD");
67 return 1;
68 }
69#endif
70 hdr = images->legacy_hdr_os;
71
72
73
74
75
76
77
78
79
80
81
82
83 os_hdr = NULL;
84 if (image_check_type(&images->legacy_hdr_os_copy, IH_TYPE_MULTI)) {
85 image_multi_getimg(hdr, 1, &kernel_data, &kernel_len);
86 if (kernel_len)
87 os_hdr = hdr;
88 }
89
90 if (argc > 0) {
91 ulong len;
92 int i;
93
94 for (i = 0, len = 0; i < argc; i += 1)
95 len += strlen(argv[i]) + 1;
96 cmdline = malloc(len);
97 copy_args(cmdline, argc, argv, ' ');
98 } else {
99 cmdline = env_get("bootargs");
100 if (cmdline == NULL)
101 cmdline = "";
102 }
103
104 loader = (void (*)(bd_t *, image_header_t *, char *, char *))images->ep;
105
106 printf("## Transferring control to NetBSD stage-2 loader (at address %08lx) ...\n",
107 (ulong)loader);
108
109 bootstage_mark(BOOTSTAGE_ID_RUN_OS);
110
111
112
113
114
115
116
117
118 (*loader)(gd->bd, os_hdr, "", cmdline);
119
120 return 1;
121}
122#endif
123
124#ifdef CONFIG_LYNXKDI
125static int do_bootm_lynxkdi(int flag, int argc, char * const argv[],
126 bootm_headers_t *images)
127{
128 image_header_t *hdr = &images->legacy_hdr_os_copy;
129
130 if (flag != BOOTM_STATE_OS_GO)
131 return 0;
132
133#if defined(CONFIG_FIT)
134 if (!images->legacy_hdr_valid) {
135 fit_unsupported_reset("Lynx");
136 return 1;
137 }
138#endif
139
140 lynxkdi_boot((image_header_t *)hdr);
141
142 return 1;
143}
144#endif
145
146#ifdef CONFIG_BOOTM_RTEMS
147static int do_bootm_rtems(int flag, int argc, char * const argv[],
148 bootm_headers_t *images)
149{
150 void (*entry_point)(bd_t *);
151
152 if (flag != BOOTM_STATE_OS_GO)
153 return 0;
154
155#if defined(CONFIG_FIT)
156 if (!images->legacy_hdr_valid) {
157 fit_unsupported_reset("RTEMS");
158 return 1;
159 }
160#endif
161
162 entry_point = (void (*)(bd_t *))images->ep;
163
164 printf("## Transferring control to RTEMS (at address %08lx) ...\n",
165 (ulong)entry_point);
166
167 bootstage_mark(BOOTSTAGE_ID_RUN_OS);
168
169
170
171
172
173 (*entry_point)(gd->bd);
174
175 return 1;
176}
177#endif
178
179#if defined(CONFIG_BOOTM_OSE)
180static int do_bootm_ose(int flag, int argc, char * const argv[],
181 bootm_headers_t *images)
182{
183 void (*entry_point)(void);
184
185 if (flag != BOOTM_STATE_OS_GO)
186 return 0;
187
188#if defined(CONFIG_FIT)
189 if (!images->legacy_hdr_valid) {
190 fit_unsupported_reset("OSE");
191 return 1;
192 }
193#endif
194
195 entry_point = (void (*)(void))images->ep;
196
197 printf("## Transferring control to OSE (at address %08lx) ...\n",
198 (ulong)entry_point);
199
200 bootstage_mark(BOOTSTAGE_ID_RUN_OS);
201
202
203
204
205
206 (*entry_point)();
207
208 return 1;
209}
210#endif
211
212#if defined(CONFIG_BOOTM_PLAN9)
213static int do_bootm_plan9(int flag, int argc, char * const argv[],
214 bootm_headers_t *images)
215{
216 void (*entry_point)(void);
217 char *s;
218
219 if (flag != BOOTM_STATE_OS_GO)
220 return 0;
221
222#if defined(CONFIG_FIT)
223 if (!images->legacy_hdr_valid) {
224 fit_unsupported_reset("Plan 9");
225 return 1;
226 }
227#endif
228
229
230 s = env_get("confaddr");
231 if (s != NULL) {
232 char *confaddr = (char *)simple_strtoul(s, NULL, 16);
233
234 if (argc > 0) {
235 copy_args(confaddr, argc, argv, '\n');
236 } else {
237 s = env_get("bootargs");
238 if (s != NULL)
239 strcpy(confaddr, s);
240 }
241 }
242
243 entry_point = (void (*)(void))images->ep;
244
245 printf("## Transferring control to Plan 9 (at address %08lx) ...\n",
246 (ulong)entry_point);
247
248 bootstage_mark(BOOTSTAGE_ID_RUN_OS);
249
250
251
252
253
254 (*entry_point)();
255
256 return 1;
257}
258#endif
259
260#if defined(CONFIG_BOOTM_VXWORKS) && \
261 (defined(CONFIG_PPC) || defined(CONFIG_ARM))
262
263void do_bootvx_fdt(bootm_headers_t *images)
264{
265#if defined(CONFIG_OF_LIBFDT)
266 int ret;
267 char *bootline;
268 ulong of_size = images->ft_len;
269 char **of_flat_tree = &images->ft_addr;
270 struct lmb *lmb = &images->lmb;
271
272 if (*of_flat_tree) {
273 boot_fdt_add_mem_rsv_regions(lmb, *of_flat_tree);
274
275 ret = boot_relocate_fdt(lmb, of_flat_tree, &of_size);
276 if (ret)
277 return;
278
279
280 fdt_fixup_ethernet(*of_flat_tree);
281
282 ret = fdt_add_subnode(*of_flat_tree, 0, "chosen");
283 if ((ret >= 0 || ret == -FDT_ERR_EXISTS)) {
284 bootline = env_get("bootargs");
285 if (bootline) {
286 ret = fdt_find_and_setprop(*of_flat_tree,
287 "/chosen", "bootargs",
288 bootline,
289 strlen(bootline) + 1, 1);
290 if (ret < 0) {
291 printf("## ERROR: %s : %s\n", __func__,
292 fdt_strerror(ret));
293 return;
294 }
295 }
296 } else {
297 printf("## ERROR: %s : %s\n", __func__,
298 fdt_strerror(ret));
299 return;
300 }
301 }
302#endif
303
304 boot_prep_vxworks(images);
305
306 bootstage_mark(BOOTSTAGE_ID_RUN_OS);
307
308#if defined(CONFIG_OF_LIBFDT)
309 printf("## Starting vxWorks at 0x%08lx, device tree at 0x%08lx ...\n",
310 (ulong)images->ep, (ulong)*of_flat_tree);
311#else
312 printf("## Starting vxWorks at 0x%08lx\n", (ulong)images->ep);
313#endif
314
315 boot_jump_vxworks(images);
316
317 puts("## vxWorks terminated\n");
318}
319
320static int do_bootm_vxworks(int flag, int argc, char * const argv[],
321 bootm_headers_t *images)
322{
323 if (flag != BOOTM_STATE_OS_GO)
324 return 0;
325
326#if defined(CONFIG_FIT)
327 if (!images->legacy_hdr_valid) {
328 fit_unsupported_reset("VxWorks");
329 return 1;
330 }
331#endif
332
333 do_bootvx_fdt(images);
334
335 return 1;
336}
337#endif
338
339#if defined(CONFIG_CMD_ELF)
340static int do_bootm_qnxelf(int flag, int argc, char * const argv[],
341 bootm_headers_t *images)
342{
343 char *local_args[2];
344 char str[16];
345 int dcache;
346
347 if (flag != BOOTM_STATE_OS_GO)
348 return 0;
349
350#if defined(CONFIG_FIT)
351 if (!images->legacy_hdr_valid) {
352 fit_unsupported_reset("QNX");
353 return 1;
354 }
355#endif
356
357 sprintf(str, "%lx", images->ep);
358 local_args[0] = argv[0];
359 local_args[1] = str;
360
361
362
363
364 dcache = dcache_status();
365 if (dcache)
366 dcache_disable();
367
368 do_bootelf(NULL, 0, 2, local_args);
369
370 if (dcache)
371 dcache_enable();
372
373 return 1;
374}
375#endif
376
377#ifdef CONFIG_INTEGRITY
378static int do_bootm_integrity(int flag, int argc, char * const argv[],
379 bootm_headers_t *images)
380{
381 void (*entry_point)(void);
382
383 if (flag != BOOTM_STATE_OS_GO)
384 return 0;
385
386#if defined(CONFIG_FIT)
387 if (!images->legacy_hdr_valid) {
388 fit_unsupported_reset("INTEGRITY");
389 return 1;
390 }
391#endif
392
393 entry_point = (void (*)(void))images->ep;
394
395 printf("## Transferring control to INTEGRITY (at address %08lx) ...\n",
396 (ulong)entry_point);
397
398 bootstage_mark(BOOTSTAGE_ID_RUN_OS);
399
400
401
402
403
404 (*entry_point)();
405
406 return 1;
407}
408#endif
409
410#ifdef CONFIG_BOOTM_OPENRTOS
411static int do_bootm_openrtos(int flag, int argc, char * const argv[],
412 bootm_headers_t *images)
413{
414 void (*entry_point)(void);
415
416 if (flag != BOOTM_STATE_OS_GO)
417 return 0;
418
419 entry_point = (void (*)(void))images->ep;
420
421 printf("## Transferring control to OpenRTOS (at address %08lx) ...\n",
422 (ulong)entry_point);
423
424 bootstage_mark(BOOTSTAGE_ID_RUN_OS);
425
426
427
428
429
430 (*entry_point)();
431
432 return 1;
433}
434#endif
435
436static boot_os_fn *boot_os[] = {
437 [IH_OS_U_BOOT] = do_bootm_standalone,
438#ifdef CONFIG_BOOTM_LINUX
439 [IH_OS_LINUX] = do_bootm_linux,
440#endif
441#ifdef CONFIG_BOOTM_NETBSD
442 [IH_OS_NETBSD] = do_bootm_netbsd,
443#endif
444#ifdef CONFIG_LYNXKDI
445 [IH_OS_LYNXOS] = do_bootm_lynxkdi,
446#endif
447#ifdef CONFIG_BOOTM_RTEMS
448 [IH_OS_RTEMS] = do_bootm_rtems,
449#endif
450#if defined(CONFIG_BOOTM_OSE)
451 [IH_OS_OSE] = do_bootm_ose,
452#endif
453#if defined(CONFIG_BOOTM_PLAN9)
454 [IH_OS_PLAN9] = do_bootm_plan9,
455#endif
456#if defined(CONFIG_BOOTM_VXWORKS) && \
457 (defined(CONFIG_PPC) || defined(CONFIG_ARM))
458 [IH_OS_VXWORKS] = do_bootm_vxworks,
459#endif
460#if defined(CONFIG_CMD_ELF)
461 [IH_OS_QNX] = do_bootm_qnxelf,
462#endif
463#ifdef CONFIG_INTEGRITY
464 [IH_OS_INTEGRITY] = do_bootm_integrity,
465#endif
466#ifdef CONFIG_BOOTM_OPENRTOS
467 [IH_OS_OPENRTOS] = do_bootm_openrtos,
468#endif
469};
470
471
472__weak void arch_preboot_os(void)
473{
474
475}
476
477int boot_selected_os(int argc, char * const argv[], int state,
478 bootm_headers_t *images, boot_os_fn *boot_fn)
479{
480 arch_preboot_os();
481 boot_fn(state, argc, argv, images);
482
483
484 if (images->os.type == IH_TYPE_STANDALONE ||
485 IS_ENABLED(CONFIG_SANDBOX) ||
486 state == BOOTM_STATE_OS_FAKE_GO)
487 return 0;
488 bootstage_error(BOOTSTAGE_ID_BOOT_OS_RETURNED);
489 debug("\n## Control returned to monitor - resetting...\n");
490
491 return BOOTM_ERR_RESET;
492}
493
494boot_os_fn *bootm_os_get_boot_func(int os)
495{
496#ifdef CONFIG_NEEDS_MANUAL_RELOC
497 static bool relocated;
498
499 if (!relocated) {
500 int i;
501
502
503 for (i = 0; i < ARRAY_SIZE(boot_os); i++)
504 if (boot_os[i] != NULL)
505 boot_os[i] += gd->reloc_off;
506
507 relocated = true;
508 }
509#endif
510 return boot_os[os];
511}
512