-
Notifications
You must be signed in to change notification settings - Fork 0
/
output.ino
77 lines (68 loc) · 2.09 KB
/
output.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
static const char* bin2tristate(const char* bin);
static char * dec2binWzerofill(unsigned long Dec, unsigned int bitLength);
void output(unsigned long decimal, unsigned int length, unsigned int delay, unsigned int* raw, unsigned int protocol, String* result1, String* result2, String* result3, String* result4, String* result5, String* result6) {
const char* b = dec2binWzerofill(decimal, length);
// Serial.print("Decimal: ");
// Serial.print(decimal);
// Serial.print(" (");
// Serial.print( length );
// Serial.print("Bit) Binary: ");
// Serial.print( b );
// Serial.print(" Tri-State: ");
// Serial.print( bin2tristate( b) );
// Serial.print(" PulseLength: ");
// Serial.print(delay);
// Serial.print(" microseconds");
// Serial.print(" Protocol: ");
// Serial.println(protocol);
Serial.print("Raw data: ");
for (unsigned int i=0; i<= length*2; i++) {
Serial.print(raw[i]);
Serial.print(",");
}
Serial.println();
Serial.println();
*result1 = String(decimal);
*result2 = String(b);
*result3 = String(bin2tristate(b));
*result4 = String(protocol);
*result5 = String(delay);
*result6 = String(length);
}
static const char* bin2tristate(const char* bin) {
static char returnValue[50];
int pos = 0;
int pos2 = 0;
while (bin[pos]!='\0' && bin[pos+1]!='\0') {
if (bin[pos]=='0' && bin[pos+1]=='0') {
returnValue[pos2] = '0';
} else if (bin[pos]=='1' && bin[pos+1]=='1') {
returnValue[pos2] = '1';
} else if (bin[pos]=='0' && bin[pos+1]=='1') {
returnValue[pos2] = 'F';
} else {
return "not applicable";
}
pos = pos+2;
pos2++;
}
returnValue[pos2] = '\0';
return returnValue;
}
static char * dec2binWzerofill(unsigned long Dec, unsigned int bitLength) {
static char bin[64];
unsigned int i=0;
while (Dec > 0) {
bin[32+i++] = ((Dec & 1) > 0) ? '1' : '0';
Dec = Dec >> 1;
}
for (unsigned int j = 0; j< bitLength; j++) {
if (j >= bitLength - i) {
bin[j] = bin[ 31 + i - (j - (bitLength - i)) ];
} else {
bin[j] = '0';
}
}
bin[bitLength] = '\0';
return bin;
}