ds 1.2.4

A library for controlling FIRST Robotics Competition robots
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
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49

use bytes::Buf;

/// Function to translate boolean button values into the bytes that the roboRIO expects
/// Buttons are encoded LSB 0 on the wire. This algorithm was MSB 0 originally, and I didn't feel like translating it properly
pub(crate) fn to_u8_vec(vec_in: &[bool]) -> Vec<u8> {
    let mut vec = Vec::new();

    for i in (0..vec_in.len()).step_by(8) {
        let mut num: u8 = 0;
        for j in i..i + 8 {
            num <<= 1;
            num |= *match vec_in.get(j) {
                Some(a) => a,
                None => &false,
            } as u8;
        }
        vec.push(reverse_byte(num));
    }

    vec.into_iter().rev().collect()
}

/// Reverses all the bits in a byte. Used to convert MSB 0 into LSB 0 for button encoding
fn reverse_byte(mut byte: u8) -> u8 {
    byte = (byte & 0xF0) >> 4 | (byte & 0x0F) << 4;
    byte = (byte & 0xCC) >> 2 | (byte & 0x33) << 2;
    byte = (byte & 0xAA) >> 1 | (byte & 0x55) << 1;

    byte
}

/// Converts the given team number into a String containing the IP of the roboRIO
/// Assumes the roboRIO will exist at 10.TE.AM.2
pub(crate) fn ip_from_team_number(team: u32) -> String {
    let s = team.to_string();

    match s.len() {
        1 | 2 => format!("10.0.{}.2", team),
        3 => format!("10.{}.{}.2", &s[0..1], &s[1..3]),
        4 => format!("10.{}.{}.2", &s[0..2], &s[2..4]),
        _ => unreachable!(), // Team numbers shouldn't be >4 characters
    }
}

pub(crate) trait InboundTag {
    fn chomp(buf: &mut impl Buf) -> crate::Result<Self>
    where
        Self: Sized;
}