1 | /* |
2 | * Microblaze kernel loader |
3 | * |
4 | * Copyright (c) 2012 Peter Crosthwaite <peter.crosthwaite@petalogix.com> |
5 | * Copyright (c) 2012 PetaLogix |
6 | * Copyright (c) 2009 Edgar E. Iglesias. |
7 | * |
8 | * Permission is hereby granted, free of charge, to any person obtaining a copy |
9 | * of this software and associated documentation files (the "Software"), to deal |
10 | * in the Software without restriction, including without limitation the rights |
11 | * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell |
12 | * copies of the Software, and to permit persons to whom the Software is |
13 | * furnished to do so, subject to the following conditions: |
14 | * |
15 | * The above copyright notice and this permission notice shall be included in |
16 | * all copies or substantial portions of the Software. |
17 | * |
18 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
19 | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, |
20 | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL |
21 | * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER |
22 | * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, |
23 | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN |
24 | * THE SOFTWARE. |
25 | */ |
26 | |
27 | #include "qemu/osdep.h" |
28 | #include "qemu-common.h" |
29 | #include "cpu.h" |
30 | #include "qemu/option.h" |
31 | #include "qemu/config-file.h" |
32 | #include "qemu/error-report.h" |
33 | #include "sysemu/device_tree.h" |
34 | #include "sysemu/reset.h" |
35 | #include "sysemu/sysemu.h" |
36 | #include "hw/loader.h" |
37 | #include "elf.h" |
38 | #include "qemu/cutils.h" |
39 | |
40 | #include "boot.h" |
41 | |
42 | static struct |
43 | { |
44 | void (*machine_cpu_reset)(MicroBlazeCPU *); |
45 | uint32_t bootstrap_pc; |
46 | uint32_t cmdline; |
47 | uint32_t initrd_start; |
48 | uint32_t initrd_end; |
49 | uint32_t fdt; |
50 | } boot_info; |
51 | |
52 | static void main_cpu_reset(void *opaque) |
53 | { |
54 | MicroBlazeCPU *cpu = opaque; |
55 | CPUState *cs = CPU(cpu); |
56 | CPUMBState *env = &cpu->env; |
57 | |
58 | cpu_reset(cs); |
59 | env->regs[5] = boot_info.cmdline; |
60 | env->regs[6] = boot_info.initrd_start; |
61 | env->regs[7] = boot_info.fdt; |
62 | cpu_set_pc(cs, boot_info.bootstrap_pc); |
63 | if (boot_info.machine_cpu_reset) { |
64 | boot_info.machine_cpu_reset(cpu); |
65 | } |
66 | } |
67 | |
68 | static int microblaze_load_dtb(hwaddr addr, |
69 | uint32_t ramsize, |
70 | uint32_t initrd_start, |
71 | uint32_t initrd_end, |
72 | const char *kernel_cmdline, |
73 | const char *dtb_filename) |
74 | { |
75 | int fdt_size; |
76 | void *fdt = NULL; |
77 | int r; |
78 | |
79 | if (dtb_filename) { |
80 | fdt = load_device_tree(dtb_filename, &fdt_size); |
81 | } |
82 | if (!fdt) { |
83 | return 0; |
84 | } |
85 | |
86 | if (kernel_cmdline) { |
87 | r = qemu_fdt_setprop_string(fdt, "/chosen" , "bootargs" , |
88 | kernel_cmdline); |
89 | if (r < 0) { |
90 | fprintf(stderr, "couldn't set /chosen/bootargs\n" ); |
91 | } |
92 | } |
93 | |
94 | if (initrd_start) { |
95 | qemu_fdt_setprop_cell(fdt, "/chosen" , "linux,initrd-start" , |
96 | initrd_start); |
97 | |
98 | qemu_fdt_setprop_cell(fdt, "/chosen" , "linux,initrd-end" , |
99 | initrd_end); |
100 | } |
101 | |
102 | cpu_physical_memory_write(addr, fdt, fdt_size); |
103 | return fdt_size; |
104 | } |
105 | |
106 | static uint64_t translate_kernel_address(void *opaque, uint64_t addr) |
107 | { |
108 | return addr - 0x30000000LL; |
109 | } |
110 | |
111 | void microblaze_load_kernel(MicroBlazeCPU *cpu, hwaddr ddr_base, |
112 | uint32_t ramsize, |
113 | const char *initrd_filename, |
114 | const char *dtb_filename, |
115 | void (*machine_cpu_reset)(MicroBlazeCPU *)) |
116 | { |
117 | QemuOpts *machine_opts; |
118 | const char *kernel_filename; |
119 | const char *kernel_cmdline; |
120 | const char *dtb_arg; |
121 | char *filename = NULL; |
122 | |
123 | machine_opts = qemu_get_machine_opts(); |
124 | kernel_filename = qemu_opt_get(machine_opts, "kernel" ); |
125 | kernel_cmdline = qemu_opt_get(machine_opts, "append" ); |
126 | dtb_arg = qemu_opt_get(machine_opts, "dtb" ); |
127 | /* default to pcbios dtb as passed by machine_init */ |
128 | if (!dtb_arg && dtb_filename) { |
129 | filename = qemu_find_file(QEMU_FILE_TYPE_BIOS, dtb_filename); |
130 | } |
131 | |
132 | boot_info.machine_cpu_reset = machine_cpu_reset; |
133 | qemu_register_reset(main_cpu_reset, cpu); |
134 | |
135 | if (kernel_filename) { |
136 | int kernel_size; |
137 | uint64_t entry, low, high; |
138 | uint32_t base32; |
139 | int big_endian = 0; |
140 | |
141 | #ifdef TARGET_WORDS_BIGENDIAN |
142 | big_endian = 1; |
143 | #endif |
144 | |
145 | /* Boots a kernel elf binary. */ |
146 | kernel_size = load_elf(kernel_filename, NULL, NULL, NULL, |
147 | &entry, &low, &high, |
148 | big_endian, EM_MICROBLAZE, 0, 0); |
149 | base32 = entry; |
150 | if (base32 == 0xc0000000) { |
151 | kernel_size = load_elf(kernel_filename, NULL, |
152 | translate_kernel_address, NULL, |
153 | &entry, NULL, NULL, |
154 | big_endian, EM_MICROBLAZE, 0, 0); |
155 | } |
156 | /* Always boot into physical ram. */ |
157 | boot_info.bootstrap_pc = (uint32_t)entry; |
158 | |
159 | /* If it wasn't an ELF image, try an u-boot image. */ |
160 | if (kernel_size < 0) { |
161 | hwaddr uentry, loadaddr = LOAD_UIMAGE_LOADADDR_INVALID; |
162 | |
163 | kernel_size = load_uimage(kernel_filename, &uentry, &loadaddr, 0, |
164 | NULL, NULL); |
165 | boot_info.bootstrap_pc = uentry; |
166 | high = (loadaddr + kernel_size + 3) & ~3; |
167 | } |
168 | |
169 | /* Not an ELF image nor an u-boot image, try a RAW image. */ |
170 | if (kernel_size < 0) { |
171 | kernel_size = load_image_targphys(kernel_filename, ddr_base, |
172 | ram_size); |
173 | boot_info.bootstrap_pc = ddr_base; |
174 | high = (ddr_base + kernel_size + 3) & ~3; |
175 | } |
176 | |
177 | if (initrd_filename) { |
178 | int initrd_size; |
179 | uint32_t initrd_offset; |
180 | |
181 | high = ROUND_UP(high + kernel_size, 4); |
182 | boot_info.initrd_start = high; |
183 | initrd_offset = boot_info.initrd_start - ddr_base; |
184 | |
185 | initrd_size = load_ramdisk(initrd_filename, |
186 | boot_info.initrd_start, |
187 | ram_size - initrd_offset); |
188 | if (initrd_size < 0) { |
189 | initrd_size = load_image_targphys(initrd_filename, |
190 | boot_info.initrd_start, |
191 | ram_size - initrd_offset); |
192 | } |
193 | if (initrd_size < 0) { |
194 | error_report("could not load initrd '%s'" , |
195 | initrd_filename); |
196 | exit(EXIT_FAILURE); |
197 | } |
198 | boot_info.initrd_end = boot_info.initrd_start + initrd_size; |
199 | high = ROUND_UP(high + initrd_size, 4); |
200 | } |
201 | |
202 | boot_info.cmdline = high + 4096; |
203 | if (kernel_cmdline && strlen(kernel_cmdline)) { |
204 | pstrcpy_targphys("cmdline" , boot_info.cmdline, 256, kernel_cmdline); |
205 | } |
206 | /* Provide a device-tree. */ |
207 | boot_info.fdt = boot_info.cmdline + 4096; |
208 | microblaze_load_dtb(boot_info.fdt, ram_size, |
209 | boot_info.initrd_start, |
210 | boot_info.initrd_end, |
211 | kernel_cmdline, |
212 | /* Preference a -dtb argument */ |
213 | dtb_arg ? dtb_arg : filename); |
214 | } |
215 | g_free(filename); |
216 | } |
217 | |