use memory_addr::VirtAddr;
use riscv::register::sstatus::Sstatus;
#[cfg(feature = "fp-simd")]
use riscv::register::sstatus::FS;
use crate::{GeneralRegisters, TrapFrame};
pub struct UspaceContext(TrapFrame);
impl UspaceContext {
pub const fn empty() -> Self {
unsafe { core::mem::MaybeUninit::zeroed().assume_init() }
}
pub fn new(entry: usize, ustack_top: VirtAddr, arg0: usize) -> Self {
let mut sstatus = Sstatus::from_bits(0);
sstatus.set_spie(true); sstatus.set_sum(true); #[cfg(feature = "fp-simd")]
{
sstatus.set_fs(FS::Initial); }
Self(TrapFrame {
regs: GeneralRegisters {
a0: arg0,
sp: ustack_top.as_usize(),
..Default::default()
},
sepc: entry,
sstatus,
})
}
pub const fn from(trap_frame: &TrapFrame) -> Self {
Self(*trap_frame)
}
pub const fn get_ip(&self) -> usize {
self.0.sepc
}
pub const fn get_sp(&self) -> usize {
self.0.regs.sp
}
pub const fn set_ip(&mut self, pc: usize) {
self.0.sepc = pc;
}
pub const fn set_sp(&mut self, sp: usize) {
self.0.regs.sp = sp;
}
pub const fn set_retval(&mut self, a0: usize) {
self.0.regs.a0 = a0;
}
pub unsafe fn enter_uspace(&self, kstack_top: VirtAddr) -> ! {
use riscv::register::{sepc, sscratch};
crate::asm::disable_irqs();
let kernel_trap_addr = kstack_top.as_usize() - core::mem::size_of::<TrapFrame>();
unsafe {
sscratch::write(kstack_top.as_usize());
sepc::write(self.0.sepc);
core::arch::asm!(
include_asm_macros!(),
"
mv sp, {tf}
STR gp, {kernel_trap_addr}, 3
LDR gp, sp, 3
STR tp, {kernel_trap_addr}, 4
LDR tp, sp, 4
LDR t0, sp, 33
csrw sstatus, t0
POP_GENERAL_REGS
LDR sp, sp, 2
sret",
tf = in(reg) &(self.0),
kernel_trap_addr = in(reg) kernel_trap_addr,
options(noreturn),
)
}
}
}