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
use crate::{protocol::Rc5, sender::ProtocolEncoder};
const fn calc_freq(mut f: u32) -> u32 {
let mut div = 1_000_000;
if f > 1000 {
f /= 1000;
div /= 1000;
}
(889 * f) / div
}
impl<const FREQ: u32> ProtocolEncoder<FREQ> for Rc5 {
type EncoderData = [u32; 1];
const DATA: Self::EncoderData = [calc_freq(FREQ)];
fn encode(cmd: &Self::Cmd, buf: &mut [u32]) -> usize {
let bits = cmd.pack();
let rc5len = <Self as ProtocolEncoder<FREQ>>::DATA[0];
buf[0] = 0;
let mut prev = true;
let mut index = 1;
for b in 0..13 {
let cur = bits & (1 << (12 - b)) != 0;
if prev == cur {
buf[index] = rc5len;
buf[index + 1] = rc5len;
index += 2;
} else {
buf[index] = rc5len * 2;
index += 1;
}
prev = cur;
}
index
}
}