#include <ESP32Servo.h>

const int servoPin = 14;  
Servo servoMotor;
int posGraus = 0;

#define TRIG 26  
#define ECHO 27

long duration;
int distance;

void setup() {
  
  Serial.begin(115200);

    servoMotor.attach(servoPin);

  pinMode(TRIG, OUTPUT);
  pinMode(ECHO, INPUT);
}

void loop() {
  digitalWrite(TRIG, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIG, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG, LOW);

  duration = pulseIn(ECHO, HIGH);

  distance = duration / 58;

  Serial.print("Distância: ");
  Serial.print(distance);
  Serial.println(" cm");

  int servoPos = map(distance, 0, 200, 0, 180);

  servoPos = constrain(servoPos, 0, 180);

  servoMotor.write(servoPos);

  delay(500);
}