forked from tdewaha/arduino-pocsag
-
Notifications
You must be signed in to change notification settings - Fork 0
/
helpers.ino
77 lines (68 loc) · 1.79 KB
/
helpers.ino
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
/**
* Provides helper functions for the pocsag decoder
* Copyright (C) 2013 Tom de Waha
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
* You should have received a copy of the GNU General Public License along
* with this program; if not, write to the Free Software Foundation, Inc.,
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
**/
#define CLR(x,y) (x&=(~(1<<y)))
#define SET(x,y) (x|=(1<<y))
String long2str(unsigned long binstr)
{
String cwrep;
int zeros = 32 - String(binstr,BIN).length();
for (int i=0; i<zeros; i++) {
cwrep = cwrep + "0";
}
cwrep = cwrep + String(binstr,BIN);
return cwrep;
}
String byte2str(byte binstr)
{
String cwrep;
int zeros = 8 - String(binstr,BIN).length();
for (int i = 0; i < zeros; i++)
{
cwrep = cwrep + "0";
}
cwrep = cwrep + String(binstr,BIN);
return cwrep;
}
int parity (unsigned long x) // Parity check. If ==1, codeword is invalid
{
x = x ^ x >> 16;
x = x ^ x >> 8;
x = x ^ x >> 4;
x = x ^ x >> 2;
x = x ^ x >> 1;
return x & 1;
}
void trigger()
{
SET(PORTD, triggerPin);
CLR(PORTD, triggerPin);
}
void enable_trigger()
{
SET(PORTD, triggerPin);
}
void disable_trigger()
{
CLR(PORTD, triggerPin);
}
void enable_led()
{
SET(PORTD, ledPin);
}
void disable_led()
{
CLR(PORTD, ledPin);
}