360 lines
7.8 KiB
Rust
360 lines
7.8 KiB
Rust
pub const CRC32R_LOOKUP_TABLE: [u32; 256] = [
|
|
0x0000_0000,
|
|
0x7707_3096,
|
|
0xEE0E_612C,
|
|
0x9909_51BA,
|
|
0x076D_C419,
|
|
0x706A_F48F,
|
|
0xE963_A535,
|
|
0x9E64_95A3,
|
|
0x0EDB_8832,
|
|
0x79DC_B8A4,
|
|
0xE0D5_E91E,
|
|
0x97D2_D988,
|
|
0x09B6_4C2B,
|
|
0x7EB1_7CBD,
|
|
0xE7B8_2D07,
|
|
0x90BF_1D91,
|
|
0x1DB7_1064,
|
|
0x6AB0_20F2,
|
|
0xF3B9_7148,
|
|
0x84BE_41DE,
|
|
0x1ADA_D47D,
|
|
0x6DDD_E4EB,
|
|
0xF4D4_B551,
|
|
0x83D3_85C7,
|
|
0x136C_9856,
|
|
0x646B_A8C0,
|
|
0xFD62_F97A,
|
|
0x8A65_C9EC,
|
|
0x1401_5C4F,
|
|
0x6306_6CD9,
|
|
0xFA0F_3D63,
|
|
0x8D08_0DF5,
|
|
0x3B6E_20C8,
|
|
0x4C69_105E,
|
|
0xD560_41E4,
|
|
0xA267_7172,
|
|
0x3C03_E4D1,
|
|
0x4B04_D447,
|
|
0xD20D_85FD,
|
|
0xA50A_B56B,
|
|
0x35B5_A8FA,
|
|
0x42B2_986C,
|
|
0xDBBB_C9D6,
|
|
0xACBC_F940,
|
|
0x32D8_6CE3,
|
|
0x45DF_5C75,
|
|
0xDCD6_0DCF,
|
|
0xABD1_3D59,
|
|
0x26D9_30AC,
|
|
0x51DE_003A,
|
|
0xC8D7_5180,
|
|
0xBFD0_6116,
|
|
0x21B4_F4B5,
|
|
0x56B3_C423,
|
|
0xCFBA_9599,
|
|
0xB8BD_A50F,
|
|
0x2802_B89E,
|
|
0x5F05_8808,
|
|
0xC60C_D9B2,
|
|
0xB10B_E924,
|
|
0x2F6F_7C87,
|
|
0x5868_4C11,
|
|
0xC161_1DAB,
|
|
0xB666_2D3D,
|
|
0x76DC_4190,
|
|
0x01DB_7106,
|
|
0x98D2_20BC,
|
|
0xEFD5_102A,
|
|
0x71B1_8589,
|
|
0x06B6_B51F,
|
|
0x9FBF_E4A5,
|
|
0xE8B8_D433,
|
|
0x7807_C9A2,
|
|
0x0F00_F934,
|
|
0x9609_A88E,
|
|
0xE10E_9818,
|
|
0x7F6A_0DBB,
|
|
0x086D_3D2D,
|
|
0x9164_6C97,
|
|
0xE663_5C01,
|
|
0x6B6B_51F4,
|
|
0x1C6C_6162,
|
|
0x8565_30D8,
|
|
0xF262_004E,
|
|
0x6C06_95ED,
|
|
0x1B01_A57B,
|
|
0x8208_F4C1,
|
|
0xF50F_C457,
|
|
0x65B0_D9C6,
|
|
0x12B7_E950,
|
|
0x8BBE_B8EA,
|
|
0xFCB9_887C,
|
|
0x62DD_1DDF,
|
|
0x15DA_2D49,
|
|
0x8CD3_7CF3,
|
|
0xFBD4_4C65,
|
|
0x4DB2_6158,
|
|
0x3AB5_51CE,
|
|
0xA3BC_0074,
|
|
0xD4BB_30E2,
|
|
0x4ADF_A541,
|
|
0x3DD8_95D7,
|
|
0xA4D1_C46D,
|
|
0xD3D6_F4FB,
|
|
0x4369_E96A,
|
|
0x346E_D9FC,
|
|
0xAD67_8846,
|
|
0xDA60_B8D0,
|
|
0x4404_2D73,
|
|
0x3303_1DE5,
|
|
0xAA0A_4C5F,
|
|
0xDD0D_7CC9,
|
|
0x5005_713C,
|
|
0x2702_41AA,
|
|
0xBE0B_1010,
|
|
0xC90C_2086,
|
|
0x5768_B525,
|
|
0x206F_85B3,
|
|
0xB966_D409,
|
|
0xCE61_E49F,
|
|
0x5EDE_F90E,
|
|
0x29D9_C998,
|
|
0xB0D0_9822,
|
|
0xC7D7_A8B4,
|
|
0x59B3_3D17,
|
|
0x2EB4_0D81,
|
|
0xB7BD_5C3B,
|
|
0xC0BA_6CAD,
|
|
0xEDB8_8320,
|
|
0x9ABF_B3B6,
|
|
0x03B6_E20C,
|
|
0x74B1_D29A,
|
|
0xEAD5_4739,
|
|
0x9DD2_77AF,
|
|
0x04DB_2615,
|
|
0x73DC_1683,
|
|
0xE363_0B12,
|
|
0x9464_3B84,
|
|
0x0D6D_6A3E,
|
|
0x7A6A_5AA8,
|
|
0xE40E_CF0B,
|
|
0x9309_FF9D,
|
|
0x0A00_AE27,
|
|
0x7D07_9EB1,
|
|
0xF00F_9344,
|
|
0x8708_A3D2,
|
|
0x1E01_F268,
|
|
0x6906_C2FE,
|
|
0xF762_575D,
|
|
0x8065_67CB,
|
|
0x196C_3671,
|
|
0x6E6B_06E7,
|
|
0xFED4_1B76,
|
|
0x89D3_2BE0,
|
|
0x10DA_7A5A,
|
|
0x67DD_4ACC,
|
|
0xF9B9_DF6F,
|
|
0x8EBE_EFF9,
|
|
0x17B7_BE43,
|
|
0x60B0_8ED5,
|
|
0xD6D6_A3E8,
|
|
0xA1D1_937E,
|
|
0x38D8_C2C4,
|
|
0x4FDF_F252,
|
|
0xD1BB_67F1,
|
|
0xA6BC_5767,
|
|
0x3FB5_06DD,
|
|
0x48B2_364B,
|
|
0xD80D_2BDA,
|
|
0xAF0A_1B4C,
|
|
0x3603_4AF6,
|
|
0x4104_7A60,
|
|
0xDF60_EFC3,
|
|
0xA867_DF55,
|
|
0x316E_8EEF,
|
|
0x4669_BE79,
|
|
0xCB61_B38C,
|
|
0xBC66_831A,
|
|
0x256F_D2A0,
|
|
0x5268_E236,
|
|
0xCC0C_7795,
|
|
0xBB0B_4703,
|
|
0x2202_16B9,
|
|
0x5505_262F,
|
|
0xC5BA_3BBE,
|
|
0xB2BD_0B28,
|
|
0x2BB4_5A92,
|
|
0x5CB3_6A04,
|
|
0xC2D7_FFA7,
|
|
0xB5D0_CF31,
|
|
0x2CD9_9E8B,
|
|
0x5BDE_AE1D,
|
|
0x9B64_C2B0,
|
|
0xEC63_F226,
|
|
0x756A_A39C,
|
|
0x026D_930A,
|
|
0x9C09_06A9,
|
|
0xEB0E_363F,
|
|
0x7207_6785,
|
|
0x0500_5713,
|
|
0x95BF_4A82,
|
|
0xE2B8_7A14,
|
|
0x7BB1_2BAE,
|
|
0x0CB6_1B38,
|
|
0x92D2_8E9B,
|
|
0xE5D5_BE0D,
|
|
0x7CDC_EFB7,
|
|
0x0BDB_DF21,
|
|
0x86D3_D2D4,
|
|
0xF1D4_E242,
|
|
0x68DD_B3F8,
|
|
0x1FDA_836E,
|
|
0x81BE_16CD,
|
|
0xF6B9_265B,
|
|
0x6FB0_77E1,
|
|
0x18B7_4777,
|
|
0x8808_5AE6,
|
|
0xFF0F_6A70,
|
|
0x6606_3BCA,
|
|
0x1101_0B5C,
|
|
0x8F65_9EFF,
|
|
0xF862_AE69,
|
|
0x616B_FFD3,
|
|
0x166C_CF45,
|
|
0xA00A_E278,
|
|
0xD70D_D2EE,
|
|
0x4E04_8354,
|
|
0x3903_B3C2,
|
|
0xA767_2661,
|
|
0xD060_16F7,
|
|
0x4969_474D,
|
|
0x3E6E_77DB,
|
|
0xAED1_6A4A,
|
|
0xD9D6_5ADC,
|
|
0x40DF_0B66,
|
|
0x37D8_3BF0,
|
|
0xA9BC_AE53,
|
|
0xDEBB_9EC5,
|
|
0x47B2_CF7F,
|
|
0x30B5_FFE9,
|
|
0xBDBD_F21C,
|
|
0xCABA_C28A,
|
|
0x53B3_9330,
|
|
0x24B4_A3A6,
|
|
0xBAD0_3605,
|
|
0xCDD7_0693,
|
|
0x54DE_5729,
|
|
0x23D9_67BF,
|
|
0xB366_7A2E,
|
|
0xC461_4AB8,
|
|
0x5D68_1B02,
|
|
0x2A6F_2B94,
|
|
0xB40B_BE37,
|
|
0xC30C_8EA1,
|
|
0x5A05_DF1B,
|
|
0x2D02_EF8D,
|
|
];
|
|
|
|
/// Generate Ethernet Frame Check Sequence
|
|
#[allow(non_camel_case_types)]
|
|
#[derive(Debug)]
|
|
pub struct ETH_FCS(pub u32);
|
|
|
|
impl ETH_FCS {
|
|
pub const CRC32_OK: u32 = 0x2144_df1c;
|
|
|
|
#[must_use]
|
|
pub fn new(data: &[u8]) -> Self {
|
|
let fcs = data.iter().fold(u32::MAX, |crc, byte| {
|
|
let idx = u8::try_from(crc & 0xFF).unwrap() ^ byte;
|
|
CRC32R_LOOKUP_TABLE[usize::from(idx)] ^ (crc >> 8)
|
|
}) ^ u32::MAX;
|
|
Self(fcs)
|
|
}
|
|
|
|
#[must_use]
|
|
pub fn update(self, data: &[u8]) -> Self {
|
|
let fcs = data.iter().fold(self.0 ^ u32::MAX, |crc, byte| {
|
|
let idx = u8::try_from(crc & 0xFF).unwrap() ^ byte;
|
|
CRC32R_LOOKUP_TABLE[usize::from(idx)] ^ (crc >> 8)
|
|
}) ^ u32::MAX;
|
|
Self(fcs)
|
|
}
|
|
|
|
#[must_use]
|
|
pub fn crc_ok(&self) -> bool {
|
|
self.0 == Self::CRC32_OK
|
|
}
|
|
|
|
#[must_use]
|
|
pub fn hton_bytes(&self) -> [u8; 4] {
|
|
self.0.to_le_bytes()
|
|
}
|
|
|
|
#[must_use]
|
|
pub fn hton(&self) -> u32 {
|
|
self.0.to_le()
|
|
}
|
|
}
|
|
|
|
#[cfg(test)]
|
|
mod tests {
|
|
use super::*;
|
|
|
|
#[test]
|
|
fn crc32_ethernet_frame() {
|
|
let packet_a = &[
|
|
0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00, 0xe0, 0x4c, 0x68, 0xee, 0xee, 0xff, 0x06, 0x00, 0x01, 0x08, 0x00,
|
|
0x06, 0x04, 0x00, 0x01, 0x00, 0xe0, 0x4c, 0x68, 0x0e, 0x06, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
|
|
0x00, 0x00, 0xc0, 0xa8, 0x10, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xf2, 0x65, 0x90, 0x3d,
|
|
];
|
|
|
|
let packet_b = &[
|
|
0x12, 0x34, 0x56, 0x78, 0x9a, 0xbc, 0x00, 0xe0, 0x4c, 0x68, 0xee, 0xee, 0xdd, 0x06, 0x00, 0x01, 0x08, 0x00,
|
|
0x06, 0x04, 0x00, 0x02, 0x00, 0xe0, 0x4c, 0x68, 0x09, 0xde, 0xc0, 0xa8, 0x01, 0x02, 0x12, 0x34, 0x56, 0x78,
|
|
0x9a, 0xbc, 0xc0, 0xa8, 0x01, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x21, 0x3d, 0x67, 0x7c,
|
|
];
|
|
|
|
// Packet A
|
|
let own_crc = ETH_FCS::new(&packet_a[0..60]);
|
|
let crc_bytes = own_crc.hton_bytes();
|
|
println!("{:08x} {:02x?}", own_crc.0, crc_bytes);
|
|
assert_eq!(&crc_bytes, &packet_a[60..64]);
|
|
|
|
let own_crc = ETH_FCS::new(packet_a);
|
|
println!("{:08x}", own_crc.0);
|
|
assert_eq!(own_crc.0, ETH_FCS::CRC32_OK);
|
|
|
|
// Packet B
|
|
let own_crc = ETH_FCS::new(&packet_b[0..60]);
|
|
let crc_bytes = own_crc.hton_bytes();
|
|
println!("{:08x} {:02x?}", own_crc.0, crc_bytes);
|
|
assert_eq!(&crc_bytes, &packet_b[60..64]);
|
|
|
|
let own_crc = ETH_FCS::new(packet_b);
|
|
println!("{:08x}", own_crc.0);
|
|
assert_eq!(own_crc.0, ETH_FCS::CRC32_OK);
|
|
}
|
|
|
|
#[test]
|
|
fn crc32_update() {
|
|
let full_data = &[
|
|
0x12, 0x34, 0x56, 0x78, 0x9a, 0xbc, 0x00, 0xe0, 0x4c, 0x68, 0xee, 0xee, 0xdd, 0x06, 0x00, 0x01, 0x08, 0x00,
|
|
0x06, 0x04, 0x00, 0x02, 0x00, 0xe0, 0x4c, 0x68, 0x09, 0xde, 0xc0, 0xa8, 0x01, 0x02, 0x12, 0x34, 0x56, 0x78,
|
|
0x9a, 0xbc, 0xc0, 0xa8, 0x01, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
|
|
0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x21, 0x3d, 0x67, 0x7c,
|
|
];
|
|
|
|
let (part_a, part_b) = full_data.split_at(16);
|
|
let crc_partially = ETH_FCS::new(part_a).update(part_b);
|
|
|
|
let crc_full = ETH_FCS::new(full_data);
|
|
|
|
assert_eq!(crc_full.0, crc_partially.0);
|
|
}
|
|
}
|