#include <Servo.h>

const int tPin = 9;
const int ePin = 10;
const int servoPin =6;

Servo miServo;

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

  miServo.attach(servoPin);

  pinMode(tPin,OUTPUT);
  pinMode(ePin, INPUT);
}

void loop() {

  digitalWrite(tPin, LOW);
  delayMicroseconds(2);
  digitalWrite(tPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(tPin, LOW);

  long duracion = pulseIn(ePin, HIGH);

  float distancia = duracion * 0.034/2;

  Serial.print("Distancia: ");
  Serial.print(distancia);
  Serial.println(" cm");

  int angulo = map(distancia, 2, 30, 0, 180);

  angulo = constrain(angulo, 0,180);

  miServo.write(angulo);

  delay(500);
}