#include <Servo.h>
  

int potpin = 0;  
int val; 

Servo servoArray[3];

int counter = 0;
int ser = 0;

int buttonState;
int buttonState_ser;

bool rps = true;
bool sds = true;

int angle_profile[8] {0, 40, 80, 120, 160, 180, 90, 110};

void setup() {
  Serial.begin(9600);

  servoArray[0].attach(5); // attach servo 1 to pin 5
  servoArray[1].attach(6); // attach servo 2 to pin 6
  servoArray[2].attach(9); // attach servo 3 to pin 9 

  pinMode(7, INPUT);
 
}

void loop() {
  //Write_servo(1);
  buttonState = digitalRead(7);
  buttonState_ser = digitalRead(8);  

  if (buttonState == HIGH && rps == true) {
    counter++;
    angle_profile[counter];
    delay(100);  
    rps = false;
  }else if (buttonState == LOW) { 
      rps = true;    
    }

     if (buttonState_ser == HIGH && sds == true) {
    ser++;
    delay(50);  
    sds = false;
  }else if (buttonState_ser == LOW) { 
      sds = true;    
    }

    Write_servo(angle_profile[counter], ser);


}
                         

void Write_servo(int val, int servo_num){
  servoArray[servo_num].write(val);
  delay(15);
}