tinyRemote/rc.cpp at master · dgtie/tinyRemote · GitHub

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
#include "code.h"

namespace
{

void rc5bit(char c) {
  unsigned char b = 0b11111110;
  int n = 3;
  while (n--) {
    b <<= 2; if (c & 1) b |= 2; else b++;
    c >>= 1;
  }
  *ptr++ = b;
}

void bit(char c, int n) {
  unsigned char b = 0b11111110;
  while (n--) {
    b <<= 2; if (c & 1) b++; else b |= 2;
    c >>= 1;
  }
  *ptr++ = b;
}

void byte(char c) {
  bit(c >> 5, 3);
  bit(c >> 2, 3);
  bit(c, 2);
}

} // anonymous

namespace user
{

void rc6(char a, char c, char mode) {
  static unsigned char t = 0b11101100;
  while (transmitting_());
  ptr = buffer;
  *ptr++ = -1; *ptr++ = 93; *ptr++ = 16;
  *ptr++ = 9; *ptr++ = 0b11001001;
  bit(mode, 0b100);
  *ptr++ = (t ^= 0b1111);
  byte(a); byte(c);
  transmit_();
}

void rc5(char a, char c) {
  static char toggle = 0;
  toggle ^= 0b100000;
  a |= toggle;
  while (transmitting_());
  ptr = buffer;
  *ptr++ = -1; *ptr++ = 93; *ptr++ = 32;
  *ptr++ = 0b11110101;
  rc5bit(a>>3); rc5bit(a);
  rc5bit(c>>3); rc5bit(c);
  transmit_();
}

} // user