use crate::error::MessageError;
pub const FUNCTION_CODE: u8 = 0x06;
#[derive(Debug, Clone, Copy, PartialEq, Eq)]
pub struct WriteSingleRegister {
pub address: u16,
pub value: u16,
}
impl WriteSingleRegister {
pub(crate) fn decode(data: &[u8]) -> Result<Self, MessageError> {
let [a1, a0, v1, v0, ..] = data else {
return Err(MessageError::UnexpectedEof);
};
Ok(Self {
address: u16::from_be_bytes([*a1, *a0]),
value: u16::from_be_bytes([*v1, *v0]),
})
}
pub(crate) fn encode(self, buf: &mut [u8]) -> Result<usize, MessageError> {
let [d0, d1, d2, d3, ..] = buf else {
return Err(MessageError::BufferFull);
};
[*d0, *d1] = self.address.to_be_bytes();
[*d2, *d3] = self.value.to_be_bytes();
Ok(4)
}
}
#[cfg(test)]
mod tests {
use super::*;
#[test]
fn decodes_a_reference_frame() {
let data = [0x00, 0x01, 0x00, 0x03];
let msg = WriteSingleRegister::decode(&data).unwrap();
assert_eq!(msg.address, 1);
assert_eq!(msg.value, 3);
}
#[test]
fn round_trips() {
let original = WriteSingleRegister {
address: 0x0042,
value: 0xBEEF,
};
let mut buf = [0u8; 4];
let n = original.encode(&mut buf).unwrap();
assert_eq!(WriteSingleRegister::decode(&buf[..n]).unwrap(), original);
}
}