use crate::{
eeprom::{ADDRESS_LEN_8KB, ADDRESS_LEN_512B, populate_address, read, write},
log,
};
use core::{cmp::min, convert::Infallible, marker::PhantomData};
use deranged::RangedUsize;
use embedded_io::{ErrorType, Read};
#[derive(Debug)]
struct Reader<'a> {
address: *mut u8,
len: usize,
lifetime: PhantomData<&'a ()>,
}
impl Reader<'_> {
unsafe fn new_unchecked(address: *mut u8, len: usize) -> Self {
Self {
address,
len,
lifetime: PhantomData,
}
}
fn read<const ADDRESS_LEN: usize>(&mut self, buf: &mut [u8]) -> Result<usize, Infallible> {
let mut bits = [0u16; 68];
let mut read_count = 0;
let read_limit = min(buf.len(), self.len);
loop {
if read_count >= read_limit {
return Ok(read_count);
}
bits[0] = 1;
bits[1] = 1;
populate_address::<ADDRESS_LEN>(&mut bits[2..], self.address);
write(&bits[..(ADDRESS_LEN + 3)]);
let bytes_to_read = read_limit - read_count;
let offset = unsafe { RangedUsize::new_unchecked(self.address as usize & 0b0000_0111) };
if bytes_to_read < (8 - offset.get()) {
read(
bits,
&mut buf[read_count..(read_count + bytes_to_read)],
offset,
);
} else {
read(bits, &mut buf[read_count..], offset);
}
let amount_read = min(8 - offset.get(), bytes_to_read);
read_count += amount_read;
self.address = unsafe { self.address.byte_add(amount_read) };
self.len -= amount_read;
}
}
}
#[derive(Debug)]
pub struct Reader512B<'a> {
reader: Reader<'a>,
}
impl Reader512B<'_> {
pub(in crate::eeprom) unsafe fn new_unchecked(address: *mut u8, len: usize) -> Self {
log::info!(
"Creating EEPROM 512B reader at address 0x{:08x?} with length {len}",
address as usize
);
Self {
reader: unsafe { Reader::new_unchecked(address, len) },
}
}
}
impl ErrorType for Reader512B<'_> {
type Error = Infallible;
}
impl Read for Reader512B<'_> {
fn read(&mut self, buf: &mut [u8]) -> Result<usize, Self::Error> {
self.reader.read::<ADDRESS_LEN_512B>(buf)
}
}
#[derive(Debug)]
pub struct Reader8K<'a> {
reader: Reader<'a>,
}
impl Reader8K<'_> {
pub(in crate::eeprom) unsafe fn new_unchecked(address: *mut u8, len: usize) -> Self {
log::info!(
"Creating EEPROM 8KiB reader at address 0x{:08x?} with length {len}",
address as usize
);
Self {
reader: unsafe { Reader::new_unchecked(address, len) },
}
}
}
impl ErrorType for Reader8K<'_> {
type Error = Infallible;
}
impl Read for Reader8K<'_> {
fn read(&mut self, buf: &mut [u8]) -> Result<usize, Self::Error> {
self.reader.read::<ADDRESS_LEN_8KB>(buf)
}
}