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