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
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108

use crate::{protocol::Rc6, sender::ProtocolEncoder};

impl<const F: u32> ProtocolEncoder<F> for Rc6 {
    type EncoderData = [u32; 1];
    const DATA: Self::EncoderData = [((444 * F) / 1_000_000)];

    fn encode(cmd: &Self::Cmd, b: &mut [u32]) -> usize {
        use Level::*;

        let rc6len = <Self as ProtocolEncoder<F>>::DATA[0];

        let header = leader(cmd.toggle, rc6len);

        let bits = u16::from(cmd.addr) << 8 | u16::from(cmd.cmd);
        let payload = payload(bits, rc6len);

        let mut prevlev = Low(0);
        let mut index = 0;

        let low = [Low(6 * (rc6len))];

        let all = header.iter().chain(payload.iter()).chain(&low);

        for level in all {
            match (prevlev, *level) {
                (Low(lt), Low(nlt)) => {
                    prevlev = Low(lt + nlt);
                }
                (Low(lt), High(ht)) => {
                    b[index] = lt;
                    index += 1;
                    prevlev = High(ht)
                }
                (High(ht), Low(lt)) => {
                    b[index] = ht;
                    index += 1;
                    prevlev = Low(lt);
                }
                (High(ht), High(nht)) => {
                    prevlev = High(ht + nht);
                }
            }
        }

        index
    }
}

#[derive(Copy, Clone, PartialEq)]
enum Level {
    High(u32),
    Low(u32),
}

/// Construct the leader
const fn leader(toggle: bool, rc6len: u32) -> [Level; 12] {
    use Level::*;
    [
        // Leader
        High(6 * rc6len),
        Low(2 * rc6len),
        // Start bit after leading pause. Always one
        High(rc6len),
        Low(rc6len),
        // Mode 000
        Low(rc6len),
        High(rc6len),
        Low(rc6len),
        High(rc6len),
        Low(rc6len),
        High(rc6len),
        // Toggle bit. Double length
        if toggle {
            High(2 * rc6len)
        } else {
            Low(2 * rc6len)
        },
        if toggle {
            Low(2 * rc6len)
        } else {
            High(2 * rc6len)
        },
    ]
}

const fn payload(bits: u16, rc6len: u32) -> [Level; 32] {
    let mut lvls = [Level::Low(0); 32];
    let mut i = 0;
    let mut b = 0;
    loop {
        let bit_is_set = bits & (1 << (15 - b)) != 0;
        if bit_is_set {
            lvls[i] = Level::High(rc6len);
            lvls[i + 1] = Level::Low(rc6len);
        } else {
            lvls[i] = Level::Low(rc6len);
            lvls[i + 1] = Level::High(rc6len);
        }

        b += 1;
        i += 2;

        if b == 16 {
            break;
        }
    }
    lvls
}