-
Notifications
You must be signed in to change notification settings - Fork 1
/
TPSurgery.pde
135 lines (119 loc) · 5.42 KB
/
TPSurgery.pde
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
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
class TPSurgery
{
final int NUM_LEDS = 61;
long fadeMillis = 0;
color col[] = new color[NUM_LEDS];
color fadeCol[] = new color[NUM_LEDS];
boolean serialError = false;
Serial port;
Left left = new Left();
Bottom bottom = new Bottom();
Right right = new Right();
Top top = new Top();
Menu menu = new Menu();
Hands hands = new Hands();
TPSurgery(PApplet parent) {
try{
String portName = Serial.list()[0];
println(portName);
port = new Serial(parent, portName, 115200);
}
catch(Exception e) {
serialError = true;
println("Could not establish serial connection with TPS!");
//stop();
}
}
void update() {
byte data[] = new byte[NUM_LEDS*3];
for(int i=0; i<NUM_LEDS; i++) {
data[i*3] = byte((col[i] >> 16 & 0xFF));
data[i*3+1] = byte((col[i] >> 8 & 0xFF));
data[i*3+2] = byte((col[i] & 0xFF));
}
if(!serialError) {
port.write(1);
port.write(data);
}
else println("Could not establish serial connection with TPS!");
}
void randomize() { for( int i=0; i<NUM_LEDS; i++) col[i] = color(random(255),random(255),random(255)); }
void clear() { for( int i=0; i<NUM_LEDS; i++) { col[i] = 0; fadeCol[i] = 0; } }
void setLed(int led, color c) { if(0<=led && led<NUM_LEDS) { col[led] = c; fadeCol[led] = c; } }
void addLed(int led, color c) { if(0<=led && led<NUM_LEDS) { blendColor(col[led], c, ADD); blendColor(fadeCol[led], c, ADD); } }
void set(color c) { for( int i=0; i<NUM_LEDS; i++) setLed(i, c); }
void add(color c) { for( int i=0; i<NUM_LEDS; i++) addLed(i, c); }
void fadeLed(int led, color c) { fadeCol[led] = c; }
void fade(color c) { for( int i=0; i<NUM_LEDS; i++) fadeLed(i, c); }
void fadeUpdate() {
final int fadeSpeed = 2;
for( int i=0; i<NUM_LEDS; i++) {
if((fadeCol[i] >> 16 & 0xFF) > (col[i] >> 16 & 0xFF)) col[i] = color((col[i] >> 16 & 0xFF)+fadeSpeed, (col[i] >> 8 & 0xFF), (col[i] & 0xFF));
else if((fadeCol[i] >> 16 & 0xFF) < (col[i] >> 16 & 0xFF)) col[i] = color((col[i] >> 16 & 0xFF)-fadeSpeed, (col[i] >> 8 & 0xFF), (col[i] & 0xFF));
if((fadeCol[i] >> 8 & 0xFF) > (col[i] >> 8 & 0xFF)) col[i] = color((col[i] >> 16 & 0xFF), (col[i] >> 8 & 0xFF)+fadeSpeed, (col[i] & 0xFF));
else if((fadeCol[i] >> 16 & 0xFF) < (col[i] >> 16 & 0xFF)) col[i] = color((col[i] >> 16 & 0xFF), (col[i] >> 8 & 0xFF)-fadeSpeed, (col[i] & 0xFF));
if((fadeCol[i] & 0xFF) > (col[i] & 0xFF)) col[i] = color((col[i] >> 16 & 0xFF), (col[i] >> 8 & 0xFF), (col[i] & 0xFF)+fadeSpeed);
else if((fadeCol[i] >> 16 & 0xFF) < (col[i] >> 16 & 0xFF)) col[i] = color((col[i] >> 16 & 0xFF), (col[i] >> 8 & 0xFF), (col[i] & 0xFF)-fadeSpeed);
}
}
class Left
{
final int OFFSET = 0;
final int NUM_LEDS = 9;
Left() { }
void setLed(int led, color c) { TPSurgery.this.setLed(OFFSET+led, c); }
void addLed(int led, color c) { TPSurgery.this.addLed(OFFSET+led, c); }
void set(color c) { for(int i=OFFSET; i<OFFSET+NUM_LEDS; i++) TPSurgery.this.setLed(i, c); }
void add(color c) { for(int i=OFFSET; i<OFFSET+NUM_LEDS; i++) TPSurgery.this.addLed(i, c); }
}
class Bottom
{
final int OFFSET = 9;
final int NUM_LEDS = 20;
Bottom() { }
void setLed(int led, color c) { TPSurgery.this.setLed(OFFSET+led, c); }
void addLed(int led, color c) { TPSurgery.this.addLed(OFFSET+led, c); }
void set(color c) { for(int i=OFFSET; i<OFFSET+NUM_LEDS; i++) TPSurgery.this.setLed(i, c); }
void add(color c) { for(int i=OFFSET; i<OFFSET+NUM_LEDS; i++) TPSurgery.this.addLed(i, c); }
}
class Right
{
final int OFFSET = 29;
final int NUM_LEDS = 9;
Right() { }
void setLed(int led, color c) { TPSurgery.this.setLed(OFFSET+led, c); }
void addLed(int led, color c) { TPSurgery.this.addLed(OFFSET+led, c); }
void set(color c) { for(int i=OFFSET; i<OFFSET+NUM_LEDS; i++) TPSurgery.this.setLed(i, c); }
void add(color c) { for(int i=OFFSET; i<OFFSET+NUM_LEDS; i++) TPSurgery.this.addLed(i, c); }
}
class Top
{
final int OFFSET = 38;
final int NUM_LEDS = 20;
Top() { }
void setLed(int led, color c) { TPSurgery.this.setLed(OFFSET+led, c); }
void addLed(int led, color c) { TPSurgery.this.addLed(OFFSET+led, c); }
void set(color c) { for(int i=OFFSET; i<OFFSET+NUM_LEDS; i++) TPSurgery.this.setLed(i, c); }
void add(color c) { for(int i=OFFSET; i<OFFSET+NUM_LEDS; i++) TPSurgery.this.addLed(i, c); }
}
class Menu
{
final int OFFSET = 58;
final int NUM_LEDS = 1;
Menu() { }
void setLed(int led, color c) { TPSurgery.this.setLed(OFFSET+led, c); }
void addLed(int led, color c) { TPSurgery.this.addLed(OFFSET+led, c); }
void set(color c) { for(int i=OFFSET; i<OFFSET+NUM_LEDS; i++) TPSurgery.this.setLed(i, c); }
void add(color c) { for(int i=OFFSET; i<OFFSET+NUM_LEDS; i++) TPSurgery.this.addLed(i, c); }
}
class Hands
{
final int OFFSET = 59;
final int NUM_LEDS = 2;
Hands() { }
void setLed(int led, color c) { TPSurgery.this.setLed(OFFSET+led, c); }
void addLed(int led, color c) { TPSurgery.this.addLed(OFFSET+led, c); }
void set(color c) { for(int i=OFFSET; i<OFFSET+NUM_LEDS; i++) TPSurgery.this.setLed(i, c); }
void add(color c) { for(int i=OFFSET; i<OFFSET+NUM_LEDS; i++) TPSurgery.this.addLed(i, c); }
}
}