use heterob::{bit_numbering::Lsb, endianness::Le, Seq, P2, P3};
use super::ExtendedCapabilityDataError;
#[derive(Debug, Clone, PartialEq, Eq)]
pub struct LatencyToleranceReporting {
pub max_snoop_latency: MaxLatency,
pub max_no_snoop_latency: MaxLatency,
}
impl TryFrom<&[u8]> for LatencyToleranceReporting {
type Error = ExtendedCapabilityDataError;
fn try_from(slice: &[u8]) -> Result<Self, Self::Error> {
let Seq {
head: Le((max_snoop_latency, max_no_snoop_latency)),
..
} = P2(slice)
.try_into()
.map_err(|_| ExtendedCapabilityDataError {
name: "Latency Tolerance Reporting",
size: 8,
})?;
Ok(Self {
max_snoop_latency: From::<u16>::from(max_snoop_latency),
max_no_snoop_latency: From::<u16>::from(max_no_snoop_latency),
})
}
}
#[derive(Debug, Clone, PartialEq, Eq)]
pub struct MaxLatency {
pub value: u16,
pub scale: u8,
}
impl MaxLatency {
pub fn value(&self) -> usize {
match self.scale {
scale @ 0..=5 => (self.value as usize) << (5 * scale),
_ => 0,
}
}
}
impl From<u16> for MaxLatency {
fn from(word: u16) -> Self {
let Lsb((value, scale, ())) = P3::<_, 10, 3, 3>(word).into();
Self { value, scale }
}
}
impl From<MaxLatency> for u16 {
fn from(data: MaxLatency) -> Self {
(data.scale as u16) << 13 | data.value
}
}