Statistics
| Branch: | Revision:

root / hw / arm_boot.c @ d6698281

History | View | Annotate | Download (7.9 kB)

1 5fafdf24 ths
/*
2 16406950 pbrook
 * ARM kernel loader.
3 16406950 pbrook
 *
4 9ee6e8bb pbrook
 * Copyright (c) 2006-2007 CodeSourcery.
5 16406950 pbrook
 * Written by Paul Brook
6 16406950 pbrook
 *
7 16406950 pbrook
 * This code is licenced under the GPL.
8 16406950 pbrook
 */
9 16406950 pbrook
10 87ecb68b pbrook
#include "hw.h"
11 87ecb68b pbrook
#include "arm-misc.h"
12 87ecb68b pbrook
#include "sysemu.h"
13 ca20cf32 Blue Swirl
#include "loader.h"
14 ca20cf32 Blue Swirl
#include "elf.h"
15 16406950 pbrook
16 16406950 pbrook
#define KERNEL_ARGS_ADDR 0x100
17 16406950 pbrook
#define KERNEL_LOAD_ADDR 0x00010000
18 16406950 pbrook
#define INITRD_LOAD_ADDR 0x00800000
19 16406950 pbrook
20 16406950 pbrook
/* The worlds second smallest bootloader.  Set r0-r2, then jump to kernel.  */
21 16406950 pbrook
static uint32_t bootloader[] = {
22 16406950 pbrook
  0xe3a00000, /* mov     r0, #0 */
23 16406950 pbrook
  0xe3a01000, /* mov     r1, #0x?? */
24 16406950 pbrook
  0xe3811c00, /* orr     r1, r1, #0x??00 */
25 16406950 pbrook
  0xe59f2000, /* ldr     r2, [pc, #0] */
26 16406950 pbrook
  0xe59ff000, /* ldr     pc, [pc, #0] */
27 16406950 pbrook
  0, /* Address of kernel args.  Set by integratorcp_init.  */
28 16406950 pbrook
  0  /* Kernel entry point.  Set by integratorcp_init.  */
29 16406950 pbrook
};
30 16406950 pbrook
31 9ee6e8bb pbrook
/* Entry point for secondary CPUs.  Enable interrupt controller and
32 9ee6e8bb pbrook
   Issue WFI until start address is written to system controller.  */
33 9ee6e8bb pbrook
static uint32_t smpboot[] = {
34 9ee6e8bb pbrook
  0xe3a00201, /* mov     r0, #0x10000000 */
35 9ee6e8bb pbrook
  0xe3800601, /* orr     r0, r0, #0x001000000 */
36 9ee6e8bb pbrook
  0xe3a01001, /* mov     r1, #1 */
37 9ee6e8bb pbrook
  0xe5801100, /* str     r1, [r0, #0x100] */
38 9ee6e8bb pbrook
  0xe3a00201, /* mov     r0, #0x10000000 */
39 9ee6e8bb pbrook
  0xe3800030, /* orr     r0, #0x30 */
40 9ee6e8bb pbrook
  0xe320f003, /* wfi */
41 9ee6e8bb pbrook
  0xe5901000, /* ldr     r1, [r0] */
42 9ee6e8bb pbrook
  0xe3110003, /* tst     r1, #3 */
43 9ee6e8bb pbrook
  0x1afffffb, /* bne     <wfi> */
44 9ee6e8bb pbrook
  0xe12fff11  /* bx      r1 */
45 9ee6e8bb pbrook
};
46 9ee6e8bb pbrook
47 f3d6b95e pbrook
static void main_cpu_reset(void *opaque)
48 f3d6b95e pbrook
{
49 f3d6b95e pbrook
    CPUState *env = opaque;
50 f3d6b95e pbrook
51 f3d6b95e pbrook
    cpu_reset(env);
52 f93eb9ff balrog
    if (env->boot_info)
53 f93eb9ff balrog
        arm_load_kernel(env, env->boot_info);
54 9ee6e8bb pbrook
55 9ee6e8bb pbrook
    /* TODO:  Reset secondary CPUs.  */
56 f3d6b95e pbrook
}
57 f3d6b95e pbrook
58 52b43737 pbrook
#define WRITE_WORD(p, value) do { \
59 52b43737 pbrook
    stl_phys_notdirty(p, value);  \
60 52b43737 pbrook
    p += 4;                       \
61 52b43737 pbrook
} while (0)
62 52b43737 pbrook
63 f93eb9ff balrog
static void set_kernel_args(struct arm_boot_info *info,
64 c227f099 Anthony Liguori
                int initrd_size, target_phys_addr_t base)
65 16406950 pbrook
{
66 c227f099 Anthony Liguori
    target_phys_addr_t p;
67 16406950 pbrook
68 52b43737 pbrook
    p = base + KERNEL_ARGS_ADDR;
69 16406950 pbrook
    /* ATAG_CORE */
70 52b43737 pbrook
    WRITE_WORD(p, 5);
71 52b43737 pbrook
    WRITE_WORD(p, 0x54410001);
72 52b43737 pbrook
    WRITE_WORD(p, 1);
73 52b43737 pbrook
    WRITE_WORD(p, 0x1000);
74 52b43737 pbrook
    WRITE_WORD(p, 0);
75 16406950 pbrook
    /* ATAG_MEM */
76 f93eb9ff balrog
    /* TODO: handle multiple chips on one ATAG list */
77 52b43737 pbrook
    WRITE_WORD(p, 4);
78 52b43737 pbrook
    WRITE_WORD(p, 0x54410002);
79 52b43737 pbrook
    WRITE_WORD(p, info->ram_size);
80 52b43737 pbrook
    WRITE_WORD(p, info->loader_start);
81 16406950 pbrook
    if (initrd_size) {
82 16406950 pbrook
        /* ATAG_INITRD2 */
83 52b43737 pbrook
        WRITE_WORD(p, 4);
84 52b43737 pbrook
        WRITE_WORD(p, 0x54420005);
85 52b43737 pbrook
        WRITE_WORD(p, info->loader_start + INITRD_LOAD_ADDR);
86 52b43737 pbrook
        WRITE_WORD(p, initrd_size);
87 16406950 pbrook
    }
88 f93eb9ff balrog
    if (info->kernel_cmdline && *info->kernel_cmdline) {
89 16406950 pbrook
        /* ATAG_CMDLINE */
90 16406950 pbrook
        int cmdline_size;
91 16406950 pbrook
92 f93eb9ff balrog
        cmdline_size = strlen(info->kernel_cmdline);
93 52b43737 pbrook
        cpu_physical_memory_write(p + 8, (void *)info->kernel_cmdline,
94 52b43737 pbrook
                                  cmdline_size + 1);
95 16406950 pbrook
        cmdline_size = (cmdline_size >> 2) + 1;
96 52b43737 pbrook
        WRITE_WORD(p, cmdline_size + 2);
97 52b43737 pbrook
        WRITE_WORD(p, 0x54410009);
98 52b43737 pbrook
        p += cmdline_size * 4;
99 16406950 pbrook
    }
100 f93eb9ff balrog
    if (info->atag_board) {
101 f93eb9ff balrog
        /* ATAG_BOARD */
102 f93eb9ff balrog
        int atag_board_len;
103 52b43737 pbrook
        uint8_t atag_board_buf[0x1000];
104 f93eb9ff balrog
105 52b43737 pbrook
        atag_board_len = (info->atag_board(info, atag_board_buf) + 3) & ~3;
106 52b43737 pbrook
        WRITE_WORD(p, (atag_board_len + 8) >> 2);
107 52b43737 pbrook
        WRITE_WORD(p, 0x414f4d50);
108 52b43737 pbrook
        cpu_physical_memory_write(p, atag_board_buf, atag_board_len);
109 f93eb9ff balrog
        p += atag_board_len;
110 f93eb9ff balrog
    }
111 16406950 pbrook
    /* ATAG_END */
112 52b43737 pbrook
    WRITE_WORD(p, 0);
113 52b43737 pbrook
    WRITE_WORD(p, 0);
114 16406950 pbrook
}
115 16406950 pbrook
116 f93eb9ff balrog
static void set_kernel_args_old(struct arm_boot_info *info,
117 c227f099 Anthony Liguori
                int initrd_size, target_phys_addr_t base)
118 2b8f2d41 balrog
{
119 c227f099 Anthony Liguori
    target_phys_addr_t p;
120 52b43737 pbrook
    const char *s;
121 52b43737 pbrook
122 2b8f2d41 balrog
123 2b8f2d41 balrog
    /* see linux/include/asm-arm/setup.h */
124 52b43737 pbrook
    p = base + KERNEL_ARGS_ADDR;
125 2b8f2d41 balrog
    /* page_size */
126 52b43737 pbrook
    WRITE_WORD(p, 4096);
127 2b8f2d41 balrog
    /* nr_pages */
128 52b43737 pbrook
    WRITE_WORD(p, info->ram_size / 4096);
129 2b8f2d41 balrog
    /* ramdisk_size */
130 52b43737 pbrook
    WRITE_WORD(p, 0);
131 2b8f2d41 balrog
#define FLAG_READONLY        1
132 2b8f2d41 balrog
#define FLAG_RDLOAD        4
133 2b8f2d41 balrog
#define FLAG_RDPROMPT        8
134 2b8f2d41 balrog
    /* flags */
135 52b43737 pbrook
    WRITE_WORD(p, FLAG_READONLY | FLAG_RDLOAD | FLAG_RDPROMPT);
136 2b8f2d41 balrog
    /* rootdev */
137 52b43737 pbrook
    WRITE_WORD(p, (31 << 8) | 0);        /* /dev/mtdblock0 */
138 2b8f2d41 balrog
    /* video_num_cols */
139 52b43737 pbrook
    WRITE_WORD(p, 0);
140 2b8f2d41 balrog
    /* video_num_rows */
141 52b43737 pbrook
    WRITE_WORD(p, 0);
142 2b8f2d41 balrog
    /* video_x */
143 52b43737 pbrook
    WRITE_WORD(p, 0);
144 2b8f2d41 balrog
    /* video_y */
145 52b43737 pbrook
    WRITE_WORD(p, 0);
146 2b8f2d41 balrog
    /* memc_control_reg */
147 52b43737 pbrook
    WRITE_WORD(p, 0);
148 2b8f2d41 balrog
    /* unsigned char sounddefault */
149 2b8f2d41 balrog
    /* unsigned char adfsdrives */
150 2b8f2d41 balrog
    /* unsigned char bytes_per_char_h */
151 2b8f2d41 balrog
    /* unsigned char bytes_per_char_v */
152 52b43737 pbrook
    WRITE_WORD(p, 0);
153 2b8f2d41 balrog
    /* pages_in_bank[4] */
154 52b43737 pbrook
    WRITE_WORD(p, 0);
155 52b43737 pbrook
    WRITE_WORD(p, 0);
156 52b43737 pbrook
    WRITE_WORD(p, 0);
157 52b43737 pbrook
    WRITE_WORD(p, 0);
158 2b8f2d41 balrog
    /* pages_in_vram */
159 52b43737 pbrook
    WRITE_WORD(p, 0);
160 2b8f2d41 balrog
    /* initrd_start */
161 2b8f2d41 balrog
    if (initrd_size)
162 52b43737 pbrook
        WRITE_WORD(p, info->loader_start + INITRD_LOAD_ADDR);
163 2b8f2d41 balrog
    else
164 52b43737 pbrook
        WRITE_WORD(p, 0);
165 2b8f2d41 balrog
    /* initrd_size */
166 52b43737 pbrook
    WRITE_WORD(p, initrd_size);
167 2b8f2d41 balrog
    /* rd_start */
168 52b43737 pbrook
    WRITE_WORD(p, 0);
169 2b8f2d41 balrog
    /* system_rev */
170 52b43737 pbrook
    WRITE_WORD(p, 0);
171 2b8f2d41 balrog
    /* system_serial_low */
172 52b43737 pbrook
    WRITE_WORD(p, 0);
173 2b8f2d41 balrog
    /* system_serial_high */
174 52b43737 pbrook
    WRITE_WORD(p, 0);
175 2b8f2d41 balrog
    /* mem_fclk_21285 */
176 52b43737 pbrook
    WRITE_WORD(p, 0);
177 2b8f2d41 balrog
    /* zero unused fields */
178 52b43737 pbrook
    while (p < base + KERNEL_ARGS_ADDR + 256 + 1024) {
179 52b43737 pbrook
        WRITE_WORD(p, 0);
180 52b43737 pbrook
    }
181 52b43737 pbrook
    s = info->kernel_cmdline;
182 52b43737 pbrook
    if (s) {
183 52b43737 pbrook
        cpu_physical_memory_write(p, (void *)s, strlen(s) + 1);
184 52b43737 pbrook
    } else {
185 52b43737 pbrook
        WRITE_WORD(p, 0);
186 52b43737 pbrook
    }
187 2b8f2d41 balrog
}
188 2b8f2d41 balrog
189 f93eb9ff balrog
void arm_load_kernel(CPUState *env, struct arm_boot_info *info)
190 16406950 pbrook
{
191 16406950 pbrook
    int kernel_size;
192 16406950 pbrook
    int initrd_size;
193 16406950 pbrook
    int n;
194 1c7b3754 pbrook
    int is_linux = 0;
195 1c7b3754 pbrook
    uint64_t elf_entry;
196 c227f099 Anthony Liguori
    target_phys_addr_t entry;
197 ca20cf32 Blue Swirl
    int big_endian;
198 16406950 pbrook
199 16406950 pbrook
    /* Load the kernel.  */
200 f93eb9ff balrog
    if (!info->kernel_filename) {
201 16406950 pbrook
        fprintf(stderr, "Kernel image must be specified\n");
202 16406950 pbrook
        exit(1);
203 16406950 pbrook
    }
204 daf90626 pbrook
205 f93eb9ff balrog
    if (!env->boot_info) {
206 f93eb9ff balrog
        if (info->nb_cpus == 0)
207 f93eb9ff balrog
            info->nb_cpus = 1;
208 f93eb9ff balrog
        env->boot_info = info;
209 a08d4367 Jan Kiszka
        qemu_register_reset(main_cpu_reset, env);
210 f3d6b95e pbrook
    }
211 f93eb9ff balrog
212 ca20cf32 Blue Swirl
#ifdef TARGET_WORDS_BIGENDIAN
213 ca20cf32 Blue Swirl
    big_endian = 1;
214 ca20cf32 Blue Swirl
#else
215 ca20cf32 Blue Swirl
    big_endian = 0;
216 ca20cf32 Blue Swirl
#endif
217 ca20cf32 Blue Swirl
218 1c7b3754 pbrook
    /* Assume that raw images are linux kernels, and ELF images are not.  */
219 ca20cf32 Blue Swirl
    kernel_size = load_elf(info->kernel_filename, 0, &elf_entry, NULL, NULL,
220 ca20cf32 Blue Swirl
                           big_endian, ELF_MACHINE, 1);
221 1c7b3754 pbrook
    entry = elf_entry;
222 1c7b3754 pbrook
    if (kernel_size < 0) {
223 5a9154e0 aliguori
        kernel_size = load_uimage(info->kernel_filename, &entry, NULL,
224 5a9154e0 aliguori
                                  &is_linux);
225 1c7b3754 pbrook
    }
226 1c7b3754 pbrook
    if (kernel_size < 0) {
227 f93eb9ff balrog
        entry = info->loader_start + KERNEL_LOAD_ADDR;
228 3b760e04 pbrook
        kernel_size = load_image_targphys(info->kernel_filename, entry,
229 3b760e04 pbrook
                                          ram_size - KERNEL_LOAD_ADDR);
230 1c7b3754 pbrook
        is_linux = 1;
231 1c7b3754 pbrook
    }
232 1c7b3754 pbrook
    if (kernel_size < 0) {
233 f93eb9ff balrog
        fprintf(stderr, "qemu: could not load kernel '%s'\n",
234 f93eb9ff balrog
                info->kernel_filename);
235 1c7b3754 pbrook
        exit(1);
236 1c7b3754 pbrook
    }
237 1c7b3754 pbrook
    if (!is_linux) {
238 1c7b3754 pbrook
        /* Jump to the entry point.  */
239 daf90626 pbrook
        env->regs[15] = entry & 0xfffffffe;
240 daf90626 pbrook
        env->thumb = entry & 1;
241 daf90626 pbrook
    } else {
242 f93eb9ff balrog
        if (info->initrd_filename) {
243 3b760e04 pbrook
            initrd_size = load_image_targphys(info->initrd_filename,
244 3b760e04 pbrook
                                              info->loader_start
245 3b760e04 pbrook
                                              + INITRD_LOAD_ADDR,
246 3b760e04 pbrook
                                              ram_size - INITRD_LOAD_ADDR);
247 daf90626 pbrook
            if (initrd_size < 0) {
248 daf90626 pbrook
                fprintf(stderr, "qemu: could not load initrd '%s'\n",
249 f93eb9ff balrog
                        info->initrd_filename);
250 daf90626 pbrook
                exit(1);
251 daf90626 pbrook
            }
252 daf90626 pbrook
        } else {
253 daf90626 pbrook
            initrd_size = 0;
254 daf90626 pbrook
        }
255 f93eb9ff balrog
        bootloader[1] |= info->board_id & 0xff;
256 f93eb9ff balrog
        bootloader[2] |= (info->board_id >> 8) & 0xff;
257 f93eb9ff balrog
        bootloader[5] = info->loader_start + KERNEL_ARGS_ADDR;
258 1c7b3754 pbrook
        bootloader[6] = entry;
259 52b43737 pbrook
        for (n = 0; n < sizeof(bootloader) / 4; n++) {
260 52b43737 pbrook
            stl_phys_notdirty(info->loader_start + (n * 4), bootloader[n]);
261 52b43737 pbrook
        }
262 52b43737 pbrook
        if (info->nb_cpus > 1) {
263 52b43737 pbrook
            for (n = 0; n < sizeof(smpboot) / 4; n++) {
264 52b43737 pbrook
                stl_phys_notdirty(info->smp_loader_start + (n * 4), smpboot[n]);
265 52b43737 pbrook
            }
266 52b43737 pbrook
        }
267 2b8f2d41 balrog
        if (old_param)
268 52b43737 pbrook
            set_kernel_args_old(info, initrd_size, info->loader_start);
269 2b8f2d41 balrog
        else
270 52b43737 pbrook
            set_kernel_args(info, initrd_size, info->loader_start);
271 16406950 pbrook
    }
272 16406950 pbrook
}