/* SPDX-License-Identifier: GPL-2.0-only */ #include <program_loading.h> #include <stdint.h> #include <arch/boot.h> #include <arch/encoding.h> #include <arch/smp/atomic.h> #include <console/console.h> #include <vm.h> /* Run OpenSBI and let OpenSBI hand over control to the payload */ void run_payload_opensbi(struct prog *prog, void *fdt, struct prog *opensbi, int payload_mode) { int hart_id = read_csr(mhartid); uintptr_t status = read_csr(mstatus); status = INSERT_FIELD(status, MSTATUS_MPIE, 0); /* * In case of OpenSBI we always run it in M-Mode. * OpenSBI will switch to payload_mode when done. */ status = INSERT_FIELD(status, MSTATUS_MPP, PRV_M); /* Trap vector base address point to the payload */ write_csr(mtvec, prog_entry(opensbi)); /* disable M-Mode interrupt */ write_csr(mie, 0); write_csr(mstatus, status); run_opensbi(hart_id, fdt, prog_entry(opensbi), prog_entry(prog), payload_mode); } /* Runs the payload without OpenSBI integration */ void run_payload(struct prog *prog, void *fdt, int payload_mode) { void (*doit)(int hart_id, void *fdt) = prog_entry(prog); int hart_id = read_csr(mhartid); uintptr_t status = read_csr(mstatus); status = INSERT_FIELD(status, MSTATUS_MPIE, 0); switch (payload_mode) { case RISCV_PAYLOAD_MODE_U: status = INSERT_FIELD(status, MSTATUS_MPP, PRV_U); /* Trap vector base address point to the payload */ write_csr(utvec, doit); /* disable U-Mode interrupt */ write_csr(uie, 0); break; case RISCV_PAYLOAD_MODE_S: status = INSERT_FIELD(status, MSTATUS_MPP, PRV_S); /* Trap vector base address point to the payload */ write_csr(stvec, doit); /* disable S-Mode interrupt */ write_csr(sie, 0); /* disable MMU */ write_csr(satp, 0); break; case RISCV_PAYLOAD_MODE_M: status = INSERT_FIELD(status, MSTATUS_MPP, PRV_M); /* Trap vector base address point to the payload */ write_csr(mtvec, doit); /* disable M-Mode interrupt */ write_csr(mie, 0); break; default: die("wrong privilege level for payload"); break; } write_csr(mstatus, status); write_csr(mepc, doit); asm volatile( "mv a0, %0\n\t" "mv a1, %1\n\t" "mret" ::"r"(hart_id), "r"(fdt) : "a0", "a1"); }