124 lines
3.2 KiB
Rust
124 lines
3.2 KiB
Rust
use core::ptr::NonNull;
|
|
|
|
mod ecah;
|
|
mod mem;
|
|
|
|
use {
|
|
crate::{arch, ipc::buffer::IpcBuffer, kmain::IPC_BUFFERS},
|
|
alloc::boxed::Box,
|
|
core::{default, future::Future, marker::PhantomData, task::Poll},
|
|
hbvm::{
|
|
mem::{
|
|
softpaging::{icache::ICache, HandlePageFault, SoftPagedMem},
|
|
Address, Memory,
|
|
},
|
|
VmRunError, VmRunOk,
|
|
},
|
|
log::{debug, error, info, trace, warn},
|
|
};
|
|
|
|
const TIMER_QUOTIENT: usize = 100;
|
|
type Vm = hbvm::Vm<mem::Memory, TIMER_QUOTIENT>;
|
|
|
|
pub struct ExecThread<'p> {
|
|
vm: Vm,
|
|
stack_top: *mut u8,
|
|
_phantom: PhantomData<&'p [u8]>,
|
|
}
|
|
|
|
unsafe impl<'p> Send for ExecThread<'p> {}
|
|
impl<'p> ExecThread<'p> {
|
|
pub fn set_arguments(&mut self, ptr: u64, length: u64) {
|
|
self.vm.registers[1] = hbvm::value::Value(ptr);
|
|
self.vm.registers[2] = hbvm::value::Value(length);
|
|
}
|
|
|
|
pub unsafe fn new(program: &'p [u8], entrypoint: Address) -> Self {
|
|
let mut vm = unsafe {
|
|
Vm::new(
|
|
mem::Memory,
|
|
Address::new(program.as_ptr() as u64 + entrypoint.get()),
|
|
)
|
|
};
|
|
|
|
let stack_top = allocate_stack().as_ptr();
|
|
vm.write_reg(254, stack_top as u64);
|
|
|
|
ExecThread {
|
|
vm,
|
|
stack_top,
|
|
_phantom: Default::default(),
|
|
}
|
|
}
|
|
}
|
|
|
|
impl<'p> Drop for ExecThread<'p> {
|
|
fn drop(&mut self) {
|
|
unsafe { alloc::alloc::dealloc(self.stack_top, stack_layout()) };
|
|
}
|
|
}
|
|
|
|
impl<'p> Future for ExecThread<'p> {
|
|
type Output = Result<(), VmRunError>;
|
|
|
|
fn poll(
|
|
mut self: core::pin::Pin<&mut Self>,
|
|
cx: &mut core::task::Context<'_>,
|
|
) -> Poll<Self::Output> {
|
|
match self.vm.run() {
|
|
Err(err) => {
|
|
log::error!("HBVM Error\r\nRegister dump: {:?}", self.vm.registers,);
|
|
return Poll::Ready(Err(err));
|
|
}
|
|
Ok(VmRunOk::End) => return Poll::Ready(Ok(())),
|
|
Ok(VmRunOk::Ecall) => ecah::handler(&mut self.vm),
|
|
Ok(VmRunOk::Timer) => (),
|
|
Ok(VmRunOk::Breakpoint) => {
|
|
log::error!(
|
|
"HBVM Debug breakpoint\r\nRegister dump: {:?}",
|
|
self.vm.registers,
|
|
);
|
|
}
|
|
}
|
|
|
|
cx.waker().wake_by_ref();
|
|
Poll::Pending
|
|
}
|
|
}
|
|
|
|
struct PageFaultHandler;
|
|
impl HandlePageFault for PageFaultHandler {
|
|
fn page_fault(
|
|
&mut self,
|
|
reason: hbvm::mem::MemoryAccessReason,
|
|
pagetable: &mut hbvm::mem::softpaging::paging::PageTable,
|
|
vaddr: hbvm::mem::Address,
|
|
size: hbvm::mem::softpaging::PageSize,
|
|
dataptr: *mut u8,
|
|
) -> bool
|
|
where
|
|
Self: Sized,
|
|
{
|
|
log::error!(
|
|
"REASON: {reason} \
|
|
vaddr: {vaddr} \
|
|
size: {size:?} \
|
|
Dataptr {dataptr:p}",
|
|
);
|
|
|
|
false
|
|
}
|
|
}
|
|
|
|
const fn stack_layout() -> core::alloc::Layout {
|
|
unsafe { alloc::alloc::Layout::from_size_align_unchecked(1024 * 1024, 4096) }
|
|
}
|
|
|
|
fn allocate_stack() -> NonNull<u8> {
|
|
let layout = stack_layout();
|
|
match NonNull::new(unsafe { alloc::alloc::alloc_zeroed(layout) }) {
|
|
Some(ptr) => ptr,
|
|
None => alloc::alloc::handle_alloc_error(layout),
|
|
}
|
|
}
|