pub const CC: u8 = 0x56;
const ALG: crc::Crc<u16> = crc::Crc::<u16>::new(&crc::CRC_16_SPI_FUJITSU);
pub fn checksum(data: &[u8]) -> u16 {
ALG.checksum(data)
}
pub fn encapsulate(command: &[u8]) -> Vec<u8> {
let mut v = Vec::with_capacity(command.len() + 4);
v.extend_from_slice(&[CC, 0x01]);
v.extend_from_slice(command);
let c = checksum(&v);
v.extend_from_slice(&c.to_be_bytes());
v
}
pub fn decapsulate(frame: &[u8]) -> Option<&[u8]> {
if frame.len() < 5 || frame[0] != CC || frame[1] != 0x01 {
return None;
}
let (body, crc) = frame.split_at(frame.len() - 2);
(checksum(body) == u16::from_be_bytes([crc[0], crc[1]])).then_some(&body[2..])
}
#[cfg(test)]
mod tests {
use super::*;
#[test]
fn check_value_and_roundtrip() {
assert_eq!(checksum(b"123456789"), 0xe5cc);
let f = encapsulate(&[0x20, 0x02]);
assert_eq!(decapsulate(&f), Some(&[0x20u8, 0x02][..]));
let mut bad = f.clone();
bad[2] ^= 1;
assert_eq!(decapsulate(&bad), None);
}
}