#define TRIG 12
#define ECHO 14
#include <ESP32Servo.h>
#include <Wire.h>
#include <LiquidCrystal_I2C.h>
LiquidCrystal_I2C LCD(0X27,16,2);

const int servoPin = 5;
Servo servoMotor;

int tempo;
int dist;

void setup() {

  pinMode(TRIG, OUTPUT);
  pinMode(ECHO, INPUT);
  digitalWrite(TRIG, LOW);

  servoMotor.attach(servoPin);
}

void loop() {

  digitalWrite(TRIG, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG, LOW);

  tempo = pulseIn(ECHO, HIGH);
  dist = tempo * 0.017;

  int graus = map(dist, 2 , 400 , 180 , 0);

  servoMotor.write(graus);

}