-
Notifications
You must be signed in to change notification settings - Fork 50
/
insectRemote.ino
66 lines (52 loc) · 1.09 KB
/
insectRemote.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
#include "AnalogInput.h"
//#define LOGSERIAL
#define SERIALDATA
AnalogInput lx("lx", A1, 1);
AnalogInput ly("ly", A0, -1);
AnalogInput lz("lz", A2, 1);
AnalogInput rx("rx", A4, 1);
AnalogInput ry("ry", A3, -1);
AnalogInput rz("rz", A5, 1);
AnalogInput inputs[] = {lx, ly, lz, rx, ry, rz};
byte output[18];
void setup() {
Serial.begin(115200);
analogReadResolution(12);
pinMode(8, INPUT_PULLUP);
pinMode(9, INPUT_PULLUP);
delay(500);
for (int i = 0; i < 6; i++)
{
inputs[i].setCenter();
}
}
void loop() {
for (int i = 0; i < 6; i++)
{
inputs[i].update();
}
#ifdef LOGSERIAL
for (int i = 0; i < 6; i++)
{
inputs[i].serialLog();
}
Serial.print(" ");
Serial.print( !digitalRead(8));
Serial.print(" ");
Serial.print( !digitalRead(9));
Serial.println("");
#endif
#ifdef SERIALDATA
int count =0;
Serial.write(100);
Serial.write(100);
for (int i = 0; i < 6; i++)
{
Serial.write(inputs[i].endVal.byte.c1);
Serial.write(inputs[i].endVal.byte.c2);
}
Serial.write(!digitalRead(8));
Serial.write(!digitalRead(9));
#endif
delay(32);
}