/******************************* 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;
      }
    }    
  }  
}