// Initialize color Array
ColorArray[0][0]= 1023; ColorArray[0][1]= 0; ColorArray[0][2]= 0; //Red
ColorArray[1][0]= 1023; ColorArray[1][1]= 600; ColorArray[1][2]= 600; //Pink
ColorArray[2][0]= 1023; ColorArray[2][1]= 0; ColorArray[2][2]= 1023; //Magenta
ColorArray[3][0]= 0; ColorArray[3][1]= 0; ColorArray[3][2]= 1023; //Blue
ColorArray[4][0]= 510; ColorArray[4][1]= 510; ColorArray[4][2]= 1023; //Royal Blue
ColorArray[5][0]= 0; ColorArray[5][1]= 1023; ColorArray[5][2]= 500; //Spring Green
ColorArray[6][0]= 0; ColorArray[6][1]= 1023; ColorArray[6][2]= 0; //Green
ColorArray[7][0]= 510; ColorArray[7][1]= 1023; ColorArray[7][2]= 0; //Green Yellow
ColorArray[8][0]= 1023; ColorArray[8][1]= 1023; ColorArray[8][2]= 0; //Yellow
ColorArray[9][0]= 1023; ColorArray[9][1]= 512; ColorArray[9][2]= 0; //Orange

//Initialize Primary Colors
PrimaryColors[RED][0]=1023;
PrimaryColors[GREEN][1]=1023;
PrimaryColors[BLUE][2]=1023;

//Setup Button
pinMode(buttonPin, INPUT); // declare pushbutton as input

randomSeed(89793);
}

void SB_SendPacket() {

if (SB_CommandMode == B01) {
SB_RedCommand = 120;
SB_GreenCommand = 100;
SB_BlueCommand = 100;
}

SPDR = SB_CommandMode << 6 | SB_BlueCommand>>4;
while(!(SPSR & (1<
SPDR = SB_BlueCommand<<4 | SB_RedCommand>>6;
while(!(SPSR & (1<
SPDR = SB_RedCommand << 2 | SB_GreenCommand>>8;
while(!(SPSR & (1<
SPDR = SB_GreenCommand;
while(!(SPSR & (1<

}

void WriteLEDArray() {

SB_CommandMode = B00; // Write to PWM control registers
for (int h = 0;h
SB_RedCommand = LEDChannels[h][0];
SB_GreenCommand = LEDChannels[h][1];
SB_BlueCommand = LEDChannels[h][2];
SB_SendPacket();
}

delayMicroseconds(15);
digitalWrite(latchpin,HIGH); // latch data into registers
delayMicroseconds(15);
digitalWrite(latchpin,LOW);

SB_CommandMode = B01; // Write to current control registers
for (int z = 0; z < NumLEDs; z++) SB_SendPacket();
delayMicroseconds(15);
digitalWrite(latchpin,HIGH); // latch data into registers
delayMicroseconds(15);
digitalWrite(latchpin,LOW);

}

void ChangeToNew(int new_r1,int new_g1,int new_b1,int step_delay)
{
while ( LEDChannels[0][0] != new_r1 &&
LEDChannels[0][1] != new_g1 &&
LEDChannels[0][2] != new_b1 )
{
if ( LEDChannels[0][0] < new_r1 ) { LEDChannels[0][0]++;} else if ( LEDChannels[0][0] > new_r1 )
{ LEDChannels[0][0]--;}
if ( LEDChannels[0][1] < new_g1 ) { LEDChannels[0][1]++;} else if ( LEDChannels[0][1] > new_g1 )
{ LEDChannels[0][1]--;}
if ( LEDChannels[0][2] < new_b1 ) { LEDChannels[0][2]++;} else if ( LEDChannels[0][2] > new_b1 )
{ LEDChannels[0][2]--;}

// Shift Values on other led to do something interesting
LEDChannels[1][1] = LEDChannels[0][0];
LEDChannels[1][2] = LEDChannels[0][1];
LEDChannels[1][0] = LEDChannels[0][2];

WriteLEDArray();
delay (step_delay);
val = digitalRead(buttonPin); // read input value

if (val == HIGH ) return;
}
}

void FadeToRandom()
{
long r;

r = random(MaxColors);
ChangeToNew(ColorArray[r][0],ColorArray[r][1],ColorArray[r][2], 5 );
}

void WaitForButton()
{
while ( val == LOW )
{
val = digitalRead(buttonPin); // read input value
}
val = LOW;
}

void SetColor(int c1, int c2)
{
LEDChannels[0][0]=PrimaryColors[c1][0];
LEDChannels[0][1]=PrimaryColors[c1][1];
LEDChannels[0][2]=PrimaryColors[c1][2];
LEDChannels[1][0]=PrimaryColors[c2][0];
LEDChannels[1][1]=PrimaryColors[c2][1];
LEDChannels[1][2]=PrimaryColors[c2][2];
WriteLEDArray();
}

void loop() {
val = LOW;
int i;

SetColor(RED,RED);
delay (wait);
WaitForButton();

SetColor(RED,GREEN);
delay (wait);
WaitForButton();

SetColor(GREEN,GREEN);
delay (wait);
WaitForButton();

SetColor(GREEN,BLUE);
delay (wait);
WaitForButton();

SetColor(BLUE,BLUE);
delay (wait);
WaitForButton();

SetColor(RED,BLUE);
delay (wait);
WaitForButton();

SetColor(GREEN,RED);
delay (wait);
WaitForButton();

SetColor(BLUE,RED);
delay (wait);
WaitForButton();

SetColor(BLUE,GREEN);
delay (wait);
WaitForButton();

delay (wait/2);
while (val == LOW )
{
FadeToRandom();
delay (wait);
}
val = LOW;