#include <ESP32Servo.h>

#define ECO 14
#define TRG 27
#define LED 2
Servo servo;
int degree = 180;

void setup() {
  Serial.begin(115200);
  pinMode(LED, OUTPUT);
  pinMode(TRG, OUTPUT);
  pinMode(ECO, INPUT);
  servo.attach(12);
  servo.write(degree);
}

void loop() {
  digitalWrite(TRG, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRG, LOW);
  int duration = pulseIn(ECO, HIGH);
  int distance = duration / 58;

  Serial.println(distance);
  servo.write(degree);
  if (distance < 50) {
    digitalWrite(LED, HIGH);
    degree = 180;
  } else {
    digitalWrite(LED, LOW);
    degree = 0;
  }
}