98 lines
2.4 KiB
C++
98 lines
2.4 KiB
C++
/******************************* RAINBOW CORNER *******************************\
|
|
| Found on the internet.... |
|
|
| |
|
|
| Modified By: S. Dugre to use asynchronous timer |
|
|
| |
|
|
\******************************************************************************/
|
|
|
|
int loop_rc1, loop_rc2, loop_rc3, loop_rc4;
|
|
int moveAxisState;
|
|
|
|
byte spectrum2[24][3] = {
|
|
{8,0,0},{7,1,0},{6,2,0},{5,3,0},{4,4,0},{3,5,0},{2,6,0},{1,7,0},
|
|
{0,8,0},{0,7,1},{0,6,2},{0,5,3},{0,4,4},{0,3,5},{0,2,6},{0,1,7},
|
|
{0,0,8},{1,0,7},{2,0,6},{3,0,5},{4,0,4},{5,0,3},{6,0,2},{7,0,1},
|
|
};
|
|
byte offset = 0;
|
|
byte shift[3] = {0,0,0};
|
|
bool mirror[3] = {false,false,false};
|
|
byte anim[8] = {0,2,0,1,0,2,0,1};
|
|
|
|
void drawCube() {
|
|
for (byte x = 0; x <= 3; x++) {
|
|
for (byte y = 0; y <= 3; y++) {
|
|
for (byte z = 0; z <= 3; z++) {
|
|
byte xx = mirror[0] ? 3 - x : x;
|
|
byte yy = mirror[1] ? 3 - y : y;
|
|
byte zz = mirror[2] ? 3 - z : z;
|
|
xx = shift[0] > xx ? 0 : xx - shift[0];
|
|
yy = shift[1] > yy ? 0 : yy - shift[1];
|
|
zz = shift[2] > zz ? 0 : zz - shift[2];
|
|
byte val = (offset + xx + yy + zz) % 24;
|
|
drawLed(red, spectrum2[val][0],x,y,z);
|
|
drawLed(green,spectrum2[val][1],x,y,z);
|
|
drawLed(blue, spectrum2[val][2],x,y,z);
|
|
}
|
|
}
|
|
}
|
|
flushBuffer();
|
|
clearBuffer();
|
|
offset = offset == 0 ? 23 : offset - 1;
|
|
//delay(75);
|
|
//timerReset = false;
|
|
}
|
|
|
|
void moveAxis(byte axis) {
|
|
for (int n = 1;n <= 3; n++) {
|
|
shift[axis] = n;
|
|
drawCube();
|
|
delay(75);
|
|
}
|
|
|
|
mirror[axis] = not mirror[axis];
|
|
drawCube();
|
|
delay(75);
|
|
|
|
for (int n = 2;n >= 0; n--) {
|
|
shift[axis] = n;
|
|
drawCube();
|
|
delay(75);
|
|
}
|
|
}
|
|
|
|
void rainbow_corner() {
|
|
|
|
if (currentState != lastState) {
|
|
|
|
lastState = currentState;
|
|
Serial.print("New State = ");
|
|
Serial.println(currentState);
|
|
|
|
currentTimer = 0;
|
|
maxTimer = 4687; // 75 ms
|
|
|
|
loop_rc1 = loop_rc2 = 0;
|
|
loop_rc3 = 1;
|
|
loop_rc4 = 2;
|
|
moveAxisState = 0;
|
|
}
|
|
|
|
if ( timerReset) {
|
|
|
|
if(loop_rc2 < 50){
|
|
loop_rc2++;
|
|
drawCube();
|
|
timerReset = false;
|
|
}
|
|
else {
|
|
loop_rc2 = 0;
|
|
moveAxis(anim[loop_rc1]);
|
|
if(loop_rc1 <= 7){
|
|
loop_rc1++;
|
|
}
|
|
else{
|
|
loop_rc1 = 0;
|
|
}
|
|
}
|
|
}
|
|
}
|