1d771ca1cSSong Gao /* SPDX-License-Identifier: GPL-2.0-or-later */ 2d771ca1cSSong Gao /* 3d771ca1cSSong Gao * LoongArch boot helper functions. 4d771ca1cSSong Gao * 5d771ca1cSSong Gao * Copyright (c) 2023 Loongson Technology Corporation Limited 6d771ca1cSSong Gao */ 7d771ca1cSSong Gao 8d771ca1cSSong Gao #include "qemu/osdep.h" 9d771ca1cSSong Gao #include "qemu/units.h" 10d771ca1cSSong Gao #include "target/loongarch/cpu.h" 11d771ca1cSSong Gao #include "hw/loongarch/virt.h" 12d771ca1cSSong Gao #include "hw/loader.h" 13d771ca1cSSong Gao #include "elf.h" 14d771ca1cSSong Gao #include "qemu/error-report.h" 15d771ca1cSSong Gao #include "sysemu/reset.h" 16d771ca1cSSong Gao #include "sysemu/qtest.h" 17d771ca1cSSong Gao 18d771ca1cSSong Gao static uint64_t cpu_loongarch_virt_to_phys(void *opaque, uint64_t addr) 19d771ca1cSSong Gao { 20d771ca1cSSong Gao return addr & MAKE_64BIT_MASK(0, TARGET_PHYS_ADDR_SPACE_BITS); 21d771ca1cSSong Gao } 22d771ca1cSSong Gao 23d771ca1cSSong Gao static int64_t load_kernel_info(struct loongarch_boot_info *info) 24d771ca1cSSong Gao { 25*02307a67SSong Gao uint64_t kernel_entry, kernel_low, kernel_high, initrd_size; 26*02307a67SSong Gao ram_addr_t initrd_offset; 27d771ca1cSSong Gao ssize_t kernel_size; 28d771ca1cSSong Gao 29d771ca1cSSong Gao kernel_size = load_elf(info->kernel_filename, NULL, 30d771ca1cSSong Gao cpu_loongarch_virt_to_phys, NULL, 31d771ca1cSSong Gao &kernel_entry, &kernel_low, 32d771ca1cSSong Gao &kernel_high, NULL, 0, 33d771ca1cSSong Gao EM_LOONGARCH, 1, 0); 34d771ca1cSSong Gao 35d771ca1cSSong Gao if (kernel_size < 0) { 36d771ca1cSSong Gao error_report("could not load kernel '%s': %s", 37d771ca1cSSong Gao info->kernel_filename, 38d771ca1cSSong Gao load_elf_strerror(kernel_size)); 39d771ca1cSSong Gao exit(1); 40d771ca1cSSong Gao } 41*02307a67SSong Gao 42*02307a67SSong Gao if (info->initrd_filename) { 43*02307a67SSong Gao initrd_size = get_image_size(info->initrd_filename); 44*02307a67SSong Gao if (initrd_size > 0) { 45*02307a67SSong Gao initrd_offset = ROUND_UP(kernel_high + 4 * kernel_size, 64 * KiB); 46*02307a67SSong Gao 47*02307a67SSong Gao if (initrd_offset + initrd_size > info->ram_size) { 48*02307a67SSong Gao error_report("memory too small for initial ram disk '%s'", 49*02307a67SSong Gao info->initrd_filename); 50*02307a67SSong Gao exit(1); 51*02307a67SSong Gao } 52*02307a67SSong Gao 53*02307a67SSong Gao initrd_size = load_image_targphys(info->initrd_filename, initrd_offset, 54*02307a67SSong Gao info->ram_size - initrd_offset); 55*02307a67SSong Gao } 56*02307a67SSong Gao 57*02307a67SSong Gao if (initrd_size == (target_ulong)-1) { 58*02307a67SSong Gao error_report("could not load initial ram disk '%s'", 59*02307a67SSong Gao info->initrd_filename); 60*02307a67SSong Gao exit(1); 61*02307a67SSong Gao } 62*02307a67SSong Gao } else { 63*02307a67SSong Gao initrd_size = 0; 64*02307a67SSong Gao } 65*02307a67SSong Gao 66d771ca1cSSong Gao return kernel_entry; 67d771ca1cSSong Gao } 68d771ca1cSSong Gao 69d771ca1cSSong Gao static void reset_load_elf(void *opaque) 70d771ca1cSSong Gao { 71d771ca1cSSong Gao LoongArchCPU *cpu = opaque; 72d771ca1cSSong Gao CPULoongArchState *env = &cpu->env; 73d771ca1cSSong Gao 74d771ca1cSSong Gao cpu_reset(CPU(cpu)); 75d771ca1cSSong Gao if (env->load_elf) { 76d771ca1cSSong Gao cpu_set_pc(CPU(cpu), env->elf_address); 77d771ca1cSSong Gao } 78d771ca1cSSong Gao } 79d771ca1cSSong Gao 80d771ca1cSSong Gao static void fw_cfg_add_kernel_info(struct loongarch_boot_info *info, 81d771ca1cSSong Gao FWCfgState *fw_cfg) 82d771ca1cSSong Gao { 83d771ca1cSSong Gao /* 84d771ca1cSSong Gao * Expose the kernel, the command line, and the initrd in fw_cfg. 85d771ca1cSSong Gao * We don't process them here at all, it's all left to the 86d771ca1cSSong Gao * firmware. 87d771ca1cSSong Gao */ 88d771ca1cSSong Gao load_image_to_fw_cfg(fw_cfg, 89d771ca1cSSong Gao FW_CFG_KERNEL_SIZE, FW_CFG_KERNEL_DATA, 90d771ca1cSSong Gao info->kernel_filename, 91d771ca1cSSong Gao false); 92d771ca1cSSong Gao 93d771ca1cSSong Gao if (info->initrd_filename) { 94d771ca1cSSong Gao load_image_to_fw_cfg(fw_cfg, 95d771ca1cSSong Gao FW_CFG_INITRD_SIZE, FW_CFG_INITRD_DATA, 96d771ca1cSSong Gao info->initrd_filename, false); 97d771ca1cSSong Gao } 98d771ca1cSSong Gao 99d771ca1cSSong Gao if (info->kernel_cmdline) { 100d771ca1cSSong Gao fw_cfg_add_i32(fw_cfg, FW_CFG_CMDLINE_SIZE, 101d771ca1cSSong Gao strlen(info->kernel_cmdline) + 1); 102d771ca1cSSong Gao fw_cfg_add_string(fw_cfg, FW_CFG_CMDLINE_DATA, 103d771ca1cSSong Gao info->kernel_cmdline); 104d771ca1cSSong Gao } 105d771ca1cSSong Gao } 106d771ca1cSSong Gao 107d771ca1cSSong Gao static void loongarch_firmware_boot(LoongArchMachineState *lams, 108d771ca1cSSong Gao struct loongarch_boot_info *info) 109d771ca1cSSong Gao { 110d771ca1cSSong Gao fw_cfg_add_kernel_info(info, lams->fw_cfg); 111d771ca1cSSong Gao } 112d771ca1cSSong Gao 113d771ca1cSSong Gao static void loongarch_direct_kernel_boot(struct loongarch_boot_info *info) 114d771ca1cSSong Gao { 115d771ca1cSSong Gao int64_t kernel_addr = 0; 116d771ca1cSSong Gao LoongArchCPU *lacpu; 117d771ca1cSSong Gao CPUState *cs; 118d771ca1cSSong Gao 119d771ca1cSSong Gao if (info->kernel_filename) { 120d771ca1cSSong Gao kernel_addr = load_kernel_info(info); 121d771ca1cSSong Gao } else { 122d771ca1cSSong Gao if(!qtest_enabled()) { 123d771ca1cSSong Gao error_report("Need kernel filename\n"); 124d771ca1cSSong Gao exit(1); 125d771ca1cSSong Gao } 126d771ca1cSSong Gao } 127d771ca1cSSong Gao 128d771ca1cSSong Gao CPU_FOREACH(cs) { 129d771ca1cSSong Gao lacpu = LOONGARCH_CPU(cs); 130d771ca1cSSong Gao lacpu->env.load_elf = true; 131d771ca1cSSong Gao lacpu->env.elf_address = kernel_addr; 132d771ca1cSSong Gao } 133d771ca1cSSong Gao } 134d771ca1cSSong Gao 135d771ca1cSSong Gao void loongarch_load_kernel(MachineState *ms, struct loongarch_boot_info *info) 136d771ca1cSSong Gao { 137d771ca1cSSong Gao LoongArchMachineState *lams = LOONGARCH_MACHINE(ms); 138d771ca1cSSong Gao int i; 139d771ca1cSSong Gao 140d771ca1cSSong Gao /* register reset function */ 141d771ca1cSSong Gao for (i = 0; i < ms->smp.cpus; i++) { 142d771ca1cSSong Gao qemu_register_reset(reset_load_elf, LOONGARCH_CPU(qemu_get_cpu(i))); 143d771ca1cSSong Gao } 144d771ca1cSSong Gao 145d771ca1cSSong Gao info->kernel_filename = ms->kernel_filename; 146d771ca1cSSong Gao info->kernel_cmdline = ms->kernel_cmdline; 147d771ca1cSSong Gao info->initrd_filename = ms->initrd_filename; 148d771ca1cSSong Gao 149d771ca1cSSong Gao if (lams->bios_loaded) { 150d771ca1cSSong Gao loongarch_firmware_boot(lams, info); 151d771ca1cSSong Gao } else { 152d771ca1cSSong Gao loongarch_direct_kernel_boot(info); 153d771ca1cSSong Gao } 154d771ca1cSSong Gao } 155