#include <ESP32Servo.h>
Servo servo1;
#define trig 27
#define echo 26
#define servoPin 13
void setup() {
pinMode(trig, OUTPUT);
pinMode(echo, INPUT);
Serial.begin(9600);
servo1.attach(servoPin);
}
void loop() {
String mensaje = "";
float distancia = calcularDistancia();
Serial.println(distancia);
if(distancia < 10){
servo1.write(90);
}
if(distancia > 10){
servo1.write(0);
}
Serial.println(mensaje);
}
float calcularDistancia(){
digitalWrite(trig, LOW);
delayMicroseconds(2);
digitalWrite(trig, HIGH);
delayMicroseconds(10);
digitalWrite(trig, LOW);
long duration = pulseIn(echo, HIGH);
float distance = duration * 0.034 / 2;
delay(500);
return distance;
}