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" 29d94e7434SPeter A. G. Crosthwaite #include "qemu-common.h" 309c17d615SPaolo Bonzini #include "sysemu/device_tree.h" 317bccd940SMarkus Armbruster #include "sysemu/sysemu.h" 3283c9f4caSPaolo Bonzini #include "hw/loader.h" 33d94e7434SPeter A. G. Crosthwaite #include "elf.h" 34d94e7434SPeter A. G. Crosthwaite 3547b43a1fSPaolo Bonzini #include "boot.h" 36d94e7434SPeter A. G. Crosthwaite 37d94e7434SPeter A. G. Crosthwaite static struct 38d94e7434SPeter A. G. Crosthwaite { 39bf494367SAndreas Färber void (*machine_cpu_reset)(MicroBlazeCPU *); 40d94e7434SPeter A. G. Crosthwaite uint32_t bootstrap_pc; 41d94e7434SPeter A. G. Crosthwaite uint32_t cmdline; 42d94e7434SPeter A. G. Crosthwaite uint32_t fdt; 43d94e7434SPeter A. G. Crosthwaite } boot_info; 44d94e7434SPeter A. G. Crosthwaite 45d94e7434SPeter A. G. Crosthwaite static void main_cpu_reset(void *opaque) 46d94e7434SPeter A. G. Crosthwaite { 47bf494367SAndreas Färber MicroBlazeCPU *cpu = opaque; 48bf494367SAndreas Färber CPUMBState *env = &cpu->env; 49d94e7434SPeter A. G. Crosthwaite 50bf494367SAndreas Färber cpu_reset(CPU(cpu)); 51d94e7434SPeter A. G. Crosthwaite env->regs[5] = boot_info.cmdline; 52d94e7434SPeter A. G. Crosthwaite env->regs[7] = boot_info.fdt; 53d94e7434SPeter A. G. Crosthwaite env->sregs[SR_PC] = boot_info.bootstrap_pc; 54d94e7434SPeter A. G. Crosthwaite if (boot_info.machine_cpu_reset) { 55bf494367SAndreas Färber boot_info.machine_cpu_reset(cpu); 56d94e7434SPeter A. G. Crosthwaite } 57d94e7434SPeter A. G. Crosthwaite } 58d94e7434SPeter A. G. Crosthwaite 59a8170e5eSAvi Kivity static int microblaze_load_dtb(hwaddr addr, 60d94e7434SPeter A. G. Crosthwaite uint32_t ramsize, 61d94e7434SPeter A. G. Crosthwaite const char *kernel_cmdline, 62d94e7434SPeter A. G. Crosthwaite const char *dtb_filename) 63d94e7434SPeter A. G. Crosthwaite { 64d94e7434SPeter A. G. Crosthwaite int fdt_size; 65da71ebd1SPeter A. G. Crosthwaite void *fdt = NULL; 66d94e7434SPeter A. G. Crosthwaite int r; 67d94e7434SPeter A. G. Crosthwaite 68da71ebd1SPeter A. G. Crosthwaite if (dtb_filename) { 69da71ebd1SPeter A. G. Crosthwaite fdt = load_device_tree(dtb_filename, &fdt_size); 70d94e7434SPeter A. G. Crosthwaite } 71d94e7434SPeter A. G. Crosthwaite if (!fdt) { 72d94e7434SPeter A. G. Crosthwaite return 0; 73d94e7434SPeter A. G. Crosthwaite } 74d94e7434SPeter A. G. Crosthwaite 75d94e7434SPeter A. G. Crosthwaite if (kernel_cmdline) { 76d94e7434SPeter A. G. Crosthwaite r = qemu_devtree_setprop_string(fdt, "/chosen", "bootargs", 77d94e7434SPeter A. G. Crosthwaite kernel_cmdline); 78d94e7434SPeter A. G. Crosthwaite if (r < 0) { 79d94e7434SPeter A. G. Crosthwaite fprintf(stderr, "couldn't set /chosen/bootargs\n"); 80d94e7434SPeter A. G. Crosthwaite } 81d94e7434SPeter A. G. Crosthwaite } 82d94e7434SPeter A. G. Crosthwaite 83e1fe50dcSStefan Weil cpu_physical_memory_write(addr, fdt, fdt_size); 84d94e7434SPeter A. G. Crosthwaite return fdt_size; 85d94e7434SPeter A. G. Crosthwaite } 86d94e7434SPeter A. G. Crosthwaite 87d94e7434SPeter A. G. Crosthwaite static uint64_t translate_kernel_address(void *opaque, uint64_t addr) 88d94e7434SPeter A. G. Crosthwaite { 89d94e7434SPeter A. G. Crosthwaite return addr - 0x30000000LL; 90d94e7434SPeter A. G. Crosthwaite } 91d94e7434SPeter A. G. Crosthwaite 92a8170e5eSAvi Kivity void microblaze_load_kernel(MicroBlazeCPU *cpu, hwaddr ddr_base, 93d94e7434SPeter A. G. Crosthwaite uint32_t ramsize, const char *dtb_filename, 94bf494367SAndreas Färber void (*machine_cpu_reset)(MicroBlazeCPU *)) 95d94e7434SPeter A. G. Crosthwaite { 96d94e7434SPeter A. G. Crosthwaite QemuOpts *machine_opts; 977bccd940SMarkus Armbruster const char *kernel_filename; 987bccd940SMarkus Armbruster const char *kernel_cmdline; 99da71ebd1SPeter A. G. Crosthwaite const char *dtb_arg; 1007bccd940SMarkus Armbruster 1017bccd940SMarkus Armbruster machine_opts = qemu_get_machine_opts(); 102d94e7434SPeter A. G. Crosthwaite kernel_filename = qemu_opt_get(machine_opts, "kernel"); 103d94e7434SPeter A. G. Crosthwaite kernel_cmdline = qemu_opt_get(machine_opts, "append"); 104da71ebd1SPeter A. G. Crosthwaite dtb_arg = qemu_opt_get(machine_opts, "dtb"); 105da71ebd1SPeter A. G. Crosthwaite if (dtb_arg) { /* Preference a -dtb argument */ 106da71ebd1SPeter A. G. Crosthwaite dtb_filename = dtb_arg; 107da71ebd1SPeter A. G. Crosthwaite } else { /* default to pcbios dtb as passed by machine_init */ 108da71ebd1SPeter A. G. Crosthwaite dtb_filename = qemu_find_file(QEMU_FILE_TYPE_BIOS, dtb_filename); 109da71ebd1SPeter A. G. Crosthwaite } 110d94e7434SPeter A. G. Crosthwaite 111d94e7434SPeter A. G. Crosthwaite boot_info.machine_cpu_reset = machine_cpu_reset; 112bf494367SAndreas Färber qemu_register_reset(main_cpu_reset, cpu); 113d94e7434SPeter A. G. Crosthwaite 114d94e7434SPeter A. G. Crosthwaite if (kernel_filename) { 115d94e7434SPeter A. G. Crosthwaite int kernel_size; 116d94e7434SPeter A. G. Crosthwaite uint64_t entry, low, high; 117d94e7434SPeter A. G. Crosthwaite uint32_t base32; 118d94e7434SPeter A. G. Crosthwaite int big_endian = 0; 119d94e7434SPeter A. G. Crosthwaite 120d94e7434SPeter A. G. Crosthwaite #ifdef TARGET_WORDS_BIGENDIAN 121d94e7434SPeter A. G. Crosthwaite big_endian = 1; 122d94e7434SPeter A. G. Crosthwaite #endif 123d94e7434SPeter A. G. Crosthwaite 124d94e7434SPeter A. G. Crosthwaite /* Boots a kernel elf binary. */ 125d94e7434SPeter A. G. Crosthwaite kernel_size = load_elf(kernel_filename, NULL, NULL, 126d94e7434SPeter A. G. Crosthwaite &entry, &low, &high, 127d94e7434SPeter A. G. Crosthwaite big_endian, ELF_MACHINE, 0); 128d94e7434SPeter A. G. Crosthwaite base32 = entry; 129d94e7434SPeter A. G. Crosthwaite if (base32 == 0xc0000000) { 130d94e7434SPeter A. G. Crosthwaite kernel_size = load_elf(kernel_filename, translate_kernel_address, 131d94e7434SPeter A. G. Crosthwaite NULL, &entry, NULL, NULL, 132d94e7434SPeter A. G. Crosthwaite big_endian, ELF_MACHINE, 0); 133d94e7434SPeter A. G. Crosthwaite } 134d94e7434SPeter A. G. Crosthwaite /* Always boot into physical ram. */ 135d94e7434SPeter A. G. Crosthwaite boot_info.bootstrap_pc = ddr_base + (entry & 0x0fffffff); 136d94e7434SPeter A. G. Crosthwaite 137d94e7434SPeter A. G. Crosthwaite /* If it wasn't an ELF image, try an u-boot image. */ 138d94e7434SPeter A. G. Crosthwaite if (kernel_size < 0) { 139a8170e5eSAvi Kivity hwaddr uentry, loadaddr; 140d94e7434SPeter A. G. Crosthwaite 141d94e7434SPeter A. G. Crosthwaite kernel_size = load_uimage(kernel_filename, &uentry, &loadaddr, 0); 142d94e7434SPeter A. G. Crosthwaite boot_info.bootstrap_pc = uentry; 143d94e7434SPeter A. G. Crosthwaite high = (loadaddr + kernel_size + 3) & ~3; 144d94e7434SPeter A. G. Crosthwaite } 145d94e7434SPeter A. G. Crosthwaite 146d94e7434SPeter A. G. Crosthwaite /* Not an ELF image nor an u-boot image, try a RAW image. */ 147d94e7434SPeter A. G. Crosthwaite if (kernel_size < 0) { 148d94e7434SPeter A. G. Crosthwaite kernel_size = load_image_targphys(kernel_filename, ddr_base, 149d94e7434SPeter A. G. Crosthwaite ram_size); 150d94e7434SPeter A. G. Crosthwaite boot_info.bootstrap_pc = ddr_base; 151d94e7434SPeter A. G. Crosthwaite high = (ddr_base + kernel_size + 3) & ~3; 152d94e7434SPeter A. G. Crosthwaite } 153d94e7434SPeter A. G. Crosthwaite 154d94e7434SPeter A. G. Crosthwaite boot_info.cmdline = high + 4096; 155d94e7434SPeter A. G. Crosthwaite if (kernel_cmdline && strlen(kernel_cmdline)) { 156d94e7434SPeter A. G. Crosthwaite pstrcpy_targphys("cmdline", boot_info.cmdline, 256, kernel_cmdline); 157d94e7434SPeter A. G. Crosthwaite } 158d94e7434SPeter A. G. Crosthwaite /* Provide a device-tree. */ 159d94e7434SPeter A. G. Crosthwaite boot_info.fdt = boot_info.cmdline + 4096; 160*d0b022a0SEdgar E. Iglesias microblaze_load_dtb(boot_info.fdt, ram_size, 161*d0b022a0SEdgar E. Iglesias kernel_cmdline, 162d94e7434SPeter A. G. Crosthwaite dtb_filename); 163d94e7434SPeter A. G. Crosthwaite } 164d94e7434SPeter A. G. Crosthwaite 165d94e7434SPeter A. G. Crosthwaite } 166