#include <Wire.h>
#include <Adafruit_PWMServoDriver.h>

// Define PCA9685 addresses
#define PCA9685_ADDRESS_0  0x40
#define PCA9685_ADDRESS_1  0x41
#define PCA9685_ADDRESS_2  0x42
#define PCA9685_ADDRESS_3  0x43

Adafruit_PWMServoDriver pwm0 = Adafruit_PWMServoDriver(PCA9685_ADDRESS_0, Wire);
Adafruit_PWMServoDriver pwm1 = Adafruit_PWMServoDriver(PCA9685_ADDRESS_1, Wire);
Adafruit_PWMServoDriver pwm2 = Adafruit_PWMServoDriver(PCA9685_ADDRESS_2, Wire);
Adafruit_PWMServoDriver pwm3 = Adafruit_PWMServoDriver(PCA9685_ADDRESS_3, Wire);

Adafruit_PWMServoDriver PWMs[4] = {pwm0, pwm1, pwm2, pwm3};



int color[][5] = {
  {255, 0, 0},
  {0, 0, 255},
  {255, 255, 0},
  {0, 255, 0},
  {255, 255, 255},
  {0, 0, 0}
};

int color_red    = 0;
int color_blue   = 1;
int color_yellow = 2;
int color_green  = 3;
int color_white  = 4;
int color_black  = 5;


int myleds_PWM_unit[20];
int myleds_port_number[20];

// this is the numbering for the first red_blue section
int red_blue_1_start = 0;
int red_blue_1_end = 12;
// this is the numbering for the second red_blue section
int red_blue_2_start = 18;
int red_blue_2_end = 20;
// this is the numbering for the front white section
int white_start = 0;
int white_end = 10;
// this is the numbering for the back yellow section
int yellow_start = 13;
int yellow_end = 18;





void setup() {

  // starts the PWM units and sets the Freq
  for ( int x = 0; x < 4; x++)
  {
    PWMs[x].begin();
    PWMs[x].setPWMFreq(1000);
  }

  // this just fills the array with the values we want
  int counter = 0;   // this counter keeps track of the led number
  for ( int pwm_unit = 0; pwm_unit < 4; pwm_unit++)
  {
    // we start at x = 0
    // for each we also do this
    for (int port = 0; port < 5; port++)
    {
      myleds_PWM_unit[counter] = pwm_unit;
      myleds_port_number[counter]  =  port;
      counter++;
    }
  }
  // your delay - assume for chip settle
  delay(10);

  pinMode(3, INPUT_PULLUP);
  pinMode(4, INPUT_PULLUP);
  pinMode(5, INPUT_PULLUP);
  pinMode(6, INPUT_PULLUP);
  pinMode(7, INPUT_PULLUP);
}


// trafficAdvisorL();
//trafficAdvisorR();
//trafficAdvisorM();
//trafficAdvisorS();
//unnamedPattern();
//unnamedPattern2();
//doubleDual();

void loop()
{

frame1();
frame2();
frame3();
frame4();
frame5();
frame6();

}

/*
  int color_red    = 0;
  int color_blue   = 1;
  int color_yellow = 2;
  int color_green  = 3;
  int color_white  = 4;
  int color_black  = 5;
*/

void setLED(uint8_t lednumber, uint8_t color_num) {
  // this sets the color based on the number that comes in (color_num)
  int Rvalue = color[color_num][0];
  int Gvalue = color[color_num][1];
  int Bvalue = color[color_num][2];

  // this is your code to map to 4096 from 255
  uint16_t redPWM = (Rvalue == 0) ? 4096 : map(Rvalue, 0, 255, 0, 4095);
  uint16_t greenPWM = (Gvalue == 0) ? 4096 : map(Gvalue, 0, 255, 0, 4095);
  uint16_t bluePWM = (Bvalue == 0) ? 4096 : map(Bvalue, 0, 255, 0, 4095);



  // this is where the actual PWM chip and LED are set
  PWMs[myleds_PWM_unit[lednumber]].setPWM((myleds_port_number[lednumber]) * 3, 4096, redPWM);
  PWMs[myleds_PWM_unit[lednumber]].setPWM((myleds_port_number[lednumber]) * 3 + 1, 4096, greenPWM);
  PWMs[myleds_PWM_unit[lednumber]].setPWM((myleds_port_number[lednumber]) * 3 + 2, 4096, bluePWM);

}


//-------------------//-------------------//-------------------//-------------------//-------
//PATTERNS
//-------------------//-------------------//-------------------//-------------------//-------

void chipWireTest()
{
  for ( int x = red_blue_1_start ; x < red_blue_1_end; x++)
  {
    if ( x % 2 == 0)
    { setLED(x, color_red);
    }
    else
    {
      setLED(x, color_blue);
    }

    delay(100);
  }
  for ( int x = red_blue_1_end; x < red_blue_2_start; x++)
  {
    setLED(x, color_yellow);
    delay(100);
  }

  for ( int x = red_blue_2_start; x < red_blue_2_end; x++)
  {
    if ( x % 2 == 0)
    { setLED(x, color_red);
    }
    else
    {
      setLED(x, color_blue);
    }
    delay(100);
  }
  delay(1000);
  for ( int x = white_start; x < white_end; x++)
  {
    setLED(x, color_white);
    delay(100);
  }


  delay(3000);
  for ( int x = 0; x < 20; x++)
  {
    setLED(x, color_blue);
  }
  delay(300);
  for ( int x = 0; x < 20; x++)
  {
    setLED(x, color_yellow);
  }
  delay(300);
  for ( int x = 0; x < 20; x++)
  {
    setLED(x, color_green);
  }
  delay(300);
}



void trafficAdvisorL()
{
  
  setLED(12, 2);
  delay(300);
  setLED(13, 2);
  delay(300);
  setLED(14, 2);
  delay(300);
  setLED(15, 2);
  delay(300);
  setLED(16, 2);
  delay(300);
  setLED(17, 2);
  delay(300);
  allOff();
  delay(300);
}




void trafficAdvisorR()
{
  setLED(17, 2);
  delay(300);
  setLED(16, 2);
  delay(300);
  setLED(15, 2);
  delay(300);
  setLED(14, 2);
  delay(300);
  setLED(13, 2);
  delay(300);
  setLED(12, 2);
  delay(300);
  allOff();
  delay(300);
}

void trafficAdvisorM()
{
  setLED(14, 2);
  setLED(15, 2);
  delay(450);
  setLED(13, 2);
  setLED(16, 2);
  delay(450);
  setLED(12, 2);
  setLED(17, 2);
  delay(450);
  allOff();
  delay(450);
}


/*
  
  void trafficAdvisorS()
  {
  subTAS1();
  subTAS1();
  subTAS1();
  subTAS1();
  subTAS1();
  subTAS2();
  subTAS2();
  subTAS2();
  subTAS2();
  subTAS2();
  subTAS3();
  subTAS3();
  subTAS3();
  subTAS3();
  subTAS3();
  }
*/
void allOff()
{
  for ( int x = 0; x < 20; x++)
  {
    setLED(x, color_black);
  }

}


void allRed()
{
  for ( int x = 0; x < 20; x++)
  {
    setLED(x, color_red);
  }
}

void allBlue()
{
  for ( int x = 0; x < 20; x++)
  {
    setLED(x, color_blue);
  }
}

void leftSideRed()
{
  setLED(0, 0);
  setLED(1, 0);
  setLED(2, 0);
  setLED(3, 0);
  setLED(4, 0);
  setLED(15, 0);
  setLED(16, 0);
  setLED(17, 0);
  setLED(18, 0);
  setLED(19, 0);
  setLED(19, 0);
}

void rightSideRed()
{
  setLED(5, 0);
  setLED(6, 0);
  setLED(7, 0);
  setLED(8, 0);
  setLED(9, 0);
  setLED(10, 0);
  setLED(11, 0);
  setLED(12, 0);
  setLED(13, 0);
  setLED(14, 0);
}

void leftSideBlue()
{
  setLED(0, 1);
  setLED(1, 1);
  setLED(2, 1);
  setLED(3, 1);
  setLED(4, 1);
  setLED(15, 1);
  setLED(16, 1);
  setLED(17, 1);
  setLED(18, 1);
  setLED(19, 1);
  setLED(19, 1);
}

void rightSideBlue()
{
  setLED(5, 1);
  setLED(6, 1);
  setLED(7, 1);
  setLED(8, 1);
  setLED(9, 1);
  setLED(10, 1);
  setLED(11, 1);
  setLED(12, 1);
  setLED(13, 1);
  setLED(14, 1);
}



  void patternTest()
{
  leftSideRed();
  delay(300);
  allOff();
  rightSideRed();
  delay(300);
  allOff();
  leftSideBlue();
  delay(300);
  allOff();
  rightSideBlue();
  delay(300);
  allOff();
}

/*
  void doubleDual()
  {
  leftSideRed();
  delay(60);
  allOff();
  delay(20);
  leftSideRed();
  delay(60);
  allOff();
  delay(20);
  rightSideRed();
  delay(60);
  allOff();
  rightSideRed();
  delay(60);
  allOff();
  rightSideRed();
  delay(60);
  allOff();
  leftSideBlue();
  delay(60);
  allOff();
  delay(20);
  leftSideBlue();
  delay(60);
  allOff();
  delay(20);
  rightSideBlue();
  delay(60);
  allOff();
  rightSideBlue();
  delay(60);
  allOff();
  rightSideBlue();
  delay(60);
  allOff();

  }
  void unnamedPattern()
  {
  setLED(1, 255, 0, 0, pwm0);
  setLED(3, 255, 0, 0, pwm0);
  setLED(5, 255, 0, 0, pwm0);
  setLED(2, 255, 0, 0, pwm1);
  setLED(4, 255, 0, 0, pwm1);
  setLED(6, 255, 0, 0, pwm1);
  setLED(1, 255, 0, 0, pwm2);
  setLED(3, 255, 0, 0, pwm2);
  setLED(5, 255, 0, 0, pwm2);
  setLED(2, 255, 0, 0, pwm3);
  setLED(4, 255, 0, 0, pwm3);
  setLED(6, 255, 0, 0, pwm3);
  delay(60);
  allOff();
  delay(20);
  setLED(1, 255, 0, 0, pwm0);
  setLED(3, 255, 0, 0, pwm0);
  setLED(5, 255, 0, 0, pwm0);
  setLED(2, 255, 0, 0, pwm1);
  setLED(4, 255, 0, 0, pwm1);
  setLED(6, 255, 0, 0, pwm1);
  setLED(1, 255, 0, 0, pwm2);
  setLED(3, 255, 0, 0, pwm2);
  setLED(5, 255, 0, 0, pwm2);
  setLED(2, 255, 0, 0, pwm3);
  setLED(4, 255, 0, 0, pwm3);
  setLED(6, 255, 0, 0, pwm3);
  delay(60);
  allOff();
  delay(20);
  setLED(1, 255, 0, 0, pwm0);
  setLED(3, 255, 0, 0, pwm0);
  setLED(5, 255, 0, 0, pwm0);
  setLED(2, 255, 0, 0, pwm1);
  setLED(4, 255, 0, 0, pwm1);
  setLED(6, 255, 0, 0, pwm1);
  setLED(1, 255, 0, 0, pwm2);
  setLED(3, 255, 0, 0, pwm2);
  setLED(5, 255, 0, 0, pwm2);
  setLED(2, 255, 0, 0, pwm3);
  setLED(4, 255, 0, 0, pwm3);
  setLED(6, 255, 0, 0, pwm3);
  delay(60);
  allOff();
  delay(20);
  setLED(2, 255, 0, 0, pwm0);
  setLED(4, 255, 0, 0, pwm0);
  setLED(6, 255, 0, 0, pwm0);
  setLED(1, 255, 0, 0, pwm1);
  setLED(3, 255, 0, 0, pwm1);
  setLED(5, 255, 0, 0, pwm1);
  setLED(2, 255, 0, 0, pwm2);
  setLED(4, 255, 0, 0, pwm2);
  setLED(6, 255, 0, 0, pwm2);
  setLED(1, 255, 0, 0, pwm3);
  setLED(3, 255, 0, 0, pwm3);
  setLED(5, 255, 0, 0, pwm3);
  delay(60);
  allOff();
  delay(20);
  setLED(2, 255, 0, 0, pwm0);
  setLED(4, 255, 0, 0, pwm0);
  setLED(6, 255, 0, 0, pwm0);
  setLED(1, 255, 0, 0, pwm1);
  setLED(3, 255, 0, 0, pwm1);
  setLED(5, 255, 0, 0, pwm1);
  setLED(2, 255, 0, 0, pwm2);
  setLED(4, 255, 0, 0, pwm2);
  setLED(6, 255, 0, 0, pwm2);
  setLED(1, 255, 0, 0, pwm3);
  setLED(3, 255, 0, 0, pwm3);
  setLED(5, 255, 0, 0, pwm3);
  delay(60);
  allOff();
  delay(20);
  setLED(2, 255, 0, 0, pwm0);
  setLED(4, 255, 0, 0, pwm0);
  setLED(6, 255, 0, 0, pwm0);
  setLED(1, 255, 0, 0, pwm1);
  setLED(3, 255, 0, 0, pwm1);
  setLED(5, 255, 0, 0, pwm1);
  setLED(2, 255, 0, 0, pwm2);
  setLED(4, 255, 0, 0, pwm2);
  setLED(6, 255, 0, 0, pwm2);
  setLED(1, 255, 0, 0, pwm3);
  setLED(3, 255, 0, 0, pwm3);
  setLED(5, 255, 0, 0, pwm3);
  delay(60);
  allOff();
  delay(20);
  setLED(1, 0, 0, 255, pwm0);
  setLED(3, 0, 0, 255, pwm0);
  setLED(5, 0, 0, 255, pwm0);
  setLED(2, 0, 0, 255, pwm1);
  setLED(4, 0, 0, 255, pwm1);
  setLED(6, 0, 0, 255, pwm1);
  setLED(1, 0, 0, 255, pwm2);
  setLED(3, 0, 0, 255, pwm2);
  setLED(5, 0, 0, 255, pwm2);
  setLED(2, 0, 0, 255, pwm3);
  setLED(4, 0, 0, 255, pwm3);
  setLED(6, 0, 0, 255, pwm3);
  delay(60);
  allOff();
  delay(20);
  setLED(1, 0, 0, 255, pwm0);
  setLED(3, 0, 0, 255, pwm0);
  setLED(5, 0, 0, 255, pwm0);
  setLED(2, 0, 0, 255, pwm1);
  setLED(4, 0, 0, 255, pwm1);
  setLED(6, 0, 0, 255, pwm1);
  setLED(1, 0, 0, 255, pwm2);
  setLED(3, 0, 0, 255, pwm2);
  setLED(5, 0, 0, 255, pwm2);
  setLED(2, 0, 0, 255, pwm3);
  setLED(4, 0, 0, 255, pwm3);
  setLED(6, 0, 0, 255, pwm3);
  delay(60);
  allOff();
  delay(20);
  setLED(1, 0, 0, 255, pwm0);
  setLED(3, 0, 0, 255, pwm0);
  setLED(5, 0, 0, 255, pwm0);
  setLED(2, 0, 0, 255, pwm1);
  setLED(4, 0, 0, 255, pwm1);
  setLED(6, 0, 0, 255, pwm1);
  setLED(1, 0, 0, 255, pwm2);
  setLED(3, 0, 0, 255, pwm2);
  setLED(5, 0, 0, 255, pwm2);
  setLED(2, 0, 0, 255, pwm3);
  setLED(4, 0, 0, 255, pwm3);
  setLED(6, 0, 0, 255, pwm3);
  delay(60);
  allOff();
  delay(20);
  setLED(2, 0, 0, 255, pwm0);
  setLED(4, 0, 0, 255, pwm0);
  setLED(6, 0, 0, 255, pwm0);
  setLED(1, 0, 0, 255, pwm1);
  setLED(3, 0, 0, 255, pwm1);
  setLED(5, 0, 0, 255, pwm1);
  setLED(2, 0, 0, 255, pwm2);
  setLED(4, 0, 0, 255, pwm2);
  setLED(6, 0, 0, 255, pwm2);
  setLED(1, 0, 0, 255, pwm3);
  setLED(3, 0, 0, 255, pwm3);
  setLED(5, 0, 0, 255, pwm3);
  delay(60);
  allOff();
  delay(20);
  setLED(2, 0, 0, 255, pwm0);
  setLED(4, 0, 0, 255, pwm0);
  setLED(6, 0, 0, 255, pwm0);
  setLED(1, 0, 0, 255, pwm1);
  setLED(3, 0, 0, 255, pwm1);
  setLED(5, 0, 0, 255, pwm1);
  setLED(2, 0, 0, 255, pwm2);
  setLED(4, 0, 0, 255, pwm2);
  setLED(6, 0, 0, 255, pwm2);
  setLED(1, 0, 0, 255, pwm3);
  setLED(3, 0, 0, 255, pwm3);
  setLED(5, 0, 0, 255, pwm3);
  delay(60);
  allOff();
  delay(20);
  setLED(2, 0, 0, 255, pwm0);
  setLED(4, 0, 0, 255, pwm0);
  setLED(6, 0, 0, 255, pwm0);
  setLED(1, 0, 0, 255, pwm1);
  setLED(3, 0, 0, 255, pwm1);
  setLED(5, 0, 0, 255, pwm1);
  setLED(2, 0, 0, 255, pwm2);
  setLED(4, 0, 0, 255, pwm2);
  setLED(6, 0, 0, 255, pwm2);
  setLED(1, 0, 0, 255, pwm3);
  setLED(3, 0, 0, 255, pwm3);
  setLED(5, 0, 0, 255, pwm3);
  delay(60);
  allOff();
  delay(20);
  }


  void unnamedPattern2()
  {
  setLED(1, 255, 0, 0, pwm0);
  setLED(2, 255, 0, 0, pwm0);
  setLED(5, 255, 0, 0, pwm0);
  setLED(1, 255, 0, 0, pwm1);
  setLED(4, 255, 0, 0, pwm1);
  setLED(5, 255, 0, 0, pwm1);
  setLED(3, 255, 0, 0, pwm2);
  setLED(4, 255, 0, 0, pwm2);
  setLED(2, 255, 0, 0, pwm3);
  setLED(3, 255, 0, 0, pwm3);
  delay(60);
  allOff();
  delay(20);
  setLED(1, 255, 0, 0, pwm0);
  setLED(2, 255, 0, 0, pwm0);
  setLED(5, 255, 0, 0, pwm0);
  setLED(1, 255, 0, 0, pwm1);
  setLED(4, 255, 0, 0, pwm1);
  setLED(5, 255, 0, 0, pwm1);
  setLED(3, 255, 0, 0, pwm2);
  setLED(4, 255, 0, 0, pwm2);
  setLED(2, 255, 0, 0, pwm3);
  setLED(3, 255, 0, 0, pwm3);
  delay(60);
  allOff();
  delay(20);
  setLED(1, 255, 0, 0, pwm0);
  setLED(2, 255, 0, 0, pwm0);
  setLED(5, 255, 0, 0, pwm0);
  setLED(1, 255, 0, 0, pwm1);
  setLED(4, 255, 0, 0, pwm1);
  setLED(5, 255, 0, 0, pwm1);
  setLED(3, 255, 0, 0, pwm2);
  setLED(4, 255, 0, 0, pwm2);
  setLED(2, 255, 0, 0, pwm3);
  setLED(3, 255, 0, 0, pwm3);
  delay(60);
  allOff();
  delay(20);
  setLED(3, 255, 0, 0, pwm0);
  setLED(4, 255, 0, 0, pwm0);
  setLED(2, 255, 0, 0, pwm1);
  setLED(3, 255, 0, 0, pwm1);
  setLED(1, 255, 0, 0, pwm2);
  setLED(2, 255, 0, 0, pwm2);
  setLED(5, 255, 0, 0, pwm2);
  setLED(1, 255, 0, 0, pwm3);
  setLED(4, 255, 0, 0, pwm3);
  setLED(5, 255, 0, 0, pwm3);
  delay(60);
  allOff();
  delay(20);
  setLED(3, 255, 0, 0, pwm0);
  setLED(4, 255, 0, 0, pwm0);
  setLED(2, 255, 0, 0, pwm1);
  setLED(3, 255, 0, 0, pwm1);
  setLED(1, 255, 0, 0, pwm2);
  setLED(2, 255, 0, 0, pwm2);
  setLED(5, 255, 0, 0, pwm2);
  setLED(1, 255, 0, 0, pwm3);
  setLED(4, 255, 0, 0, pwm3);
  setLED(5, 255, 0, 0, pwm3);
  delay(60);
  allOff();
  delay(20);
  setLED(3, 255, 0, 0, pwm0);
  setLED(4, 255, 0, 0, pwm0);
  setLED(2, 255, 0, 0, pwm1);
  setLED(3, 255, 0, 0, pwm1);
  setLED(1, 255, 0, 0, pwm2);
  setLED(2, 255, 0, 0, pwm2);
  setLED(5, 255, 0, 0, pwm2);
  setLED(1, 255, 0, 0, pwm3);
  setLED(4, 255, 0, 0, pwm3);
  setLED(5, 255, 0, 0, pwm3);
  delay(60);
  allOff();
  delay(20);
  setLED(1, 0, 0, 255, pwm0);
  setLED(2, 0, 0, 255, pwm0);
  setLED(5, 0, 0, 255, pwm0);
  setLED(1, 0, 0, 255, pwm1);
  setLED(4, 0, 0, 255, pwm1);
  setLED(5, 0, 0, 255, pwm1);
  setLED(3, 0, 0, 255, pwm2);
  setLED(4, 0, 0, 255, pwm2);
  setLED(2, 0, 0, 255, pwm3);
  setLED(3, 0, 0, 255, pwm3);
  delay(60);
  allOff();
  delay(20);
  setLED(1, 0, 0, 255, pwm0);
  setLED(2, 0, 0, 255, pwm0);
  setLED(5, 0, 0, 255, pwm0);
  setLED(1, 0, 0, 255, pwm1);
  setLED(4, 0, 0, 255, pwm1);
  setLED(5, 0, 0, 255, pwm1);
  setLED(3, 0, 0, 255, pwm2);
  setLED(4, 0, 0, 255, pwm2);
  setLED(2, 0, 0, 255, pwm3);
  setLED(3, 0, 0, 255, pwm3);
  delay(60);
  allOff();
  delay(20);
  setLED(1, 0, 0, 255, pwm0);
  setLED(2, 0, 0, 255, pwm0);
  setLED(5, 0, 0, 255, pwm0);
  setLED(1, 0, 0, 255, pwm1);
  setLED(4, 0, 0, 255, pwm1);
  setLED(5, 0, 0, 255, pwm1);
  setLED(3, 0, 0, 255, pwm2);
  setLED(4, 0, 0, 255, pwm2);
  setLED(2, 0, 0, 255, pwm3);
  setLED(3, 0, 0, 255, pwm3);
  delay(60);
  allOff();
  delay(20);
  setLED(3, 0, 0, 255, pwm0);
  setLED(4, 0, 0, 255, pwm0);
  setLED(2, 0, 0, 255, pwm1);
  setLED(3, 0, 0, 255, pwm1);
  setLED(1, 0, 0, 255, pwm2);
  setLED(2, 0, 0, 255, pwm2);
  setLED(5, 0, 0, 255, pwm2);
  setLED(1, 0, 0, 255, pwm3);
  setLED(4, 0, 0, 255, pwm3);
  setLED(5, 0, 0, 255, pwm3);
  delay(60);
  allOff();
  delay(20);
  setLED(3, 0, 0, 255, pwm0);
  setLED(4, 0, 0, 255, pwm0);
  setLED(2, 0, 0, 255, pwm1);
  setLED(3, 0, 0, 255, pwm1);
  setLED(1, 0, 0, 255, pwm2);
  setLED(2, 0, 0, 255, pwm2);
  setLED(5, 0, 0, 255, pwm2);
  setLED(1, 0, 0, 255, pwm3);
  setLED(4, 0, 0, 255, pwm3);
  setLED(5, 0, 0, 255, pwm3);
  delay(60);
  allOff();
  delay(20);
  setLED(3, 0, 0, 255, pwm0);
  setLED(4, 0, 0, 255, pwm0);
  setLED(2, 0, 0, 255, pwm1);
  setLED(3, 0, 0, 255, pwm1);
  setLED(1, 0, 0, 255, pwm2);
  setLED(2, 0, 0, 255, pwm2);
  setLED(5, 0, 0, 255, pwm2);
  setLED(1, 0, 0, 255, pwm3);
  setLED(4, 0, 0, 255, pwm3);
  setLED(5, 0, 0, 255, pwm3);
  delay(60);
  allOff();
  delay(20);
  }





  //SUB

  void subTAS1()
  {
  setLED(2, 0, 0, 0, pwm3);
  setLED(5, 0, 0, 0, pwm2);
  setLED(3, 0, 0, 0, pwm2);
  setLED(3, 255, 255, 0, pwm3);
  setLED(1, 255, 255, 0, pwm3);
  setLED(4, 255, 255, 0, pwm2);
  delay(250);
  setLED(3, 0, 0, 0, pwm3);
  setLED(1, 0, 0, 0, pwm3);
  setLED(4, 0, 0, 0, pwm2);
  setLED(2, 255, 255, 0, pwm3);
  setLED(5, 255, 255, 0, pwm2);
  setLED(3, 255, 255, 0, pwm2);
  delay(250);
  }

  void subTAS2()
  {
  setLED(2, 0, 0, 0, pwm3);
  setLED(5, 0, 0, 0, pwm2);
  setLED(3, 0, 0, 0, pwm2);
  setLED(3, 255, 255, 0, pwm3);
  setLED(1, 255, 255, 0, pwm3);
  setLED(4, 255, 255, 0, pwm2);
  delay(100);
  setLED(3, 0, 0, 0, pwm3);
  setLED(1, 0, 0, 0, pwm3);
  setLED(4, 0, 0, 0, pwm2);
  setLED(2, 255, 255, 0, pwm3);
  setLED(5, 255, 255, 0, pwm2);
  setLED(3, 255, 255, 0, pwm2);
  delay(100);
  }

  void subTAS3()
  {
  setLED(1, 0, 0, 0, pwm3);
  setLED(2, 0, 0, 0, pwm3);
  setLED(3, 0, 0, 0, pwm3);
  setLED(3, 255, 255, 0, pwm2);
  setLED(4, 255, 255, 0, pwm2);
  setLED(5, 255, 255, 0, pwm2);
  delay(200);
  setLED(3, 0, 0, 0, pwm2);
  setLED(4, 0, 0, 0, pwm2);
  setLED(5, 0, 0, 0, pwm2);
  setLED(1, 255, 255, 0, pwm3);
  setLED(2, 255, 255, 0, pwm3);
  setLED(3, 255, 255, 0, pwm3);
  delay(200);
  }
*/