//DECLARACIÓN DE PINES 
const int triggerPin = 13;
const int echoPin = 12;
const int LBlue = 15;
//const int buzzerPin = 15;

//ACTIVACIÓN DEL SENSOR ULTRASONICO
void medir (){

  //SILENCIO
  digitalWrite(triggerPin, LOW);
  delayMicroseconds(2);

  //GRITO
  digitalWrite(triggerPin, HIGH);
  delayMicroseconds(10);

  //SILENCIO
  digitalWrite(triggerPin, LOW);
}


void setup() {

  // INICIA LA COMUNICACIÓN DE ESP32 A LA COMPUTADORA
  Serial.begin(115200);
  
  //DECLARAMOS LOS PIENES COMO ESTRADAS Y SALIDAS
  pinMode(triggerPin, OUTPUT);
  pinMode(LBlue, OUTPUT);
 // pinMode(buzzerPin, OUTPUT);
  pinMode(echoPin, INPUT);
}

//CICLO QUE SIEMPRE REPETIR
void loop() {
  medir();


  //DECLARACIÓN DE VARIABLES
  float duracion = pulseIn(echoPin, HIGH);  // LA DURACION DE LA TIEMPO DE LA ONDA
  float distancia = (duracion * 0.034)/2;   //CALCULAR LA DISTANCIA
  float Dpositiva=0, Dnegativa=0;           //DESVIACIÓN

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


  //PASAS 
  if(distancia <= 65){
      digitalWrite(LBlue, HIGH);
      Dpositiva = distancia + 3;
      Dnegativa = distancia - 3;
    }

  // TE QUEDAS QUIETO 
  while ((distancia >= Dnegativa) && (distancia <= Dpositiva)) {
    for (int i = 0; i <= 5; i++) {
      digitalWrite(LBlue, HIGH);
      delay(250);
      digitalWrite(LBlue, LOW);
      delay(250);
    }

    medir();
    duracion = pulseIn(echoPin, HIGH);
    distancia = (duracion * 0.034)/2;
  }

  //SALISTES
  digitalWrite(LBlue, LOW);
  delay(5000);
}