use crate::peripherals::Efuse;
const EFUSE_READ_MAGIC: u32 = 0x5A5A;
const EFUSE_WRITE_MAGIC: u32 = 0xA5A5;
pub const EFUSE_MAX_BYTES: u16 = 256;
const EFUSE_PROGRAM_DELAY_US: u32 = 100;
#[inline]
const fn word_index(byte_addr: u16) -> usize {
(byte_addr / 2) as usize
}
#[inline]
const fn extract_byte(word: u32, byte_addr: u16) -> u8 {
if byte_addr & 1 != 0 { ((word >> 8) & 0xFF) as u8 } else { (word & 0xFF) as u8 }
}
#[inline]
const fn pack_byte(value: u8, byte_addr: u16) -> u32 {
if byte_addr & 1 != 0 { (value as u32) << 8 } else { value as u32 }
}
#[derive(Debug, Clone, Copy, PartialEq, Eq)]
pub enum EfuseError {
OutOfRange,
}
pub struct EfuseDriver<'d> {
_efuse: Efuse<'d>,
}
impl<'d> EfuseDriver<'d> {
pub fn new(efuse: Efuse<'d>) -> Self {
Self { _efuse: efuse }
}
fn regs(&self) -> &'static ws63_pac::efuse::RegisterBlock {
unsafe { &*Efuse::ptr() }
}
pub fn set_clock_period(&mut self, period: u8) {
unsafe {
self.regs().efuse_clk_period().write(|w| w.bits(period as u32));
}
}
pub fn status(&self) -> EfuseStatus {
let sts = self.regs().efuse_sts().read();
EfuseStatus {
man_status: sts.man_sts().bits(),
boot0_done: sts.boot0_done().bit_is_set(),
boot1_done: sts.boot1_done().bit_is_set(),
boot2_done: sts.boot2_done().bit_is_set(),
}
}
pub fn read_byte(&mut self, byte_addr: u16) -> Result<u8, EfuseError> {
if byte_addr >= EFUSE_MAX_BYTES {
return Err(EfuseError::OutOfRange);
}
unsafe {
self.regs().efuse_ctl_data().write(|w| w.bits(EFUSE_READ_MAGIC));
}
let word = self.regs().efuse_data(word_index(byte_addr)).read().bits();
Ok(extract_byte(word, byte_addr))
}
pub fn read_buffer(&mut self, start_byte: u16, buf: &mut [u8]) -> Result<(), EfuseError> {
for (i, slot) in buf.iter_mut().enumerate() {
*slot = self.read_byte(start_byte + i as u16)?;
}
Ok(())
}
pub fn write_byte(&mut self, byte_addr: u16, value: u8) -> Result<(), EfuseError> {
if byte_addr >= EFUSE_MAX_BYTES {
return Err(EfuseError::OutOfRange);
}
let delay = crate::delay::Delay::new();
unsafe {
self.regs().efuse_ctl_data().write(|w| w.bits(EFUSE_WRITE_MAGIC));
self.regs().efuse_avdd_ctl().write(|w| w.bits(1));
}
delay.delay_micros(EFUSE_PROGRAM_DELAY_US);
unsafe {
self.regs().efuse_data(word_index(byte_addr)).write(|w| w.bits(pack_byte(value, byte_addr)));
self.regs().efuse_avdd_ctl().write(|w| w.bits(0));
}
delay.delay_micros(EFUSE_PROGRAM_DELAY_US);
Ok(())
}
}
#[derive(Debug, Clone, Copy)]
pub struct EfuseStatus {
pub man_status: u8,
pub boot0_done: bool,
pub boot1_done: bool,
pub boot2_done: bool,
}
impl EfuseStatus {
pub fn boot_complete(&self) -> bool {
self.boot0_done && self.boot1_done && self.boot2_done
}
}
#[cfg(test)]
mod tests {
use super::*;
#[test]
fn test_magic_values() {
assert_eq!(EFUSE_READ_MAGIC, 0x5A5A);
assert_eq!(EFUSE_WRITE_MAGIC, 0xA5A5);
}
#[test]
fn test_word_index() {
assert_eq!(word_index(0), 0);
assert_eq!(word_index(1), 0);
assert_eq!(word_index(2), 1);
assert_eq!(word_index(3), 1);
assert_eq!(word_index(255), 127);
}
#[test]
fn test_extract_byte_even_odd() {
let word = 0xABCD;
assert_eq!(extract_byte(word, 0), 0xCD); assert_eq!(extract_byte(word, 1), 0xAB); assert_eq!(extract_byte(word, 2), 0xCD); }
#[test]
fn test_pack_byte_even_odd() {
assert_eq!(pack_byte(0xCD, 0), 0x00CD); assert_eq!(pack_byte(0xAB, 1), 0xAB00); }
#[test]
fn test_pack_extract_roundtrip() {
for addr in [0u16, 1, 42, 255] {
for v in [0u8, 1, 0x5A, 0xFF] {
assert_eq!(extract_byte(pack_byte(v, addr), addr), v);
}
}
}
#[test]
fn test_efuse_boot_status_complete() {
let sts = EfuseStatus { man_status: 0, boot0_done: true, boot1_done: true, boot2_done: true };
assert!(sts.boot_complete());
let partial = EfuseStatus { man_status: 0, boot0_done: true, boot1_done: false, boot2_done: true };
assert!(!partial.boot_complete());
}
}
#[cfg(test)]
mod proptests {
use super::*;
use proptest::prelude::*;
proptest! {
#[test]
fn word_index_in_range(addr in 0u16..EFUSE_MAX_BYTES) {
let idx = word_index(addr);
prop_assert_eq!(idx, (addr / 2) as usize);
prop_assert!(idx < 128);
}
#[test]
fn pack_extract_roundtrip(addr in any::<u16>(), v in any::<u8>()) {
prop_assert_eq!(extract_byte(pack_byte(v, addr), addr), v);
}
#[test]
fn extract_byte_lane(word in any::<u32>(), addr in any::<u16>()) {
let b = extract_byte(word, addr);
let expected = if addr & 1 != 0 { ((word >> 8) & 0xFF) as u8 } else { (word & 0xFF) as u8 };
prop_assert_eq!(b, expected);
}
}
}