aboutsummaryrefslogtreecommitdiff
path: root/src/mqtt/varint.rs
blob: d5416ca9d003d45fa0e3c830dbe2b7a6a62aabb1 (plain)
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
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
#[derive(Debug)]
pub enum Error {
    NeedMoreData,
    InvalidVarInt,
}

impl core::fmt::Display for Error {
    fn fmt(&self, f: &mut core::fmt::Formatter<'_>) -> core::fmt::Result {
        match self {
            Error::NeedMoreData => f.write_str("NeedMoreData"),
            Error::InvalidVarInt => f.write_str("InvalidVarInt"),
        }
    }
}

impl core::error::Error for Error {}

pub fn encode(mut v: u32) -> ([u8; 4], usize) {
    let mut encoded = [0u8; 4];
    let mut count = 0;

    loop {
        let mut byte = (v % 128) as u8;
        v /= 128;

        if v > 0 {
            byte |= 0x80; // Set continuation bit
        }

        encoded[count] = byte;
        count += 1;

        if v == 0 {
            break;
        }
    }

    (encoded, count)
}

pub fn decode(buf: &[u8]) -> Result<(u32, usize), Error> {
    let mut value = 0u32;

    let v = buf.first().ok_or(Error::NeedMoreData)?;
    value |= (v & 0x7F) as u32;
    if v & 0x80 == 0 {
        return Ok((value, 1));
    }

    let v = buf.get(1).ok_or(Error::NeedMoreData)?;
    value |= ((v & 0x7F) as u32) << 7;
    if v & 0x80 == 0 {
        return Ok((value, 2));
    }

    let v = buf.get(2).ok_or(Error::NeedMoreData)?;
    value |= ((v & 0x7F) as u32) << 14;
    if v & 0x80 == 0 {
        return Ok((value, 3));
    }

    let v = buf.get(3).ok_or(Error::NeedMoreData)?;
    value |= ((v & 0x7F) as u32) << 21;
    if v & 0x80 != 0 {
        return Err(Error::InvalidVarInt);
    }

    Ok((value, 4))
}