4 * Copyright (c) 2006-2007 CodeSourcery.
5 * Written by Paul Brook
7 * This code is licenced under the GPL.
12 #define KERNEL_ARGS_ADDR 0x100
13 #define KERNEL_LOAD_ADDR 0x00010000
14 #define INITRD_LOAD_ADDR 0x00800000
16 /* The worlds second smallest bootloader. Set r0-r2, then jump to kernel. */
17 static uint32_t bootloader
[] = {
18 0xe3a00000, /* mov r0, #0 */
19 0xe3a01000, /* mov r1, #0x?? */
20 0xe3811c00, /* orr r1, r1, #0x??00 */
21 0xe59f2000, /* ldr r2, [pc, #0] */
22 0xe59ff000, /* ldr pc, [pc, #0] */
23 0, /* Address of kernel args. Set by integratorcp_init. */
24 0 /* Kernel entry point. Set by integratorcp_init. */
27 /* Entry point for secondary CPUs. Enable interrupt controller and
28 Issue WFI until start address is written to system controller. */
29 static uint32_t smpboot
[] = {
30 0xe3a00201, /* mov r0, #0x10000000 */
31 0xe3800601, /* orr r0, r0, #0x001000000 */
32 0xe3a01001, /* mov r1, #1 */
33 0xe5801100, /* str r1, [r0, #0x100] */
34 0xe3a00201, /* mov r0, #0x10000000 */
35 0xe3800030, /* orr r0, #0x30 */
37 0xe5901000, /* ldr r1, [r0] */
38 0xe3110003, /* tst r1, #3 */
39 0x1afffffb, /* bne <wfi> */
40 0xe12fff11 /* bx r1 */
43 static void main_cpu_reset(void *opaque
)
45 CPUState
*env
= opaque
;
48 if (env
->kernel_filename
)
49 arm_load_kernel(env
, env
->ram_size
, env
->kernel_filename
,
50 env
->kernel_cmdline
, env
->initrd_filename
,
51 env
->board_id
, env
->loader_start
);
53 /* TODO: Reset secondary CPUs. */
56 static void set_kernel_args(uint32_t ram_size
, int initrd_size
,
57 const char *kernel_cmdline
,
58 target_phys_addr_t loader_start
)
62 p
= (uint32_t *)(phys_ram_base
+ KERNEL_ARGS_ADDR
);
65 stl_raw(p
++, 0x54410001);
71 stl_raw(p
++, 0x54410002);
72 stl_raw(p
++, ram_size
);
73 stl_raw(p
++, loader_start
);
77 stl_raw(p
++, 0x54420005);
78 stl_raw(p
++, loader_start
+ INITRD_LOAD_ADDR
);
79 stl_raw(p
++, initrd_size
);
81 if (kernel_cmdline
&& *kernel_cmdline
) {
85 cmdline_size
= strlen(kernel_cmdline
);
86 memcpy (p
+ 2, kernel_cmdline
, cmdline_size
+ 1);
87 cmdline_size
= (cmdline_size
>> 2) + 1;
88 stl_raw(p
++, cmdline_size
+ 2);
89 stl_raw(p
++, 0x54410009);
97 static void set_kernel_args_old(uint32_t ram_size
, int initrd_size
,
98 const char *kernel_cmdline
,
99 target_phys_addr_t loader_start
)
104 /* see linux/include/asm-arm/setup.h */
105 p
= (uint32_t *)(phys_ram_base
+ KERNEL_ARGS_ADDR
);
109 stl_raw(p
++, ram_size
/ 4096);
112 #define FLAG_READONLY 1
113 #define FLAG_RDLOAD 4
114 #define FLAG_RDPROMPT 8
116 stl_raw(p
++, FLAG_READONLY
| FLAG_RDLOAD
| FLAG_RDPROMPT
);
118 stl_raw(p
++, (31 << 8) | 0); /* /dev/mtdblock0 */
127 /* memc_control_reg */
129 /* unsigned char sounddefault */
130 /* unsigned char adfsdrives */
131 /* unsigned char bytes_per_char_h */
132 /* unsigned char bytes_per_char_v */
134 /* pages_in_bank[4] */
143 stl_raw(p
++, loader_start
+ INITRD_LOAD_ADDR
);
147 stl_raw(p
++, initrd_size
);
152 /* system_serial_low */
154 /* system_serial_high */
158 /* zero unused fields */
159 memset(p
, 0, 256 + 1024 -
160 (p
- ((uint32_t *)(phys_ram_base
+ KERNEL_ARGS_ADDR
))));
161 s
= phys_ram_base
+ KERNEL_ARGS_ADDR
+ 256 + 1024;
163 strcpy (s
, kernel_cmdline
);
168 void arm_load_kernel(CPUState
*env
, int ram_size
, const char *kernel_filename
,
169 const char *kernel_cmdline
, const char *initrd_filename
,
170 int board_id
, target_phys_addr_t loader_start
)
179 /* Load the kernel. */
180 if (!kernel_filename
) {
181 fprintf(stderr
, "Kernel image must be specified\n");
185 if (!env
->kernel_filename
) {
186 env
->ram_size
= ram_size
;
187 env
->kernel_filename
= kernel_filename
;
188 env
->kernel_cmdline
= kernel_cmdline
;
189 env
->initrd_filename
= initrd_filename
;
190 env
->board_id
= board_id
;
191 env
->loader_start
= loader_start
;
192 qemu_register_reset(main_cpu_reset
, env
);
194 /* Assume that raw images are linux kernels, and ELF images are not. */
195 kernel_size
= load_elf(kernel_filename
, 0, &elf_entry
, NULL
, NULL
);
197 if (kernel_size
< 0) {
198 kernel_size
= load_uboot(kernel_filename
, &entry
, &is_linux
);
200 if (kernel_size
< 0) {
201 kernel_size
= load_image(kernel_filename
,
202 phys_ram_base
+ KERNEL_LOAD_ADDR
);
203 entry
= loader_start
+ KERNEL_LOAD_ADDR
;
206 if (kernel_size
< 0) {
207 fprintf(stderr
, "qemu: could not load kernel '%s'\n", kernel_filename
);
211 /* Jump to the entry point. */
212 env
->regs
[15] = entry
& 0xfffffffe;
213 env
->thumb
= entry
& 1;
215 if (initrd_filename
) {
216 initrd_size
= load_image(initrd_filename
,
217 phys_ram_base
+ INITRD_LOAD_ADDR
);
218 if (initrd_size
< 0) {
219 fprintf(stderr
, "qemu: could not load initrd '%s'\n",
226 bootloader
[1] |= board_id
& 0xff;
227 bootloader
[2] |= (board_id
>> 8) & 0xff;
228 bootloader
[5] = loader_start
+ KERNEL_ARGS_ADDR
;
229 bootloader
[6] = entry
;
230 for (n
= 0; n
< sizeof(bootloader
) / 4; n
++)
231 stl_raw(phys_ram_base
+ (n
* 4), bootloader
[n
]);
232 for (n
= 0; n
< sizeof(smpboot
) / 4; n
++)
233 stl_raw(phys_ram_base
+ ram_size
+ (n
* 4), smpboot
[n
]);
235 set_kernel_args_old(ram_size
, initrd_size
,
236 kernel_cmdline
, loader_start
);
238 set_kernel_args(ram_size
, initrd_size
,
239 kernel_cmdline
, loader_start
);