#include <ESP32Servo.h>
Servo miservo; //OBJETO
#define Trig 12 //Constante
#define Echo 34 //Constante
int tiempo;
int distancia;
void setup() {
Serial.begin(115200);
miservo.attach(2);
pinMode(Trig, OUTPUT);
pinMode(Echo, INPUT);
}
int obtenerDistancia(){
digitalWrite(Trig, HIGH);
delayMicroseconds(10);
digitalWrite(Trig, LOW);
tiempo = pulseIn(Echo,HIGH);
distancia=tiempo/58.2;
return distancia;
}
void loop() {
Serial.println(obtenerDistancia());
int rango = obtenerDistancia();
//Rango1 servo a 0° -- 0<distancia<150
if (rango>0 && rango<150){
miservo.write(0);
delay(200);
} else if (rango>=150 && rango<250){
miservo.write(90);
delay(200);
}else{
miservo.write(180);
}
delay(10);
}