polhemus_viper 0.1.2

A Rust library for the Polhemus Viper electromagnetic tracking system.
Documentation 
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24

fn crc16_step(crc: &mut u32, data_byte: u8) {
    let op: [u8; 16] = [0, 1, 1, 0, 1, 0, 0, 1, 1, 0, 0, 1, 0, 1, 1, 0];
    let mut data = (data_byte as u32 ^ (*crc)) & 0xff;
    *crc >>= 8;

    // Parity check over the 8 bits of data
    if op[(data & 0xf) as usize] ^ op[(data >> 4) as usize] != 0 {
        *crc ^= 0xc001;
    }

    data <<= 6;
    *crc ^= data;
    data <<= 1;
    *crc ^= data;
}

/// The main function for CRC calculation (corresponds to Viper_CalcCRC_Bytes)
pub(crate) fn crc16(data: &[u8]) -> u16 {
    let mut crc: u32 = 0; // Start value 0 according to C code
    for &byte in data {
        crc16_step(&mut crc, byte);
    }
    crc as u16
}