#include <Servo.h> //add servo library. this library is standard library
//define the servos
Servo servo1;
Servo servo2;
Servo servo3;
const int button1 = 2;
const int button2 = 3;
int button1Pressed = 0;
boolean button2Pressed = false;
const int pot1 = A0;
const int pot2 = A1;
const int pot3 = A2;
int pot1Val;
int pot2Val;
int pot3Val;
int pot1Angle;
int pot2Angle;
int pot3Angle;
int servoPosSave[500]={};
void setup() {
servo1.attach(9);
servo2.attach(10);
servo3.attach(11);
pinMode(button1, INPUT);
pinMode(button2, INPUT);
Serial.begin(9600);
}
void loop() {
pot1Val = analogRead(pot1);
pot1Angle = map (pot1Val, 5, 1023, 0, 170);
pot2Val = analogRead(pot2);
pot2Angle = map (pot2Val, 5, 1023, 0, 170);
pot3Val = analogRead(pot3);
pot3Angle = map (pot3Val, 5, 1023, 0, 170);
servo1.write(pot1Angle);
servo2.write(pot2Angle);
servo3.write(pot3Angle);
if(digitalRead(button1) == HIGH){
//if button2 pressed (HIGH), the servos move saved position
if(digitalRead(button2) == HIGH){
button2Pressed = true;
}
if(button2Pressed){
for(int i=0; i<10; i++){
servo1.write(servoPosSave[i]);
delay(600);
}
}
delay(300);
}