#include <ESP32Servo.h>
#define TRIG 14
#define ECHO 27
int contador = 0;
long duration;
int distance;
const int servopin = 13;
int sr = 0;
Servo servoMotor;

void setup() {
  // put your setup code here, to run once:
  Serial.begin(115200);
  Serial.println("Hello, ESP32!");
  pinMode(TRIG, OUTPUT);
  pinMode(ECHO, INPUT);
  servoMotor.attach(servopin);

}

void loop() {

digitalWrite(TRIG, HIGH);
delayMicroseconds(10);
digitalWrite(TRIG, LOW);
duration = pulseIn(ECHO, HIGH);
contador = duration * 0.017;
sr = map(contador, 0, 400, 180, 0);

servoMotor.write(sr);
Serial.println(String("distancia: ")+contador+String(" Servo: ")+sr);
}