use std::{arch::asm, fmt};
use axvm_types::{HostPhysAddr, MappingFlags};
use page_table_generic as ptg;
bitflags::bitflags! {
#[derive(Debug)]
struct PTEFlags: u64 {
const V = 1 << 0;
const D = 1 << 1;
const PLVL = 1 << 2;
const PLVH = 1 << 3;
const MATL = 1 << 4;
const MATH = 1 << 5;
const GH = 1 << 6;
const P = 1 << 7;
const W = 1 << 8;
const G = 1 << 12;
const NR = 1 << 61;
const NX = 1 << 62;
const RPLV = 1 << 63;
}
}
impl From<PTEFlags> for MappingFlags {
fn from(flags: PTEFlags) -> Self {
if !flags.contains(PTEFlags::V) {
return Self::empty();
}
let mut ret = Self::empty();
if !flags.contains(PTEFlags::NR) {
ret |= Self::READ;
}
if flags.contains(PTEFlags::W) {
ret |= Self::WRITE;
}
if !flags.contains(PTEFlags::NX) {
ret |= Self::EXECUTE;
}
if flags.contains(PTEFlags::PLVL | PTEFlags::PLVH) {
ret |= Self::USER;
}
if !flags.contains(PTEFlags::MATL) {
if flags.contains(PTEFlags::MATH) {
ret |= Self::UNCACHED;
} else {
ret |= Self::DEVICE;
}
}
ret
}
}
impl From<MappingFlags> for PTEFlags {
fn from(flags: MappingFlags) -> Self {
if flags.is_empty() {
return Self::empty();
}
let mut ret = Self::V | Self::P;
if !flags.contains(MappingFlags::READ) {
ret |= Self::NR;
}
if flags.contains(MappingFlags::WRITE) {
ret |= Self::W | Self::D;
}
if !flags.contains(MappingFlags::EXECUTE) {
ret |= Self::NX;
}
if flags.contains(MappingFlags::USER) {
ret |= Self::PLVH | Self::PLVL;
}
if !flags.contains(MappingFlags::DEVICE) {
if flags.contains(MappingFlags::UNCACHED) {
ret |= Self::MATH;
} else {
ret |= Self::MATL;
}
}
ret
}
}
#[derive(Clone, Copy)]
#[repr(transparent)]
pub struct LoongArchPTE(u64);
impl LoongArchPTE {
const PHYS_ADDR_MASK: u64 = 0x0000_ffff_ffff_f000;
fn paddr(&self) -> HostPhysAddr {
HostPhysAddr::from((self.0 & Self::PHYS_ADDR_MASK) as usize)
}
fn flags(&self) -> MappingFlags {
PTEFlags::from_bits_truncate(self.0).into()
}
}
impl ptg::PageTableEntry for LoongArchPTE {
type PteConfig = MappingFlags;
fn new_page(paddr: HostPhysAddr, config: Self::PteConfig, is_huge: bool) -> Self {
if config.is_empty() {
return Self(0);
}
let mut flags = PTEFlags::from(config);
if is_huge {
flags |= PTEFlags::GH;
}
Self(flags.bits() | (paddr.as_usize() as u64 & Self::PHYS_ADDR_MASK))
}
fn new_table(paddr: HostPhysAddr) -> Self {
let flags = PTEFlags::V | PTEFlags::P | PTEFlags::MATL;
Self(flags.bits() | (paddr.as_usize() as u64 & Self::PHYS_ADDR_MASK))
}
fn paddr(&self, _is_dir: bool) -> HostPhysAddr {
LoongArchPTE::paddr(self)
}
fn config(&self, _is_dir: bool) -> Self::PteConfig {
self.flags()
}
fn present(&self) -> bool {
PTEFlags::from_bits_truncate(self.0).contains(PTEFlags::V)
}
fn huge(&self, is_dir: bool) -> bool {
is_dir && PTEFlags::from_bits_truncate(self.0).contains(PTEFlags::GH)
}
fn unused(&self) -> bool {
self.0 == 0
}
fn clear(&mut self) {
self.0 = 0;
}
}
impl fmt::Debug for LoongArchPTE {
fn fmt(&self, f: &mut fmt::Formatter<'_>) -> fmt::Result {
f.debug_struct("LoongArchPTE")
.field("raw", &self.0)
.field("paddr", &self.paddr())
.field("flags", &self.flags())
.finish()
}
}
#[derive(Copy, Clone)]
pub struct LoongArchPagingMetaDataL3;
impl ptg::TableMeta for LoongArchPagingMetaDataL3 {
type P = LoongArchPTE;
const PAGE_SIZE: usize = ax_memory_addr::PAGE_SIZE_4K;
const LEVEL_BITS: &[usize] = &[9, 9, 9];
const MAX_BLOCK_LEVEL: usize = 2;
const STRICT_ADDRESS_WIDTH: bool = true;
fn flush(vaddr: Option<ptg::VirtAddr>) {
unsafe {
let _ = vaddr;
asm!("invtlb 0x0, $r0, $r0");
asm!("dbar 0");
}
}
}
#[derive(Copy, Clone)]
pub struct LoongArchPagingMetaDataL4;
impl ptg::TableMeta for LoongArchPagingMetaDataL4 {
type P = LoongArchPTE;
const PAGE_SIZE: usize = ax_memory_addr::PAGE_SIZE_4K;
const LEVEL_BITS: &[usize] = &[9, 9, 9, 9];
const MAX_BLOCK_LEVEL: usize = 3;
const STRICT_ADDRESS_WIDTH: bool = true;
fn flush(vaddr: Option<ptg::VirtAddr>) {
LoongArchPagingMetaDataL3::flush(vaddr);
}
}
pub(crate) type NestedPageTable<H> =
crate::npt::LeveledPageTable<LoongArchPagingMetaDataL3, LoongArchPagingMetaDataL4, H, true>;