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 18*06068504SSong Gao ram_addr_t initrd_offset; 19*06068504SSong Gao uint64_t initrd_size; 20*06068504SSong Gao 217e0510d7SSong Gao static const unsigned int slave_boot_code[] = { 227e0510d7SSong Gao /* Configure reset ebase. */ 237e0510d7SSong Gao 0x0400302c, /* csrwr $t0, LOONGARCH_CSR_EENTRY */ 247e0510d7SSong Gao 257e0510d7SSong Gao /* Disable interrupt. */ 267e0510d7SSong Gao 0x0380100c, /* ori $t0, $zero,0x4 */ 277e0510d7SSong Gao 0x04000180, /* csrxchg $zero, $t0, LOONGARCH_CSR_CRMD */ 287e0510d7SSong Gao 297e0510d7SSong Gao /* Clear mailbox. */ 307e0510d7SSong Gao 0x1400002d, /* lu12i.w $t1, 1(0x1) */ 317e0510d7SSong Gao 0x038081ad, /* ori $t1, $t1, CORE_BUF_20 */ 327e0510d7SSong Gao 0x06481da0, /* iocsrwr.d $zero, $t1 */ 337e0510d7SSong Gao 347e0510d7SSong Gao /* Enable IPI interrupt. */ 357e0510d7SSong Gao 0x1400002c, /* lu12i.w $t0, 1(0x1) */ 367e0510d7SSong Gao 0x0400118c, /* csrxchg $t0, $t0, LOONGARCH_CSR_ECFG */ 377e0510d7SSong Gao 0x02fffc0c, /* addi.d $t0, $r0,-1(0xfff) */ 387e0510d7SSong Gao 0x1400002d, /* lu12i.w $t1, 1(0x1) */ 397e0510d7SSong Gao 0x038011ad, /* ori $t1, $t1, CORE_EN_OFF */ 407e0510d7SSong Gao 0x064819ac, /* iocsrwr.w $t0, $t1 */ 417e0510d7SSong Gao 0x1400002d, /* lu12i.w $t1, 1(0x1) */ 427e0510d7SSong Gao 0x038081ad, /* ori $t1, $t1, CORE_BUF_20 */ 437e0510d7SSong Gao 447e0510d7SSong Gao /* Wait for wakeup <.L11>: */ 457e0510d7SSong Gao 0x06488000, /* idle 0x0 */ 467e0510d7SSong Gao 0x03400000, /* andi $zero, $zero, 0x0 */ 477e0510d7SSong Gao 0x064809ac, /* iocsrrd.w $t0, $t1 */ 487e0510d7SSong Gao 0x43fff59f, /* beqz $t0, -12(0x7ffff4) # 48 <.L11> */ 497e0510d7SSong Gao 507e0510d7SSong Gao /* Read and clear IPI interrupt. */ 517e0510d7SSong Gao 0x1400002d, /* lu12i.w $t1, 1(0x1) */ 527e0510d7SSong Gao 0x064809ac, /* iocsrrd.w $t0, $t1 */ 537e0510d7SSong Gao 0x1400002d, /* lu12i.w $t1, 1(0x1) */ 547e0510d7SSong Gao 0x038031ad, /* ori $t1, $t1, CORE_CLEAR_OFF */ 557e0510d7SSong Gao 0x064819ac, /* iocsrwr.w $t0, $t1 */ 567e0510d7SSong Gao 577e0510d7SSong Gao /* Disable IPI interrupt. */ 587e0510d7SSong Gao 0x1400002c, /* lu12i.w $t0, 1(0x1) */ 597e0510d7SSong Gao 0x04001180, /* csrxchg $zero, $t0, LOONGARCH_CSR_ECFG */ 607e0510d7SSong Gao 617e0510d7SSong Gao /* Read mail buf and jump to specified entry */ 627e0510d7SSong Gao 0x1400002d, /* lu12i.w $t1, 1(0x1) */ 637e0510d7SSong Gao 0x038081ad, /* ori $t1, $t1, CORE_BUF_20 */ 647e0510d7SSong Gao 0x06480dac, /* iocsrrd.d $t0, $t1 */ 657e0510d7SSong Gao 0x00150181, /* move $ra, $t0 */ 667e0510d7SSong Gao 0x4c000020, /* jirl $zero, $ra,0 */ 677e0510d7SSong Gao }; 687e0510d7SSong Gao 69252b8e68SSong Gao static inline void *guidcpy(void *dst, const void *src) 70252b8e68SSong Gao { 71252b8e68SSong Gao return memcpy(dst, src, sizeof(efi_guid_t)); 72252b8e68SSong Gao } 73252b8e68SSong Gao 74252b8e68SSong Gao static void init_efi_boot_memmap(struct efi_system_table *systab, 75252b8e68SSong Gao void *p, void *start) 76252b8e68SSong Gao { 77252b8e68SSong Gao unsigned i; 78252b8e68SSong Gao struct efi_boot_memmap *boot_memmap = p; 79252b8e68SSong Gao efi_guid_t tbl_guid = LINUX_EFI_BOOT_MEMMAP_GUID; 80252b8e68SSong Gao 81252b8e68SSong Gao /* efi_configuration_table 1 */ 82252b8e68SSong Gao guidcpy(&systab->tables[0].guid, &tbl_guid); 83252b8e68SSong Gao systab->tables[0].table = (struct efi_configuration_table *)(p - start); 84252b8e68SSong Gao systab->nr_tables = 1; 85252b8e68SSong Gao 86252b8e68SSong Gao boot_memmap->desc_size = sizeof(efi_memory_desc_t); 87252b8e68SSong Gao boot_memmap->desc_ver = 1; 88252b8e68SSong Gao boot_memmap->map_size = 0; 89252b8e68SSong Gao 90252b8e68SSong Gao efi_memory_desc_t *map = p + sizeof(struct efi_boot_memmap); 91252b8e68SSong Gao for (i = 0; i < memmap_entries; i++) { 92252b8e68SSong Gao map = (void *)boot_memmap + sizeof(*map); 93252b8e68SSong Gao map[i].type = memmap_table[i].type; 94252b8e68SSong Gao map[i].phys_addr = ROUND_UP(memmap_table[i].address, 64 * KiB); 95252b8e68SSong Gao map[i].num_pages = ROUND_DOWN(memmap_table[i].address + 96252b8e68SSong Gao memmap_table[i].length - map[i].phys_addr, 64 * KiB); 97252b8e68SSong Gao p += sizeof(efi_memory_desc_t); 98252b8e68SSong Gao } 99252b8e68SSong Gao } 100252b8e68SSong Gao 101*06068504SSong Gao static void init_efi_initrd_table(struct efi_system_table *systab, 102*06068504SSong Gao void *p, void *start) 103*06068504SSong Gao { 104*06068504SSong Gao efi_guid_t tbl_guid = LINUX_EFI_INITRD_MEDIA_GUID; 105*06068504SSong Gao struct efi_initrd *initrd_table = p; 106*06068504SSong Gao 107*06068504SSong Gao /* efi_configuration_table 2 */ 108*06068504SSong Gao guidcpy(&systab->tables[1].guid, &tbl_guid); 109*06068504SSong Gao systab->tables[1].table = (struct efi_configuration_table *)(p - start); 110*06068504SSong Gao systab->nr_tables = 2; 111*06068504SSong Gao 112*06068504SSong Gao initrd_table->base = initrd_offset; 113*06068504SSong Gao initrd_table->size = initrd_size; 114*06068504SSong Gao } 115*06068504SSong Gao 1164216baa9SSong Gao static void init_systab(struct loongarch_boot_info *info, void *p, void *start) 1174216baa9SSong Gao { 118252b8e68SSong Gao void *bp_tables_start; 1194216baa9SSong Gao struct efi_system_table *systab = p; 1204216baa9SSong Gao 1214216baa9SSong Gao info->a2 = p - start; 1224216baa9SSong Gao 1234216baa9SSong Gao systab->hdr.signature = EFI_SYSTEM_TABLE_SIGNATURE; 1244216baa9SSong Gao systab->hdr.revision = EFI_SPECIFICATION_VERSION; 1254216baa9SSong Gao systab->hdr.revision = sizeof(struct efi_system_table), 1264216baa9SSong Gao systab->fw_revision = FW_VERSION << 16 | FW_PATCHLEVEL << 8; 1274216baa9SSong Gao systab->runtime = 0; 1284216baa9SSong Gao systab->boottime = 0; 1294216baa9SSong Gao systab->nr_tables = 0; 1304216baa9SSong Gao 1314216baa9SSong Gao p += ROUND_UP(sizeof(struct efi_system_table), 64 * KiB); 1324216baa9SSong Gao 1334216baa9SSong Gao systab->tables = p; 134252b8e68SSong Gao bp_tables_start = p; 135252b8e68SSong Gao 136252b8e68SSong Gao init_efi_boot_memmap(systab, p, start); 137252b8e68SSong Gao p += ROUND_UP(sizeof(struct efi_boot_memmap) + 138252b8e68SSong Gao sizeof(efi_memory_desc_t) * memmap_entries, 64 * KiB); 139*06068504SSong Gao init_efi_initrd_table(systab, p, start); 140*06068504SSong Gao p += ROUND_UP(sizeof(struct efi_initrd), 64 * KiB); 141252b8e68SSong Gao 142252b8e68SSong Gao systab->tables = (struct efi_configuration_table *)(bp_tables_start - start); 1434216baa9SSong Gao } 1444216baa9SSong Gao 14558ee60d2SSong Gao static void init_cmdline(struct loongarch_boot_info *info, void *p, void *start) 14658ee60d2SSong Gao { 14758ee60d2SSong Gao hwaddr cmdline_addr = p - start; 14858ee60d2SSong Gao 14958ee60d2SSong Gao info->a0 = 1; 15058ee60d2SSong Gao info->a1 = cmdline_addr; 15158ee60d2SSong Gao 15258ee60d2SSong Gao memcpy(p, info->kernel_cmdline, COMMAND_LINE_SIZE); 15358ee60d2SSong Gao } 15458ee60d2SSong Gao 155d771ca1cSSong Gao static uint64_t cpu_loongarch_virt_to_phys(void *opaque, uint64_t addr) 156d771ca1cSSong Gao { 157d771ca1cSSong Gao return addr & MAKE_64BIT_MASK(0, TARGET_PHYS_ADDR_SPACE_BITS); 158d771ca1cSSong Gao } 159d771ca1cSSong Gao 160d771ca1cSSong Gao static int64_t load_kernel_info(struct loongarch_boot_info *info) 161d771ca1cSSong Gao { 162*06068504SSong Gao uint64_t kernel_entry, kernel_low, kernel_high; 163d771ca1cSSong Gao ssize_t kernel_size; 164d771ca1cSSong Gao 165d771ca1cSSong Gao kernel_size = load_elf(info->kernel_filename, NULL, 166d771ca1cSSong Gao cpu_loongarch_virt_to_phys, NULL, 167d771ca1cSSong Gao &kernel_entry, &kernel_low, 168d771ca1cSSong Gao &kernel_high, NULL, 0, 169d771ca1cSSong Gao EM_LOONGARCH, 1, 0); 170d771ca1cSSong Gao 171d771ca1cSSong Gao if (kernel_size < 0) { 172d771ca1cSSong Gao error_report("could not load kernel '%s': %s", 173d771ca1cSSong Gao info->kernel_filename, 174d771ca1cSSong Gao load_elf_strerror(kernel_size)); 175d771ca1cSSong Gao exit(1); 176d771ca1cSSong Gao } 17702307a67SSong Gao 17802307a67SSong Gao if (info->initrd_filename) { 17902307a67SSong Gao initrd_size = get_image_size(info->initrd_filename); 18002307a67SSong Gao if (initrd_size > 0) { 18102307a67SSong Gao initrd_offset = ROUND_UP(kernel_high + 4 * kernel_size, 64 * KiB); 18202307a67SSong Gao 18302307a67SSong Gao if (initrd_offset + initrd_size > info->ram_size) { 18402307a67SSong Gao error_report("memory too small for initial ram disk '%s'", 18502307a67SSong Gao info->initrd_filename); 18602307a67SSong Gao exit(1); 18702307a67SSong Gao } 18802307a67SSong Gao 18902307a67SSong Gao initrd_size = load_image_targphys(info->initrd_filename, initrd_offset, 19002307a67SSong Gao info->ram_size - initrd_offset); 19102307a67SSong Gao } 19202307a67SSong Gao 19302307a67SSong Gao if (initrd_size == (target_ulong)-1) { 19402307a67SSong Gao error_report("could not load initial ram disk '%s'", 19502307a67SSong Gao info->initrd_filename); 19602307a67SSong Gao exit(1); 19702307a67SSong Gao } 19802307a67SSong Gao } else { 19902307a67SSong Gao initrd_size = 0; 20002307a67SSong Gao } 20102307a67SSong Gao 202d771ca1cSSong Gao return kernel_entry; 203d771ca1cSSong Gao } 204d771ca1cSSong Gao 205d771ca1cSSong Gao static void reset_load_elf(void *opaque) 206d771ca1cSSong Gao { 207d771ca1cSSong Gao LoongArchCPU *cpu = opaque; 208d771ca1cSSong Gao CPULoongArchState *env = &cpu->env; 209d771ca1cSSong Gao 210d771ca1cSSong Gao cpu_reset(CPU(cpu)); 211d771ca1cSSong Gao if (env->load_elf) { 21258ee60d2SSong Gao if (cpu == LOONGARCH_CPU(first_cpu)) { 21358ee60d2SSong Gao env->gpr[4] = env->boot_info->a0; 21458ee60d2SSong Gao env->gpr[5] = env->boot_info->a1; 2154216baa9SSong Gao env->gpr[6] = env->boot_info->a2; 21658ee60d2SSong Gao } 217d771ca1cSSong Gao cpu_set_pc(CPU(cpu), env->elf_address); 218d771ca1cSSong Gao } 219d771ca1cSSong Gao } 220d771ca1cSSong Gao 221d771ca1cSSong Gao static void fw_cfg_add_kernel_info(struct loongarch_boot_info *info, 222d771ca1cSSong Gao FWCfgState *fw_cfg) 223d771ca1cSSong Gao { 224d771ca1cSSong Gao /* 225d771ca1cSSong Gao * Expose the kernel, the command line, and the initrd in fw_cfg. 226d771ca1cSSong Gao * We don't process them here at all, it's all left to the 227d771ca1cSSong Gao * firmware. 228d771ca1cSSong Gao */ 229d771ca1cSSong Gao load_image_to_fw_cfg(fw_cfg, 230d771ca1cSSong Gao FW_CFG_KERNEL_SIZE, FW_CFG_KERNEL_DATA, 231d771ca1cSSong Gao info->kernel_filename, 232d771ca1cSSong Gao false); 233d771ca1cSSong Gao 234d771ca1cSSong Gao if (info->initrd_filename) { 235d771ca1cSSong Gao load_image_to_fw_cfg(fw_cfg, 236d771ca1cSSong Gao FW_CFG_INITRD_SIZE, FW_CFG_INITRD_DATA, 237d771ca1cSSong Gao info->initrd_filename, false); 238d771ca1cSSong Gao } 239d771ca1cSSong Gao 240d771ca1cSSong Gao if (info->kernel_cmdline) { 241d771ca1cSSong Gao fw_cfg_add_i32(fw_cfg, FW_CFG_CMDLINE_SIZE, 242d771ca1cSSong Gao strlen(info->kernel_cmdline) + 1); 243d771ca1cSSong Gao fw_cfg_add_string(fw_cfg, FW_CFG_CMDLINE_DATA, 244d771ca1cSSong Gao info->kernel_cmdline); 245d771ca1cSSong Gao } 246d771ca1cSSong Gao } 247d771ca1cSSong Gao 248d771ca1cSSong Gao static void loongarch_firmware_boot(LoongArchMachineState *lams, 249d771ca1cSSong Gao struct loongarch_boot_info *info) 250d771ca1cSSong Gao { 251d771ca1cSSong Gao fw_cfg_add_kernel_info(info, lams->fw_cfg); 252d771ca1cSSong Gao } 253d771ca1cSSong Gao 25458ee60d2SSong Gao static void init_boot_rom(struct loongarch_boot_info *info, void *p) 25558ee60d2SSong Gao { 25658ee60d2SSong Gao void *start = p; 25758ee60d2SSong Gao 25858ee60d2SSong Gao init_cmdline(info, p, start); 25958ee60d2SSong Gao p += COMMAND_LINE_SIZE; 2604216baa9SSong Gao 2614216baa9SSong Gao init_systab(info, p, start); 26258ee60d2SSong Gao } 26358ee60d2SSong Gao 264d771ca1cSSong Gao static void loongarch_direct_kernel_boot(struct loongarch_boot_info *info) 265d771ca1cSSong Gao { 26658ee60d2SSong Gao void *p, *bp; 267d771ca1cSSong Gao int64_t kernel_addr = 0; 268d771ca1cSSong Gao LoongArchCPU *lacpu; 269d771ca1cSSong Gao CPUState *cs; 270d771ca1cSSong Gao 271d771ca1cSSong Gao if (info->kernel_filename) { 272d771ca1cSSong Gao kernel_addr = load_kernel_info(info); 273d771ca1cSSong Gao } else { 274d771ca1cSSong Gao if(!qtest_enabled()) { 275d771ca1cSSong Gao error_report("Need kernel filename\n"); 276d771ca1cSSong Gao exit(1); 277d771ca1cSSong Gao } 278d771ca1cSSong Gao } 279d771ca1cSSong Gao 28058ee60d2SSong Gao /* Load cmdline and system tables at [0 - 1 MiB] */ 28158ee60d2SSong Gao p = g_malloc0(1 * MiB); 28258ee60d2SSong Gao bp = p; 28358ee60d2SSong Gao init_boot_rom(info, p); 28458ee60d2SSong Gao rom_add_blob_fixed_as("boot_info", bp, 1 * MiB, 0, &address_space_memory); 28558ee60d2SSong Gao 2867e0510d7SSong Gao /* Load slave boot code at pflash0 . */ 2877e0510d7SSong Gao void *boot_code = g_malloc0(VIRT_FLASH0_SIZE); 2887e0510d7SSong Gao memcpy(boot_code, &slave_boot_code, sizeof(slave_boot_code)); 2897e0510d7SSong Gao rom_add_blob_fixed("boot_code", boot_code, VIRT_FLASH0_SIZE, VIRT_FLASH0_BASE); 2907e0510d7SSong Gao 291d771ca1cSSong Gao CPU_FOREACH(cs) { 292d771ca1cSSong Gao lacpu = LOONGARCH_CPU(cs); 293d771ca1cSSong Gao lacpu->env.load_elf = true; 2947e0510d7SSong Gao if (cs == first_cpu) { 295d771ca1cSSong Gao lacpu->env.elf_address = kernel_addr; 2967e0510d7SSong Gao } else { 2977e0510d7SSong Gao lacpu->env.elf_address = VIRT_FLASH0_BASE; 298d771ca1cSSong Gao } 2997e0510d7SSong Gao lacpu->env.boot_info = info; 3007e0510d7SSong Gao } 3017e0510d7SSong Gao 3027e0510d7SSong Gao g_free(boot_code); 30358ee60d2SSong Gao g_free(bp); 304d771ca1cSSong Gao } 305d771ca1cSSong Gao 306d771ca1cSSong Gao void loongarch_load_kernel(MachineState *ms, struct loongarch_boot_info *info) 307d771ca1cSSong Gao { 308d771ca1cSSong Gao LoongArchMachineState *lams = LOONGARCH_MACHINE(ms); 309d771ca1cSSong Gao int i; 310d771ca1cSSong Gao 311d771ca1cSSong Gao /* register reset function */ 312d771ca1cSSong Gao for (i = 0; i < ms->smp.cpus; i++) { 313d771ca1cSSong Gao qemu_register_reset(reset_load_elf, LOONGARCH_CPU(qemu_get_cpu(i))); 314d771ca1cSSong Gao } 315d771ca1cSSong Gao 316d771ca1cSSong Gao info->kernel_filename = ms->kernel_filename; 317d771ca1cSSong Gao info->kernel_cmdline = ms->kernel_cmdline; 318d771ca1cSSong Gao info->initrd_filename = ms->initrd_filename; 319d771ca1cSSong Gao 320d771ca1cSSong Gao if (lams->bios_loaded) { 321d771ca1cSSong Gao loongarch_firmware_boot(lams, info); 322d771ca1cSSong Gao } else { 323d771ca1cSSong Gao loongarch_direct_kernel_boot(info); 324d771ca1cSSong Gao } 325d771ca1cSSong Gao } 326