#include <ESP32Servo.h>
int motor = 18;
int trig = 22;
int echo = 23;
int led = 21;
Servo ServoSensor;

void setup() {
Serial.begin(9600);
ServoSensor.attach(motor);
pinMode(trig, OUTPUT);
pinMode(echo, INPUT);
pinMode(led, OUTPUT);
}
void loop() {
int distancia = obterDistancia();

if(distancia < 20){
ServoSensor.write(0);
digitalWrite(led, HIGH);
delay(100);
digitalWrite(led, LOW);
}
else{
  ServoSensor.write(90);
delay(300);
}


}
int obterDistancia(){
  digitalWrite(trig, LOW);
  delayMicroseconds(2);
  digitalWrite(trig, HIGH);
  delayMicroseconds(10);
digitalWrite(trig, LOW);
long duração = pulseIn(echo, HIGH);
int distancia = (duração * 0.0343) / 2;
return distancia;
}