//Cliff Aaker
//2019.12.9
#include <Servo.h>

Servo servoA;  // create servo object to control a servo pin7
int toggleApin = 0; //create toggle switch pin
int lasttogAstate = 3; // 0 = LOW 1 = High
int curtogAstate = 0; // 0 = LOW 1 = High
Servo servoB;  // create servo object to control a servo pin8
int toggleBpin = 1; //create toggle switch pin
int lasttogBstate = 3; // 0 = LOW 1 = High
int curtogBstate = 0; // 0 = LOW 1 = High
Servo servoC;  // create servo object to control a servo pin9
int toggleCpin = 2; //create toggle switch pin
int lasttogCstate = 3; // 0 = LOW 1 = High
int curtogCstate = 0; // 0 = LOW 1 = High
Servo servoD;  // create servo object to control a servo pin10
int toggleDpin = 3; //create toggle switch pin
int lasttogDstate = 3; // 0 = LOW 1 = High
int curtogDstate = 0; // 0 = LOW 1 = High
Servo servoE;  // create servo object to control a servo pin11
int toggleEpin = 4; //create toggle switch pin
int lasttogEstate = 3; // 0 = LOW 1 = High
int curtogEstate = 0; // 0 = LOW 1 = High
Servo servoF;  // create servo object to control a servo pin12
int toggleFpin = 5; //create toggle switch pin
int lasttogFstate = 3; // 0 = LOW 1 = High
int curtogFstate = 0; // 0 = LOW 1 = High
Servo servoG;  // create servo object to control a servo pin13
int toggleGpin = 6; //create toggle switch pin
int lasttogGstate = 3; // 0 = LOW 1 = High
int curtogGstate = 0; // 0 = LOW 1 = High


int pos = 90;    // variable to store the servo position

void setup() 
{
  pinMode(toggleApin, INPUT_PULLUP);  
  pinMode(toggleBpin, INPUT_PULLUP); 
  pinMode(toggleCpin, INPUT_PULLUP);  
  pinMode(toggleDpin, INPUT_PULLUP); 
  pinMode(toggleEpin, INPUT_PULLUP);
  pinMode(toggleFpin, INPUT_PULLUP);
  pinMode(toggleGpin, INPUT_PULLUP);

}

void loop() 
{
 //BEGIN SERVO A from 66 to 114 total 48 / was 50 to 120 total 70 
  if (digitalRead(toggleApin) == LOW && digitalRead(toggleApin) == LOW && digitalRead(toggleApin) == LOW) 
  { curtogAstate = 0; } else { curtogAstate = 1; }
  
  if (curtogAstate != lasttogAstate) {   lasttogAstate = curtogAstate ; servoA.attach(7);
     if (curtogAstate == 0) {
     for (pos = 66; pos <= 114; pos += 1) { // in steps of 1 degree
     servoA.write(pos);              // tell servo to go to position in variable 'pos'
     delay(15);}                      // waits 15ms for the servo to reach the position    
   } else { 
     for (pos = 114; pos >= 66; pos -= 1) { // in steps of 1 degree
     servoA.write(pos);              // tell servo to go to position in variable 'pos'
     delay(15);}                       // waits 15ms for the servo to reach the position
   }  // else
   servoA.detach();
 }  //curtog
 //END SERVO A

 //BEGIN SERVO B 
  if (digitalRead(toggleBpin) == LOW && digitalRead(toggleBpin) == LOW && digitalRead(toggleBpin) == LOW)
  { curtogBstate = 0; } else { curtogBstate = 1; }
  
  if (curtogBstate != lasttogBstate) {   lasttogBstate = curtogBstate ; servoB.attach(8);
    if (curtogBstate == 0) {
      for (pos = 66; pos <= 114; pos += 1) { // in steps of 1 degree
      servoB.write(pos);              // tell servo to go to position in variable 'pos'
      delay(15);}                      // waits 15ms for the servo to reach the position
    } else { 
      for (pos = 114; pos >= 66; pos -= 1) { // in steps of 1 degree
      servoB.write(pos);              // tell servo to go to position in variable 'pos'
      delay(15);}                       // waits 15ms for the servo to reach the position
   }  // else
   servoB.detach();
 }  //curtog
// END SERVO B

 //BEGIN SERVO C
  if (digitalRead(toggleCpin) == LOW && digitalRead(toggleCpin) == LOW && digitalRead(toggleCpin) == LOW) 
  { curtogCstate = 0; } else { curtogCstate = 1; }
  
  if (curtogCstate != lasttogCstate) {   lasttogCstate = curtogCstate ; servoC.attach(9);
     if (curtogCstate == 0) {
     for (pos = 66; pos <= 114; pos += 1) { // in steps of 1 degree
     servoC.write(pos);              // tell servo to go to position in variable 'pos'
     delay(15);}                      // waits 15ms for the servo to reach the position    
   } else { 
     for (pos = 114; pos >= 66; pos -= 1) { // in steps of 1 degree
     servoC.write(pos);              // tell servo to go to position in variable 'pos'
     delay(15);}                       // waits 15ms for the servo to reach the position
   }  // else
   servoC.detach();
 }  //curtog
 //END SERVO C

 //BEGIN SERVO D 
  if (digitalRead(toggleDpin) == LOW && digitalRead(toggleDpin) == LOW && digitalRead(toggleDpin) == LOW)
  { curtogDstate = 0; } else { curtogDstate = 1; }
  
  if (curtogDstate != lasttogDstate) {   lasttogDstate = curtogDstate ; servoD.attach(10);
    if (curtogDstate == 0) {
      for (pos = 66; pos <= 114; pos += 1) { // in steps of 1 degree
      servoD.write(pos);              // tell servo to go to position in variable 'pos'
      delay(15);}                      // waits 15ms for the servo to reach the position
    } else { 
      for (pos = 114; pos >= 66; pos -= 1) { // in steps of 1 degree
      servoD.write(pos);              // tell servo to go to position in variable 'pos'
      delay(15);}                       // waits 15ms for the servo to reach the position
   }  // else
   servoD.detach();
 }  //curtog
// END SERVO D

//BEGIN SERVO E 
  if (digitalRead(toggleEpin) == LOW && digitalRead(toggleEpin) == LOW && digitalRead(toggleEpin) == LOW)
  { curtogEstate = 0; } else { curtogEstate = 1; }
  
  if (curtogEstate != lasttogEstate) {   lasttogEstate = curtogEstate ; servoE.attach(11);
    if (curtogEstate == 0) {
      for (pos = 66; pos <= 114; pos += 1) { // in steps of 1 degree
      servoE.write(pos);              // tell servo to go to position in variable 'pos'
      delay(15);}                      // waits 15ms for the servo to reach the position
    } else { 
      for (pos = 114; pos >= 66; pos -= 1) { // in steps of 1 degree
      servoE.write(pos);              // tell servo to go to position in variable 'pos'
      delay(15);}                       // waits 15ms for the servo to reach the position
   }  // else
   servoE.detach();
 }  //curtog
// END SERVO E

//BEGIN SERVO F
  if (digitalRead(toggleFpin) == LOW && digitalRead(toggleFpin) == LOW && digitalRead(toggleFpin) == LOW)
  { curtogFstate = 0; } else { curtogFstate = 1; }
  
  if (curtogFstate != lasttogFstate) {   lasttogFstate = curtogFstate ; servoF.attach(12);
    if (curtogFstate == 0) {
      for (pos = 66; pos <= 114; pos += 1) { // in steps of 1 degree
      servoF.write(pos);              // tell servo to go to position in variable 'pos'
      delay(15);}                      // waits 15ms for the servo to reach the position
    } else { 
      for (pos = 114; pos >= 66; pos -= 1) { // in steps of 1 degree
      servoF.write(pos);              // tell servo to go to position in variable 'pos'
      delay(15);}                       // waits 15ms for the servo to reach the position
   }  // else
   servoF.detach();
 }  //curtog
// END SERVO F

//BEGIN SERVO G
  if (digitalRead(toggleGpin) == LOW && digitalRead(toggleGpin) == LOW && digitalRead(toggleGpin) == LOW)
  { curtogGstate = 0; } else { curtogGstate = 1; }
  
  if (curtogGstate != lasttogGstate) {   lasttogGstate = curtogGstate ; servoG.attach(13);
    if (curtogGstate == 0) {
      for (pos = 66; pos <= 114; pos += 1) { // in steps of 1 degree
      servoG.write(pos);              // tell servo to go to position in variable 'pos'
      delay(15);}                      // waits 15ms for the servo to reach the position
    } else { 
      for (pos = 114; pos >= 66; pos -= 1) { // in steps of 1 degree
      servoG.write(pos);              // tell servo to go to position in variable 'pos'
      delay(15);}                       // waits 15ms for the servo to reach the position
   }  // else
   servoG.detach();
 }  //curtog
// END SERVO G

}  //END VOID LOOP