//**************************************************************//
//  Name    : LED Cube Final Code                               //
//  Author  : Tim Ballas                                        //
//  Date    : 25 Nov, 2007                                      //
//  Version : 1.0                                               //
//  Notes   : This is a compilation of code from the ShiftOut   //
//          : example and the original code for Make's          //
//          : Weekend Projects                                  //
//****************************************************************

//Pin connected to ST_CP of 74HC595
int latchPin = 9;
//Pin connected to SH_CP of 74HC595
int clockPin = 8;
////Pin connected to DS of 74HC595
int dataPin = 10;

// Ground Pins
int topGND = 6;
int midGND = 12;
int botGND = 11;

int delayedby = 30;

//holders for infromation you're going to pass to shifting function
byte dataRED;
byte dataGREEN;

// table of values for 3x3x3 LEDs
// 0 is off, 1 is on for each LED
// last element must have 0 duration
int imageTab[][10] = {
// Lights up each LED for 1/2 second, starting with the top-front-left corner LED, and going to the bottom-rear-right corner LED.
  { B000, B000, B010, B000, B000, B000, B000, B000, B000, 50 },
  { B000, B000, B100, B000, B000, B000, B000, B000, B000, 50 },
  { B001, B000, B000, B000, B000, B000, B000, B000, B000, 50 },
  { B010, B000, B000, B000, B000, B000, B000, B000, B000, 50 },
  { B100, B000, B000, B000, B000, B000, B000, B000, B000, 50 },
  { B000, B001, B000, B000, B000, B000, B000, B000, B000, 50 },
  { B000, B010, B000, B000, B000, B000, B000, B000, B000, 50 },
  { B000, B100, B000, B000, B000, B000, B000, B000, B000, 50 },
  { B000, B000, B001, B000, B000, B000, B000, B000, B000, 50 },
  { B000, B000, B000, B000, B000, B010, B000, B000, B000, 50 },
  { B000, B000, B000, B000, B000, B100, B000, B000, B000, 50 },
  { B000, B000, B000, B001, B000, B000, B000, B000, B000, 50 },
  { B000, B000, B000, B010, B000, B000, B000, B000, B000, 50 },
  { B000, B000, B000, B100, B000, B000, B000, B000, B000, 50 },
  { B000, B000, B000, B000, B001, B000, B000, B000, B000, 50 },
  { B000, B000, B000, B000, B010, B000, B000, B000, B000, 50 },
  { B000, B000, B000, B000, B100, B000, B000, B000, B000, 50 },
  { B000, B000, B000, B000, B000, B001, B000, B000, B000, 50 },
  { B000, B000, B000, B000, B000, B000, B000, B000, B010, 50 },
  { B000, B000, B000, B000, B000, B000, B000, B000, B100, 50 },
  { B000, B000, B000, B000, B000, B000, B001, B000, B000, 50 },
  { B000, B000, B000, B000, B000, B000, B010, B000, B000, 50 },
  { B000, B000, B000, B000, B000, B000, B100, B000, B000, 50 },
  { B000, B000, B000, B000, B000, B000, B000, B001, B000, 50 },
  { B000, B000, B000, B000, B000, B000, B000, B010, B000, 50 },
  { B000, B000, B000, B000, B000, B000, B000, B100, B000, 50 },
  { B000, B000, B000, B000, B000, B000, B000, B000, B001, 50 },
  { B000, B000, B000, B000, B000, B000, B000, B000, B000,     0 }  // this is a dummy element for end of table (duration=0)
// END Lights up each LED for 1/2 second, starting with the top-front-left corner LED, and going to the bottom-rear-right corner LED.

/*
// Light up all LEDs then four and then one
  { B111, B111, B111, B111, B111, B111, B111, B111, B111, 50 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000, 50 },
  { B000, B000, B000, B000, B000, B000, B000, B010, B000, 50 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000, 50 },
  { B111, B111, B111, B111, B111, B111, B111, B111, B111, 50 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000, 40 },
  { B000, B000, B000, B000, B000, B000, B000, B010, B000, 40 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000, 40 },
  { B111, B111, B111, B111, B111, B111, B111, B111, B111, 40 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000, 40 },
  { B000, B000, B000, B000, B000, B000, B000, B010, B000, 30 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000, 30 },
  { B111, B111, B111, B111, B111, B111, B111, B111, B111, 30 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000, 30 },
  { B000, B000, B000, B000, B000, B000, B000, B010, B000, 30 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000, 20 },
  { B111, B111, B111, B111, B111, B111, B111, B111, B111, 20 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000, 20 },
  { B000, B000, B000, B000, B000, B000, B000, B010, B000, 20 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000, 20 },
  { B111, B111, B111, B111, B111, B111, B111, B111, B111, 10 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000, 10 },
  { B000, B000, B000, B000, B000, B000, B000, B010, B000, 10 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000, 10 },
  { B111, B111, B111, B111, B111, B111, B111, B111, B111, 10 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000,  5 },
  { B000, B000, B000, B000, B000, B000, B000, B010, B000,  5 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000,  5 },
  { B111, B111, B111, B111, B111, B111, B111, B111, B111,  5 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000,  5 },
  { B000, B000, B000, B000, B000, B000, B000, B010, B000,  4 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000,  4 },
  { B111, B111, B111, B111, B111, B111, B111, B111, B111,  4 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000,  4 },
  { B000, B000, B000, B000, B000, B000, B000, B010, B000,  4 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000,  4 },
  { B111, B111, B111, B111, B111, B111, B111, B111, B111,  4 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000,  4 },
  { B000, B000, B000, B000, B000, B000, B000, B010, B000,  4 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000,  4 },
  { B111, B111, B111, B111, B111, B111, B111, B111, B111,  4 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000,  4 },
  { B000, B000, B000, B000, B000, B000, B000, B010, B000,  4 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000,  4 },
  { B111, B111, B111, B111, B111, B111, B111, B111, B111,  4 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000,  4 },
  { B000, B000, B000, B000, B000, B000, B000, B010, B000,  4 },

  { B000, B000, B000, B000, B000, B000, B000, B000, B000,  0 }  // this is a dummy element for end of table (duration=0)
/*
  { B000, B000, B000, B110, B110, B000, B110, B110, B000,  4 },
  { B000, B000, B000, B000, B000, B000, B000, B010, B000,  4 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000,  4 },
  { B111, B111, B111, B111, B111, B111, B111, B111, B111,  4 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000,  4 },
  { B000, B000, B000, B000, B000, B000, B000, B010, B000,  4 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000,  4 },
  { B111, B111, B111, B111, B111, B111, B111, B111, B111,  4 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000,  4 },
  { B000, B000, B000, B000, B000, B000, B000, B010, B000,  4 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000,  4 },
  { B111, B111, B111, B111, B111, B111, B111, B111, B111,  4 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000,  4 },
  { B000, B000, B000, B000, B000, B000, B000, B010, B000,  4 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000,  4 },
  { B111, B111, B111, B111, B111, B111, B111, B111, B111,  4 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000,  4 },
  { B000, B000, B000, B000, B000, B000, B000, B010, B000,  4 },
  { B000, B000, B000, B110, B110, B000, B110, B110, B000,  4 },
  { B111, B111, B111, B111, B111, B111, B111, B111, B111,  4 },
  
  { B000, B000, B000, B000, B000, B000, B000, B000, B000,  0 }  // this is a dummy element for end of table (duration=0)
*/
// END Light up all LEDs then four and then one

/*
// Plus sign turning
  { B100, B000, B000, B110, B001, B000, B100, B000, B000, 50 },
  { B100, B000, B000, B101, B010, B000, B100, B000, B000, 50 },
  { B100, B000, B000, B100, B100, B100, B100, B000, B000, 50 },
  { B100, B000, B000, B100, B000, B011, B100, B000, B000, 50 },
  { B000, B000, B000, B000, B000, B000, B000, B000, B000,  0 }  // this is a dummy element for end of table (duration=0)
*/
// END Plus sign turning

/*
// Plus sign turning speeding up
  { B100, B000, B000, B110, B001, B000, B100, B000, B000, 50 },
  { B100, B000, B000, B101, B010, B000, B100, B000, B000, 50 },
  { B100, B000, B000, B100, B100, B100, B100, B000, B000, 50 },
  { B100, B000, B000, B100, B000, B011, B100, B000, B000, 50 },
  
  { B100, B000, B000, B110, B001, B000, B100, B000, B000, 40 },
  { B100, B000, B000, B101, B010, B000, B100, B000, B000, 40 },
  { B100, B000, B000, B100, B100, B100, B100, B000, B000, 40 },
  { B100, B000, B000, B100, B000, B011, B100, B000, B000, 40 },
  
  { B100, B000, B000, B110, B001, B000, B100, B000, B000, 30 },
  { B100, B000, B000, B101, B010, B000, B100, B000, B000, 30 },
  { B100, B000, B000, B100, B100, B100, B100, B000, B000, 30 },
  { B100, B000, B000, B100, B000, B011, B100, B000, B000, 30 },

  { B100, B000, B000, B110, B001, B000, B100, B000, B000, 20 },
  { B100, B000, B000, B101, B010, B000, B100, B000, B000, 20 },
  { B100, B000, B000, B100, B100, B100, B100, B000, B000, 20 },
  { B100, B000, B000, B100, B000, B011, B100, B000, B000, 20 },
  
  { B100, B000, B000, B110, B001, B000, B100, B000, B000, 10 },
  { B100, B000, B000, B101, B010, B000, B100, B000, B000, 10 },
  { B100, B000, B000, B100, B100, B100, B100, B000, B000, 10 },
  { B100, B000, B000, B100, B000, B011, B100, B000, B000, 10 },

  { B000, B000, B000, B000, B000, B000, B000, B000, B000,  0 }  // this is a dummy element for end of table (duration=0)
// END Plus sign turning speeding up
*/
/*
  { B001, B000, B000, B000, B000, B000, B000, B000, B000, 50 },
  { B000, B000, B000, B100, B000, B000, B000, B000, B000, 50 },
  { B000, B000, B000, B000, B000, B000, B000, B010, B000, 50 },
//  { B001, B000, B000, B100, B000, B000, B000, B010, B000, 50 },
  { B000, B000, B000, B000, B000, B000, B000, B000, B000, 0 }
*/
/*
  { B100, B000, B000, B000, B000, B000, B000, B000, B000, 50 },
  { B010, B000, B000, B000, B000, B000, B000, B000, B000, 50 },
  { B001, B000, B000, B000, B000, B000, B000, B000, B000, 50 },
  { B000, B100, B000, B000, B000, B000, B000, B000, B000, 50 },
  { B000, B010, B000, B000, B000, B000, B000, B000, B000, 50 },
  { B000, B001, B000, B000, B000, B000, B000, B000, B000, 50 },
  { B000, B000, B100, B000, B000, B000, B000, B000, B000, 50 },
  { B000, B000, B010, B000, B000, B000, B000, B000, B000, 50 },
  { B000, B000, B001, B000, B000, B000, B000, B000, B000, 50 },
  { B000, B000, B000, B100, B000, B000, B000, B000, B000, 50 },
  { B000, B000, B000, B010, B000, B000, B000, B000, B000, 50 },
  { B000, B000, B000, B001, B000, B000, B000, B000, B000, 50 },
  { B000, B000, B000, B000, B100, B000, B000, B000, B000, 50 },
  { B000, B000, B000, B000, B010, B000, B000, B000, B000, 50 },
  { B000, B000, B000, B000, B001, B000, B000, B000, B000, 50 },
  { B000, B000, B000, B000, B000, B100, B000, B000, B000, 50 },
  { B000, B000, B000, B000, B000, B010, B000, B000, B000, 50 },
  { B000, B000, B000, B000, B000, B001, B000, B000, B000, 50 },
  { B000, B000, B000, B000, B000, B000, B100, B000, B000, 50 },
  { B000, B000, B000, B000, B000, B000, B010, B000, B000, 50 },
  { B000, B000, B000, B000, B000, B000, B001, B000, B000, 50 },
  { B000, B000, B000, B000, B000, B000, B000, B100, B000, 50 },
  { B000, B000, B000, B000, B000, B000, B000, B010, B000, 50 },
  { B000, B000, B000, B000, B000, B000, B000, B001, B000, 50 },
  { B000, B000, B000, B000, B000, B000, B000, B000, B100, 50 },
  { B000, B000, B000, B000, B000, B000, B000, B000, B010, 50 },
  { B000, B000, B000, B000, B000, B000, B000, B000, B001, 50 },
  { B000, B000, B000, B000, B000, B000, B000, B000, B000,     0 }  // this is a dummy element for end of table (duration=0)
*/
/*
	{ B000, B000, B001, B000, B000, B000, B000, B000, B000, 50 },
	{ B000, B001, B000, B000, B000, B000, B000, B000, B000, 50 },
	{ B001, B000, B000, B000, B000, B000, B000, B000, B000, 50 },
	{ B000, B100, B000, B000, B000, B000, B000, B000, B000, 50 },
	{ B100, B000, B000, B000, B000, B000, B000, B000, B000, 50 },
	{ B000, B000, B100, B000, B000, B000, B000, B000, B000, 50 },
	{ B000, B010, B000, B000, B000, B000, B000, B000, B000, 50 },
	{ B010, B000, B000, B000, B000, B000, B000, B000, B000, 50 },
	{ B000, B000, B010, B000, B000, B000, B000, B000, B000, 50 },
	{ B000, B000, B000, B000, B000, B001, B000, B000, B000, 50 },
	{ B000, B000, B000, B000, B001, B000, B000, B000, B000, 50 },
	{ B000, B000, B000, B001, B000, B000, B000, B000, B000, 50 },
	{ B000, B000, B000, B000, B100, B000, B000, B000, B000, 50 },
	{ B000, B000, B000, B100, B000, B000, B000, B000, B000, 50 },
	{ B000, B000, B000, B000, B000, B100, B000, B000, B000, 50 },
	{ B000, B000, B000, B000, B010, B000, B000, B000, B000, 50 },
	{ B000, B000, B000, B010, B000, B000, B000, B000, B000, 50 },
	{ B000, B000, B000, B000, B000, B010, B000, B000, B000, 50 },
	{ B000, B000, B000, B000, B000, B000, B000, B000, B001, 50 },
	{ B000, B000, B000, B000, B000, B000, B000, B001, B000, 50 },
	{ B000, B000, B000, B000, B000, B000, B001, B000, B000, 50 },
	{ B000, B000, B000, B000, B000, B000, B000, B100, B000, 50 },
	{ B000, B000, B000, B000, B000, B000, B100, B000, B000, 50 },
	{ B000, B000, B000, B000, B000, B000, B000, B000, B100, 50 },
	{ B000, B000, B000, B000, B000, B000, B000, B010, B000, 50 },
	{ B000, B000, B000, B000, B000, B000, B010, B000, B000, 50 },
	{ B000, B000, B000, B000, B000, B000, B000, B000, B010, 50 },
	{ B000, B000, B000, B000, B000, B000, B000, B000, B000, 0 }
*/
};


// This function delays the specified number of 1/10 milliseconds
void delay_one_tenth_ms(unsigned long int ms) {
  unsigned long int timer;
  unsigned long int DelayCount = 87;  // this value was determined by trial and error

  while (ms != 0) {
    // Toggling PD6 is done here to force the compiler to do this loop, rather than optimize it away
    for (timer=0; timer <= DelayCount; timer++) {PORTD |= B00000100;};
    ms--;
  }
}


// This function displays a 3x3x3 image by multiplexing through the images for the 3 planes.
//   The multiplex rate is about 111Hz.
// This function also acts as a delay for the Duration specified.
byte displayImage(int index) {
  unsigned long int duration = imageTab[index][9];
  unsigned char topRow0 = imageTab[index][0];
  unsigned char midRow0 = imageTab[index][1];
  unsigned char botRow0 = imageTab[index][2];
  unsigned char topRow1 = imageTab[index][3];
  unsigned char midRow1 = imageTab[index][4];
  unsigned char botRow1 = imageTab[index][5];
  unsigned char topRow2 = imageTab[index][6];
  unsigned char midRow2 = imageTab[index][7];
  unsigned char botRow2 = imageTab[index][8];
  for (int i=0; i<duration; i++) {
    dataRED |= ( topRow0<<1 | midRow0<<4 | botRow0<<7 );
    dataGREEN |= ( ( botRow0 & B110 ) << 5);
    //ground latchPin and hold low for as long as you are transmitting
    digitalWrite(latchPin, 0);
   /* Serial.print(dataRED,BIN);
    Serial.print(" ");
    Serial.println(dataGREEN,BIN);
  */  //move 'em out
    shiftOut(dataPin, clockPin, dataGREEN); 
    shiftOut(dataPin, clockPin, dataRED);
    //return the latch pin high to signal chip that it 
    //no longer needs to listen for information
    digitalWrite(latchPin, 1);
    pinMode(topGND, OUTPUT);
    digitalWrite(topGND,LOW);
    delay_one_tenth_ms(delayedby);
    pinMode(topGND, INPUT);
    dataRED = B00000000;
    dataGREEN = B00000000;
    //ground latchPin and hold low for as long as you are transmitting
    digitalWrite(latchPin, 0);
  /*  Serial.print(dataRED,BIN);
    Serial.print(" ");
    Serial.println(dataGREEN,BIN);
   */ //move 'em out
    shiftOut(dataPin, clockPin, dataGREEN); 
    shiftOut(dataPin, clockPin, dataRED);
    //return the latch pin high to signal chip that it 
    //no longer needs to listen for information
    digitalWrite(latchPin, 1);

    dataRED |= ( topRow1<<1 | midRow1<<4 | botRow1<<7 );
    dataGREEN |= ( ( botRow1 & B110 ) << 5);
    //ground latchPin and hold low for as long as you are transmitting
    digitalWrite(latchPin, 0);
   /* Serial.print(dataRED,BIN);
    Serial.print(" ");
    Serial.println(dataGREEN,BIN);
  */  //move 'em out
    shiftOut(dataPin, clockPin, dataGREEN); 
    shiftOut(dataPin, clockPin, dataRED);
    //return the latch pin high to signal chip that it 
    //no longer needs to listen for information
    digitalWrite(latchPin, 1);
    pinMode(midGND, OUTPUT);
    digitalWrite(midGND,LOW);
    delay_one_tenth_ms(delayedby);
    pinMode(midGND, INPUT);
    dataRED = B00000000;
    dataGREEN = B00000000;
    //ground latchPin and hold low for as long as you are transmitting
    digitalWrite(latchPin, 0);
   /* Serial.print(dataRED,BIN);
    Serial.print(" ");
    Serial.println(dataGREEN,BIN);
   */ //move 'em out
    shiftOut(dataPin, clockPin, dataGREEN); 
    shiftOut(dataPin, clockPin, dataRED);
    //return the latch pin high to signal chip that it 
    //no longer needs to listen for information
    digitalWrite(latchPin, 1);
    
    dataRED |= ( topRow2<<1 | midRow2<<4 | botRow2<<7 );
    dataGREEN |= ( ( botRow2 & B110 ) << 5);
    //ground latchPin and hold low for as long as you are transmitting
    digitalWrite(latchPin, 0);
   /* Serial.print(dataRED,BIN);
    Serial.print(" ");
    Serial.println(dataGREEN,BIN);
   */ //move 'em out
    shiftOut(dataPin, clockPin, dataGREEN); 
    shiftOut(dataPin, clockPin, dataRED);
    //return the latch pin high to signal chip that it 
    //no longer needs to listen for information
    digitalWrite(latchPin, 1);
    pinMode(botGND, OUTPUT);
    digitalWrite(botGND,LOW);
    delay_one_tenth_ms(delayedby);
    pinMode(botGND, INPUT);
    dataRED = B00000000;
    dataGREEN = B00000000;
    //ground latchPin and hold low for as long as you are transmitting
    digitalWrite(latchPin, 0);
   /* Serial.print(dataRED,BIN);
    Serial.print(" ");
    Serial.println(dataGREEN,BIN);
   */ //move 'em out
    shiftOut(dataPin, clockPin, dataGREEN); 
    shiftOut(dataPin, clockPin, dataRED);
    //return the latch pin high to signal chip that it 
    //no longer needs to listen for information
    digitalWrite(latchPin, 1);
  }
}

void setup() {
  //set pins to output because they are addressed in the main loop
  pinMode(latchPin, OUTPUT);
  pinMode(topGND, INPUT);
  pinMode(midGND, INPUT);
  pinMode(botGND, INPUT);
  //Serial.begin(9600);
}

void loop() {
  for (int j = 0; imageTab[j][9] != 0; j++) {
    displayImage(j);
  }
}

void shiftOut(int myDataPin, int myClockPin, byte myDataOut) {
  // This shifts 8 bits out MSB first, 
  //on the rising edge of the clock,
  //clock idles low

  //internal function setup
  int i=0;
  int pinState;
  pinMode(myClockPin, OUTPUT);
  pinMode(myDataPin, OUTPUT);

  //clear everything out just in case to
  //prepare shift register for bit shifting
  digitalWrite(myDataPin, 0);
  digitalWrite(myClockPin, 0);

  //for each bit in the byte myDataOut…
  //NOTICE THAT WE ARE COUNTING DOWN in our for loop
  //This means that %00000001 or "1" will go through such
  //that it will be pin Q0 that lights. 
  for (i=7; i>=0; i--)  {
    digitalWrite(myClockPin, 0);

    //if the value passed to myDataOut and a bitmask result 
    // true then... so if we are at i=6 and our value is
    // %11010100 it would the code compares it to %01000000 
    // and proceeds to set pinState to 1.
    if ( myDataOut & (1<<i) ) {
      pinState= 1;
    }
    else {	
      pinState= 0;
    }

    //Sets the pin to HIGH or LOW depending on pinState
    digitalWrite(myDataPin, pinState);
    //register shifts bits on upstroke of clock pin  
    digitalWrite(myClockPin, 1);
    //zero the data pin after shift to prevent bleed through
    digitalWrite(myDataPin, 0);
  }

  //stop shifting
  digitalWrite(myClockPin, 0);
}


//blinks the whole register based on the number of times you want to 
//blink "n" and the pause between them "d"
//starts with a moment of darkness to make sure the first blink
//has its full visual effect.
void blinkAll_2Bytes(int n, int d) {
  digitalWrite(latchPin, 0);
  shiftOut(dataPin, clockPin, 0);
  shiftOut(dataPin, clockPin, 0);
  digitalWrite(latchPin, 1);
  delay(200);
  for (int x = 0; x < n; x++) {
    digitalWrite(latchPin, 0);
    shiftOut(dataPin, clockPin, 255);
    shiftOut(dataPin, clockPin, 255);
    digitalWrite(latchPin, 1);
    delay(d);
    digitalWrite(latchPin, 0);
    shiftOut(dataPin, clockPin, 0);
    shiftOut(dataPin, clockPin, 0);
    digitalWrite(latchPin, 1);
    delay(d);
  }
}