#include<ESP32Servo.h>
Servo MiServo_Izq;
Servo MiServo_Der;
#define DIP_switch 12
#define PWM_Izq 13
#define PWM_Der 5
#define test 2
int PWM_min = 500;
int PWM_max = 2400;
int On_Off = 0;
void setup() {
pinMode(DIP_switch, INPUT);
pinMode(test, OUTPUT);
MiServo_Izq.attach(PWM_Izq,PWM_min,PWM_max);
MiServo_Der.attach(PWM_Der,PWM_min,PWM_max);
}
void estado_DIP() {
On_Off =digitalRead(DIP_switch);
if(On_Off==1){
digitalWrite(test, HIGH);
}
if(On_Off==0){
digitalWrite(test, LOW);
}
}
void secuencia_servo(){
MiServo_Izq.write(45);
delay(500);
MiServo_Der.write(135);
delay(500);
MiServo_Izq.write(135);
delay(500);
MiServo_Der.write(70);
delay(500);
}
void loop(){
estado_DIP();
if(On_Off==1){
secuencia_servo();
}
else{
MiServo_Izq.write(0);
MiServo_Der.write(180);
}
delay(250);
}