#include <Servo.h>
Servo myservo;
int Seq = 0;
void setup() {
Serial.begin(9600);
myservo.attach(D0); // attaches the servo on pin 9 to the servo object
pinMode(D1, INPUT_PULLUP);
pinMode(D2, INPUT_PULLUP);
pinMode(D3, INPUT_PULLUP);
}
void loop() {
if (digitalRead(D1) == LOW) {
Seq = 1;
}
if (digitalRead(D2) == LOW) {
Seq = 2;
}
if (digitalRead(D3) == LOW) {
Seq = 3;
}
if (Seq == 1) {
loop1 ();
}
if (Seq == 2) {
loop2 ();
}
if (Seq == 3) {
loop3 ();
}
}
void loop1 () {
Serial.println("loop1 running");
myservo.write(0);
delay(2000);
for (int A = 0; A < 91; A++) {
myservo.write(A); // 0 to 90
delay(10);
}
delay(2000);
for (int A = 90; A < 181; A++) {
myservo.write(A); // 90 to 180
delay(10);
}
delay(2000);
for (int A = 180; A > 89; A--) {
myservo.write(A); // 180 to 90
delay(10);
}
delay(2000);
for (int A = 90; A > (-1); A--) {
myservo.write(A); // 90 to 0
delay(10);
}
delay(2000);
}
void loop2 () {
Serial.println("loop2 running");
myservo.write(0); delay(2000);
for (int A = 0; A < 91; A++) {
myservo.write(A); // 0 to 90
delay(10);
}
delay(2000);
for (int A = 90; A > (-1); A--) {
myservo.write(A); // 90 to 0
delay(10);
}
delay(2000);
}
void loop3 () {
Serial.println("loop3 running");
myservo.write(0);
delay(2000);
}