acadia/rust/lib/mammoth/src/mem.rs

use crate::cap::Capability;
use crate::syscall;
use crate::zion::ZError;
use alloc::slice;
use core::fmt::Debug;
use core::ptr::{addr_of, addr_of_mut};

#[cfg(feature = "hosted")]
use linked_list_allocator::LockedHeap;

#[cfg(feature = "hosted")]
#[global_allocator]
static ALLOCATOR: LockedHeap = LockedHeap::empty();

pub static mut CAN_ALLOC: bool = false;

#[cfg(feature = "hosted")]
pub fn init_heap() {
    // 1 MiB
    let size = 0x10_0000;
    let vmmo_cap = syscall::memory_object_create(size).expect("Failed to create memory object");
    let vaddr = syscall::address_space_map(&vmmo_cap).expect("Failed to map memory object");
    unsafe {
        ALLOCATOR.lock().init(vaddr as *mut u8, size as usize);
        CAN_ALLOC = true;
    }
}

pub struct MemoryRegion {
    mem_cap: Capability,
    virt_addr: u64,
    size: u64,
}

impl MemoryRegion {
    pub fn direct_physical(paddr: u64, size: u64) -> Result<Self, ZError> {
        let mem_cap = syscall::memory_object_direct_physical(paddr, size)?;
        let virt_addr = syscall::address_space_map(&mem_cap)?;
        Ok(Self {
            mem_cap,
            virt_addr,
            size,
        })
    }

    pub fn contiguous_physical(size: u64) -> Result<(Self, u64), ZError> {
        let (mem_cap, paddr) = syscall::memory_object_contiguous_physical(size)?;
        let virt_addr = syscall::address_space_map(&mem_cap)?;
        Ok((
            Self {
                mem_cap,
                virt_addr,
                size,
            },
            paddr,
        ))
    }

    pub fn from_cap(mem_cap: Capability) -> Result<Self, ZError> {
        let virt_addr = syscall::address_space_map(&mem_cap)?;
        let size = syscall::memory_object_inspect(&mem_cap)?;
        Ok(Self {
            mem_cap,
            virt_addr,
            size,
        })
    }

    pub fn new(size: u64) -> Result<Self, ZError> {
        let mem_cap = syscall::memory_object_create(size)?;
        let virt_addr = syscall::address_space_map(&mem_cap)?;
        Ok(Self {
            mem_cap,
            virt_addr,
            size,
        })
    }

    pub fn slice<T>(&self) -> &[T] {
        unsafe {
            slice::from_raw_parts(
                self.virt_addr as *const T,
                self.size as usize / size_of::<T>(),
            )
        }
    }

    pub fn mut_slice<T>(&self) -> &mut [T] {
        unsafe {
            slice::from_raw_parts_mut(
                self.virt_addr as *mut T,
                self.size as usize / size_of::<T>(),
            )
        }
    }

    pub fn cap(&self) -> &Capability {
        &self.mem_cap
    }

    pub fn duplicate(&self, offset: u64, length: u64) -> Result<Capability, ZError> {
        syscall::memory_obj_duplicate(&self.mem_cap, offset, length)
    }
}

impl Drop for MemoryRegion {
    fn drop(&mut self) {
        // FIXME: We shouldn't have to do this manual adjustment.
        let mut max = self.virt_addr + self.size;
        if (max & 0xFFF) != 0 {
            max += 0x1000 - (max & 0xFFF);
        }
        syscall::address_space_unmap(self.virt_addr, max).expect("Failed to unmap memory");
    }
}

pub struct Volatile<T> {
    /// TODO: This should maybe be MaybeUninit.
    data: T,
}

impl<T> Volatile<T> {
    pub fn read(&self) -> T
    where
        T: Copy,
    {
        unsafe { addr_of!(self.data).cast::<T>().read_volatile() }
    }

    pub fn write(&mut self, data: T) {
        unsafe {
            addr_of_mut!(self.data).cast::<T>().write_volatile(data);
        }
    }

    pub fn update<F>(&mut self, func: F)
    where
        T: Copy,
        F: Fn(&mut T),
    {
        let mut data = self.read();
        func(&mut data);
        self.write(data);
    }
}

impl<T> Debug for Volatile<T>
where
    T: Debug + Copy,
{
    fn fmt(&self, f: &mut core::fmt::Formatter<'_>) -> core::fmt::Result {
        write!(f, "{:?}", self.read())
    }
}

pub fn map_cap_and_leak(mem_cap: Capability) -> u64 {
    let vaddr = syscall::address_space_map(&mem_cap).unwrap();
    mem_cap.release();
    vaddr
}

pub fn map_direct_physical_and_leak(paddr: u64, size: u64) -> u64 {
    let mem_cap = syscall::memory_object_direct_physical(paddr, size).unwrap();
    let vaddr = syscall::address_space_map(&mem_cap).unwrap();
    mem_cap.release();
    vaddr
}

pub fn map_physical_and_leak(size: u64) -> (u64, u64) {
    let (mem_cap, paddr) = syscall::memory_object_contiguous_physical(size).unwrap();
    let vaddr = syscall::address_space_map(&mem_cap).unwrap();
    mem_cap.release();
    (vaddr, paddr)
}