#include <ESP32Servo.h>
int Trigger = 25;   //Pin digital 13 para el Trigger del sensor
int Echo = 26;   //Pin digital 12 para el Echo del sensor
int indice = 0;
const int servoPin = 13;
void setup() {
  Servo servo;


void setup() {
  // put your setup code here, to run once:
  Serial.begin(115200);
  Serial.println("Hello, ESP32!");
  servo.attach(servoPin, 500, 2400);
  servo.write(0);
}

void loop() {
  Serial.println("Moviendo Servo");
  servo.write(0);
  delay(1200); // this speeds up the simulation
  servo.write(90);
  delay(1200); 
  servo.write(180);
  delay(1200); 
}

void loop() {
  long t; //tiempo que demora en llegar el eco
  long d; //distancia en centimetros

  digitalWrite(Trigger, HIGH);
  delayMicroseconds(20);          //Enviamos un pulso de 10us
  digitalWrite(Trigger, LOW);
  
  t = pulseIn(Echo, HIGH); //obtenemos el ancho del pulso
  if(t > 36000)
  {
    Serial.println("No hay Objeto");
  }
  d = t/59;             //escalamos el tiempo a una distancia en cm
  
  Serial.print("Distancia: ");
  Serial.print(d);      //Enviamos serialmente el valor de la distancia
  Serial.print(" cm");
  Serial.println();
  delay(300);          //Hacemos una pausa de 100ms

  if(d < 50)
  {
    while(indice < 7)
    {
      digitalWrite(servoPin[indice],1);
      delay(100);
      indice++;
    }
    indice = 6;
    while(indice > -1)
    {
      digitalWrite(servoPin[indice],0);
      delay(100);
      indice--;
    }
  }
  
}