autd3-rs 0.7.0

Core async client library for the AUTD3 phased-array kit.
Documentation
use autd3_cpu_wire::payload::ChangePatternBankPayload;
use zerocopy::FromBytes;
use zerocopy::little_endian::{U32, U64};

use crate::error::Error;
use crate::geometry::Device;
use crate::mirror::FirmwareState;
use crate::protocol::{Cmd, PAYLOAD_BYTES};
use crate::value::{PatternBank, TransitionMode};

use super::{Distribution, Operation};

#[derive(Clone, Copy, Debug)]
pub struct ChangePatternBank {
    pub bank: PatternBank,
    pub transition_mode: TransitionMode,
}

impl crate::sealed::Sealed for ChangePatternBank {}

impl Operation for ChangePatternBank {
    fn apply_dc_offset(&mut self, offset_ns: i64) {
        self.transition_mode = self.transition_mode.with_dc_offset(offset_ns);
    }

    fn distribution(&self) -> Distribution {
        Distribution::Broadcast
    }

    fn encode(&self, _device: &Device, out: &mut [u8; PAYLOAD_BYTES]) -> Result<Cmd, Error> {
        let margin_ns = self.transition_mode.margin_ns()?;
        let (p, _) = ChangePatternBankPayload::mut_from_prefix(&mut out[..]).unwrap();
        *p = ChangePatternBankPayload {
            bank: self.bank.as_u8(),
            transition_mode: self.transition_mode.try_as_u8()?,
            transition_value: U64::new(self.transition_mode.value()),
            margin_ns: U32::new(margin_ns),
        };
        Ok(Cmd::ChangePatternBank)
    }

    fn reflect(&self, device: usize, state: &mut FirmwareState) -> Result<(), Error> {
        let bank = self.bank.as_u8();
        state.silencer.check_pattern_bank(device, bank)?;
        state
            .transition
            .check_pattern_bank(device, bank, self.transition_mode)?;
        state.silencer.note_pattern_bank(bank);
        Ok(())
    }
}

#[cfg(test)]
mod tests {
    use super::*;
    use crate::test_utils::test_device;

    fn encode(op: ChangePatternBank) -> (Cmd, [u8; PAYLOAD_BYTES]) {
        let mut out = [0u8; PAYLOAD_BYTES];
        let cmd = op.encode(&test_device(0), &mut out).unwrap();
        (cmd, out)
    }

    #[test]
    fn change_pattern_bank_lays_out_fields() {
        let (cmd, payload) = encode(ChangePatternBank {
            bank: PatternBank::B1,
            transition_mode: TransitionMode::Immediate,
        });

        assert_eq!(cmd, Cmd::ChangePatternBank);
        assert_eq!(payload[0], 1);
        assert_eq!(payload[1], 0xFF);
        assert_eq!(&payload[2..10], &0u64.to_le_bytes());
    }

    #[test]
    fn change_pattern_bank_encodes_transition_value() {
        use crate::value::DcSysTime;

        let (_cmd, payload) = encode(ChangePatternBank {
            bank: PatternBank::B0,
            transition_mode: TransitionMode::SysTime {
                time: DcSysTime::from_nanos(0x0123_4567_89AB_CDEF),
                margin: None,
            },
        });

        assert_eq!(payload[0], 0);
        assert_eq!(payload[1], 0x01);
        assert_eq!(&payload[2..10], &0x0123_4567_89AB_CDEFu64.to_le_bytes());
    }

    #[test]
    fn change_pattern_bank_encodes_gpio_pin() {
        use crate::value::GpioIn;

        let (_cmd, payload) = encode(ChangePatternBank {
            bank: PatternBank::B0,
            transition_mode: TransitionMode::Gpio(GpioIn::I2),
        });

        assert_eq!(payload[1], 0x02);
        assert_eq!(&payload[2..10], &2u64.to_le_bytes());
    }

    #[test]
    fn change_pattern_bank_encodes_sys_time_margin() {
        use core::time::Duration;

        use crate::value::DcSysTime;

        let (_cmd, payload) = encode(ChangePatternBank {
            bank: PatternBank::B0,
            transition_mode: TransitionMode::SysTime {
                time: DcSysTime::ZERO,
                margin: Some(Duration::from_millis(1)),
            },
        });
        assert_eq!(&payload[10..14], &1_000_000u32.to_le_bytes());

        let (_cmd, payload) = encode(ChangePatternBank {
            bank: PatternBank::B0,
            transition_mode: TransitionMode::SysTime {
                time: DcSysTime::ZERO,
                margin: None,
            },
        });
        assert_eq!(&payload[10..14], &0u32.to_le_bytes());
    }

    #[test]
    fn change_pattern_bank_rejects_margin_beyond_u32_nanos() {
        use core::time::Duration;

        use crate::value::DcSysTime;

        let mut out = [0u8; PAYLOAD_BYTES];
        let err = ChangePatternBank {
            bank: PatternBank::B0,
            transition_mode: TransitionMode::SysTime {
                time: DcSysTime::ZERO,
                margin: Some(Duration::from_secs(5)),
            },
        }
        .encode(&test_device(0), &mut out)
        .unwrap_err();

        assert!(matches!(
            err,
            Error::Encode(crate::EncodeError::TransitionMarginOutOfRange(_))
        ));
    }

    #[test]
    fn change_pattern_bank_refuses_to_not_transition() {
        let mut out = [0u8; PAYLOAD_BYTES];
        let err = ChangePatternBank {
            bank: PatternBank::B1,
            transition_mode: TransitionMode::Later,
        }
        .encode(&test_device(0), &mut out)
        .unwrap_err();

        assert!(matches!(
            err,
            Error::Encode(crate::EncodeError::TransitionLaterNotEncodable)
        ));
    }
}