#include<ESP32Servo.h>
Servo Myservo_Izq;
Servo Myservo_Der;
#define dip_switch 13
#define PWM_Izq 12
#define PWM_Der 5
#define test 2
int P_min = 500;
int P_max =2400;
int on_off;
void setup() {
pinMode(dip_switch, INPUT);
pinMode(test, OUTPUT);
Myservo_Izq.attach(PWM_Izq,P_min,P_max);
Myservo_Der.attach(PWM_Der,P_min,P_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(){
Myservo_Izq.write(45);
Myservo_Der.write(70);
delay(500);
Myservo_Izq.write(135);
Myservo_Der.write(180);
delay(500);
}
void loop() {
estado_dip();
if(on_off==HIGH){
secuencia_servo();
}else{
Myservo_Izq.write(0);
Myservo_Der.write(0);
}
delay(50);
}