#include <Servo.h>
int pos = 0;
int btn = 13;
Servo servo;
void setup() {
// put your setup code here, to run once:
pinMode(btn, INPUT_PULLUP);
servo.attach(11);
Serial.begin(115200);
}
void loop() {
if(digitalRead(btn) == HIGH){
pos++;
while(digitalRead(btn) == HIGH){
delay(50);
}
}
Serial.println(pos);
if(pos > 2){
pos = 0;
}
if(pos == 1){
for (int i = 0; i <= 5; i++) {
servo.write(180);
digitalWrite(12, HIGH);
delay(500);
servo.write(0);
digitalWrite(12, LOW);
delay(500);
}
} else if (pos == 2){
digitalWrite(12, LOW);
servo.write(45);
delay(500);
} else {
for (int i = 0; i < 3; i++) {
servo.write(90);
digitalWrite(12, HIGH);
delay(250);
servo.write(90);
digitalWrite(12, LOW);
delay(250);
}
}
}