#![allow(non_snake_case)]
use crate::architecture::arm::{
ArmError, DapAccess, FullyQualifiedApAddress,
ap::{
AccessPortType, AddressIncrement, ApAccess, ApRegAccess, ApRegister, CFG, DataSize,
define_ap_register,
},
};
#[derive(Debug)]
pub struct AmbaApb2Apb3 {
address: FullyQualifiedApAddress,
csw: CSW,
cfg: CFG,
}
impl AmbaApb2Apb3 {
pub fn new<P: DapAccess>(
probe: &mut P,
address: FullyQualifiedApAddress,
) -> Result<Self, ArmError> {
let csw = probe.read_raw_ap_register(&address, CSW::ADDRESS)?;
let cfg = probe.read_raw_ap_register(&address, CFG::ADDRESS)?;
let (csw, cfg) = (csw.try_into()?, cfg.try_into()?);
let me = Self { address, csw, cfg };
let mut csw = me.csw;
csw.set_DbgSwEnable(true);
csw.set_AddrInc(AddressIncrement::Single);
probe.write_ap_register(&me, csw)?;
Ok(Self { csw, ..me })
}
}
impl super::MemoryApType for AmbaApb2Apb3 {
type CSW = CSW;
fn status<P: ApAccess + ?Sized>(&mut self, probe: &mut P) -> Result<CSW, ArmError> {
const { assert!(crate::architecture::arm::ap::CSW::ADDRESS == CSW::ADDRESS) };
self.csw = probe.read_ap_register(self)?;
Ok(self.csw)
}
fn try_set_datasize<P: ApAccess + ?Sized>(
&mut self,
_probe: &mut P,
data_size: DataSize,
) -> Result<(), ArmError> {
match data_size {
DataSize::U32 => Ok(()),
_ => Err(ArmError::UnsupportedTransferWidth(
data_size.to_byte_count() * 8,
)),
}
}
fn has_large_address_extension(&self) -> bool {
self.cfg.LA()
}
fn has_large_data_extension(&self) -> bool {
self.cfg.LD()
}
fn supports_only_32bit_data_size(&self) -> bool {
true
}
}
impl AccessPortType for AmbaApb2Apb3 {
fn ap_address(&self) -> &FullyQualifiedApAddress {
&self.address
}
}
impl ApRegAccess<CSW> for AmbaApb2Apb3 {}
super::attached_regs_to_mem_ap!(memory_ap_regs => AmbaApb2Apb3);
define_ap_register!(
name: CSW,
address: 0x00,
fields: [
pub DbgSwEnable, set_DbgSwEnable: 31;
pub TrInProg, set_TrInProg: 7;
pub DeviceEn, set_DeviceEn: 6;
pub u8, from into AddressIncrement, AddrInc, set_AddrInc: 5, 4;
pub u8, from into DataSize, Size, set_Size: 2, 0;
]
);