// Include the servo library:
#include <Servo.h>
// Create a new servo object:
Servo servo1;
Servo servo2;
Servo servo3;
//Servo servo4;
// Define the servo pin:
#define servo1Pin 2
#define servo2Pin 4
#define servo3Pin 6
//#define servo4Pin 7
#define button1Pin 8
#define button2Pin 9

// Create a variable to store the servo position:
int angle = 0;
void setup() {
  // Attach the Servo variable to a pin:
  servo1.attach(servo1Pin);
  servo2.attach(servo2Pin);
  servo3.attach(servo3Pin);
//  servo4.attach(servo4Pin);
  Serial.begin(9600); 
  pinMode(button1Pin, INPUT_PULLUP);
  pinMode(button2Pin, INPUT_PULLUP);
}

int delay_time = 100;
int prevButtonState = 1;
int currButtonState = 1;
                          
void rotateServo (Servo &servo) {
 servo.write(180);
 delay(1000);
 servo.write(0);
 delay(1000);                // Refresh cycle of servo
}

void loop() {

  delay(delay_time);

  prevButtonState = currButtonState;
  currButtonState = digitalRead(button1Pin);
  if((currButtonState != prevButtonState) && (currButtonState == LOW)){
    Serial.println("Button 1 pressed");
    rotateServo(servo1);
    rotateServo(servo2);
    rotateServo(servo3);
//    rotateServo(servo4);
    return;
  }
  currButtonState = digitalRead(button2Pin);
  if((currButtonState != prevButtonState) && (currButtonState == LOW)){
    Serial.println("Button 2 pressed");
    rotateServo(servo1);
    rotateServo(servo2);
    rotateServo(servo3);
//    rotateServo(servo4);
    return;
  }
}