1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
|
#include <boot.h>
#include <bootm.h>
#include <common.h>
#include <libfile.h>
#include <malloc.h>
#include <init.h>
#include <fs.h>
#include <errno.h>
#include <binfmt.h>
#include <restart.h>
#include <asm/byteorder.h>
#include <asm/io.h>
static int do_bootm_barebox(struct image_data *data)
{
void (*barebox)(void);
barebox = read_file(data->os_file, NULL);
if (!barebox)
return -EINVAL;
if (data->dryrun) {
free(barebox);
return 0;
}
shutdown_barebox();
barebox();
restart_machine();
}
static struct image_handler barebox_handler = {
.name = "MIPS barebox",
.bootm = do_bootm_barebox,
.filetype = filetype_mips_barebox,
};
static struct binfmt_hook binfmt_barebox_hook = {
.type = filetype_mips_barebox,
.exec = "bootm",
};
static int do_bootm_elf(struct image_data *data)
{
void (*entry)(int, void *);
struct elf_image *elf;
void *fdt, *buf;
int ret = 0;
buf = read_file(data->os_file, NULL);
if (!buf)
return -EINVAL;
elf = elf_load_image(buf);
if (IS_ERR(elf))
return PTR_ERR(elf);
fdt = bootm_get_devicetree(data);
if (IS_ERR(fdt)) {
ret = PTR_ERR(fdt);
goto bootm_elf_done;
}
pr_info("Starting application at 0x%08lx, dts 0x%08lx...\n",
phys_to_virt(elf->entry), data->of_root_node);
if (data->dryrun)
goto bootm_elf_done;
shutdown_barebox();
entry = (void *)elf->entry;
entry(-2, phys_to_virt((unsigned long)fdt));
pr_err("ELF application terminated\n");
ret = -EINVAL;
bootm_elf_done:
elf_release_image(elf);
free(fdt);
free(buf);
return ret;
}
static struct image_handler elf_handler = {
.name = "ELF",
.bootm = do_bootm_elf,
.filetype = filetype_elf,
};
static struct binfmt_hook binfmt_elf_hook = {
.type = filetype_elf,
.exec = "bootm",
};
static int mips_register_image_handler(void)
{
register_image_handler(&barebox_handler);
binfmt_register(&binfmt_barebox_hook);
register_image_handler(&elf_handler);
binfmt_register(&binfmt_elf_hook);
return 0;
}
late_initcall(mips_register_image_handler);
|
