use crate::register::IoOcr;
use crate::response::sdio::r1::R1;
use crate::result::{Error, Result};
use crate::{lib_bitfield, response};
lib_bitfield! {
pub R4(MSB0 [u8; 5]): u32 {
raw_r1: 39, 32;
raw_c: 31;
raw_num_io_functions: 30, 28;
raw_memory_present: 27;
raw_stuff: 26, 24;
raw_io_ocr: 23, 0;
}
}
response! {
R4 {
response_mode: Spi,
}
}
impl R4 {
pub const LEN: usize = 5;
pub const DEFAULT: [u8; Self::LEN] = [0u8; Self::LEN];
pub const fn new() -> Self {
Self(Self::DEFAULT)
}
pub const fn r1(&self) -> Result<R1> {
R1::try_from_bits(self.raw_r1() as u8)
}
pub fn set_r1(&mut self, r1: R1) {
self.set_raw_r1(r1.bits() as u32);
}
pub const fn is_card_ready(&self) -> bool {
self.raw_c()
}
pub fn set_is_card_ready(&mut self, val: bool) {
self.set_raw_c(val);
}
pub const fn is_memory_present(&self) -> bool {
self.raw_memory_present()
}
pub fn set_is_memory_present(&mut self, val: bool) {
self.set_raw_memory_present(val)
}
pub const fn num_io_functions(&self) -> usize {
self.raw_num_io_functions() as usize
}
pub fn set_num_io_functions(&mut self, val: usize) {
self.set_raw_num_io_functions((val & 0x7) as u32)
}
pub const fn io_ocr(&self) -> IoOcr {
IoOcr::from_bits(self.raw_io_ocr())
}
pub fn set_io_ocr(&mut self, io_ocr: IoOcr) {
self.set_raw_io_ocr(io_ocr.bits());
}
pub const fn try_from_bytes(val: &[u8]) -> Result<Self> {
match val.len() {
len if len < Self::LEN => Err(Error::invalid_length(len, Self::LEN)),
_ if R1::try_from_bits(val[0]).is_err() => {
Err(Error::invalid_field_variant("r4::r1", val[0] as usize))
}
_ => Ok(Self([val[0], val[1], val[2], val[3], val[4]])),
}
}
}
impl Default for R4 {
fn default() -> Self {
Self::new()
}
}
impl TryFrom<&[u8]> for R4 {
type Error = Error;
fn try_from(val: &[u8]) -> Result<Self> {
Self::try_from_bytes(val)
}
}
impl<const N: usize> TryFrom<[u8; N]> for R4 {
type Error = Error;
fn try_from(val: [u8; N]) -> Result<Self> {
Self::try_from_bytes(val.as_ref())
}
}
impl<const N: usize> TryFrom<&[u8; N]> for R4 {
type Error = Error;
fn try_from(val: &[u8; N]) -> Result<Self> {
Self::try_from_bytes(val.as_ref())
}
}
#[cfg(test)]
mod tests {
use super::*;
#[test]
fn test_valid() {
(1..=40u64)
.map(|r| (1u64 << r) - 1)
.for_each(|raw_bitfield| {
let [_, _, _, b0, b1, b2, b3, b4] = raw_bitfield.to_be_bytes();
let b0 = b0 & !R1::MASK;
let raw_bytes = [b0, b1, b2, b3, b4];
let exp_r1 = R1::try_from_bits(b0).unwrap();
let exp_card_ready = (b1 & 0x80) != 0;
let exp_num_io = ((b1 & 0x70) >> 4) as usize;
let exp_mem = (b1 & 0x8) != 0;
let exp_io_ocr = IoOcr::try_from_bytes(&[b2, b3, b4]).unwrap();
let mut exp_r4 = R4(raw_bytes);
assert_eq!(R4::try_from_bytes(raw_bytes.as_ref()), Ok(exp_r4));
assert_eq!(exp_r4.r1(), Ok(exp_r1));
exp_r4.set_r1(R1::new());
assert_eq!(exp_r4.r1(), Ok(R1::new()));
exp_r4.set_r1(exp_r1);
assert_eq!(exp_r4.r1(), Ok(exp_r1));
assert_eq!(exp_r4.is_card_ready(), exp_card_ready);
exp_r4.set_is_card_ready(!exp_card_ready);
assert_eq!(exp_r4.is_card_ready(), !exp_card_ready);
exp_r4.set_is_card_ready(exp_card_ready);
assert_eq!(exp_r4.is_card_ready(), exp_card_ready);
assert_eq!(exp_r4.num_io_functions(), exp_num_io, "{:#x}", raw_bitfield);
exp_r4.set_num_io_functions(0);
assert_eq!(exp_r4.num_io_functions(), 0);
exp_r4.set_num_io_functions(exp_num_io);
assert_eq!(exp_r4.num_io_functions(), exp_num_io);
assert_eq!(exp_r4.is_memory_present(), exp_mem);
exp_r4.set_is_memory_present(!exp_mem);
assert_eq!(exp_r4.is_memory_present(), !exp_mem);
exp_r4.set_is_memory_present(exp_mem);
assert_eq!(exp_r4.is_memory_present(), exp_mem);
assert_eq!(exp_r4.io_ocr(), exp_io_ocr);
exp_r4.set_io_ocr(IoOcr::new());
assert_eq!(exp_r4.io_ocr(), IoOcr::new());
exp_r4.set_io_ocr(exp_io_ocr);
assert_eq!(exp_r4.io_ocr(), exp_io_ocr);
});
}
}