use safe_mmio::{SharedMmioPointer, field_shared, fields::ReadPure};
use zerocopy::{FromBytes, Immutable, IntoBytes, KnownLayout};
use crate::utils::{concatenate_address_parts, extract_bits, get_bit};
#[derive(Debug, Clone, Copy, Eq, FromBytes, Immutable, IntoBytes, KnownLayout, PartialEq)]
#[repr(transparent)]
pub struct FailControlRegister(u32);
#[derive(Clone, Copy, Debug, Eq, PartialEq)]
pub enum FailAccessDirection {
Read,
Write,
}
impl FailControlRegister {
pub const fn direction(&self) -> FailAccessDirection {
if get_bit(self.0, 24) {
FailAccessDirection::Write
} else {
FailAccessDirection::Read
}
}
pub const fn non_secure(&self) -> bool {
get_bit(self.0, 21)
}
pub const fn privileged(&self) -> bool {
get_bit(self.0, 20)
}
}
#[derive(Debug, Clone, Copy, Eq, FromBytes, Immutable, IntoBytes, KnownLayout, PartialEq)]
#[repr(transparent)]
pub struct FailIDRegister(u32);
impl FailIDRegister {
pub const fn vnet(&self) -> u32 {
extract_bits(self.0, 27, 24)
}
pub const fn id(&self) -> u32 {
extract_bits(self.0, 23, 0)
}
}
#[derive(Debug, Clone, Eq, FromBytes, Immutable, IntoBytes, KnownLayout, PartialEq)]
#[repr(C, align(4))]
pub(crate) struct FailRegisters {
fail_address_low: ReadPure<u32>,
fail_address_high: ReadPure<u32>,
fail_control: ReadPure<FailControlRegister>,
fail_id: ReadPure<FailIDRegister>,
}
pub struct TzcFail<'regs> {
pub(crate) regs: SharedMmioPointer<'regs, FailRegisters>,
}
impl<'a> TzcFail<'a> {
pub fn fail_address(&self) -> u64 {
concatenate_address_parts(
field_shared!(self.regs, fail_address_low).read(),
field_shared!(self.regs, fail_address_high).read(),
)
}
pub fn fail_control(&self) -> FailControlRegister {
field_shared!(self.regs, fail_control).read()
}
pub fn fail_id(&self) -> FailIDRegister {
field_shared!(self.regs, fail_id).read()
}
}
#[cfg(test)]
mod tests {
use crate::{tests::FakeTZCRegisters, *};
#[test]
fn fail_oob() {
let mut regs = FakeTZCRegisters::new();
regs.reg_write(0x008, 0b0000_0000_0000_0010_0000_0000_0000_0000);
let tzc = regs.tzc_for_test();
assert!(tzc.filter_failure(2).is_none());
assert!(tzc.filter_failure(3).is_none());
assert!(tzc.filter_failure(4).is_none());
assert!(tzc.filter_failure(18).is_none());
}
#[test]
pub fn fail_address() {
let mut regs = FakeTZCRegisters::new();
regs.reg_write(0x000, 0b0000_0011_0000_0000_0010_1111_0000_1000);
for i in 0..4 {
regs.reg_write(0x020 + i * 0x10, 0xabcd_0000);
regs.reg_write(0x024 + i * 0x10, 0xfc00 | i as u32);
}
let tzc = regs.tzc_for_test();
for i in 0..4 {
assert_eq!(
tzc.filter_failure(i).unwrap().fail_address(),
0xfc00_abcd_0000 | ((i as u64) << 32),
);
}
}
#[test]
fn fail_control() {
let mut regs = FakeTZCRegisters::new();
regs.reg_write(0x000, 0b0000_0011_0000_0000_0010_1111_0000_1000);
regs.reg_write(0x028, 0b0000_0001_0010_0000_0000_0000_0000_0000);
regs.reg_write(0x038, 0b0000_0000_0011_0000_0000_0000_0000_0000);
regs.reg_write(0x048, 0b0000_0001_0000_0000_0000_0000_0000_0000);
regs.reg_write(0x058, 0b0000_0000_0001_0000_0000_0000_0000_0000);
let tzc = regs.tzc_for_test();
let fc0 = tzc.filter_failure(0).unwrap().fail_control();
let fc1 = tzc.filter_failure(1).unwrap().fail_control();
let fc2 = tzc.filter_failure(2).unwrap().fail_control();
let fc3 = tzc.filter_failure(3).unwrap().fail_control();
assert_eq!(fc0.direction(), FailAccessDirection::Write);
assert!(!fc0.privileged());
assert!(fc0.non_secure());
assert_eq!(fc1.direction(), FailAccessDirection::Read);
assert!(fc1.privileged());
assert!(fc1.non_secure());
assert_eq!(fc2.direction(), FailAccessDirection::Write);
assert!(!fc2.privileged());
assert!(!fc2.non_secure());
assert_eq!(fc3.direction(), FailAccessDirection::Read);
assert!(fc3.privileged());
assert!(!fc3.non_secure());
}
#[test]
fn fail_id() {
let mut regs = FakeTZCRegisters::new();
regs.reg_write(0x000, 0b0000_0011_0000_0000_0010_1111_0000_1000);
regs.reg_write(0x02C, 0x05_00_be_ef);
regs.reg_write(0x03C, 0x02_de_ad_00);
regs.reg_write(0x04C, 0x08_ab_cd_ef);
regs.reg_write(0x05C, 0x0f_fe_d0_af);
let tzc = regs.tzc_for_test();
let fid0 = tzc.filter_failure(0).unwrap().fail_id();
let fid1 = tzc.filter_failure(1).unwrap().fail_id();
let fid2 = tzc.filter_failure(2).unwrap().fail_id();
let fid3 = tzc.filter_failure(3).unwrap().fail_id();
assert_eq!(fid0.vnet(), 5);
assert_eq!(fid0.id(), 0xbeef);
assert_eq!(fid1.vnet(), 2);
assert_eq!(fid1.id(), 0xdead00);
assert_eq!(fid2.vnet(), 8);
assert_eq!(fid2.id(), 0xabcdef);
assert_eq!(fid3.vnet(), 15);
assert_eq!(fid3.id(), 0xfed0af);
}
}