// SENSOR ULTRASONICO 
// VCC = VOLTAJE 5 V
// GND = TIERRA

// ECHO = RECEPCIONA LA ONDA ULTRASONICA  // ENTRADA
// TRIGGER = DISPARADOR, ENVIA LA ONDA ULTRASONICA // SALIDA

int TRIG = 7, ECHO = 8;

void setup() {
  pinMode(TRIG, OUTPUT);
  pinMode(ECHO, INPUT);
  Serial.begin(9600);
}

void loop() {
  float d = ultrasonico();
  Serial.print("Distancia: ");
  Serial.print(d);
  Serial.println(" cm.");
  delay(1000);
}




float ultrasonico()
{
  // El sensor a un inicio debe estar en reposo 
  digitalWrite(TRIG, 0);
  delayMicroseconds(2);

  // Envio de la onda ultrasonica
  digitalWrite(TRIG, 1);
  delayMicroseconds(10);  
  digitalWrite(TRIG, 0);

  // Leer el tiempo que el pin ECHO permanece en alto
  long tiempo = pulseIn(ECHO, 1);

  // Calcular la distancia V = D / T
  // D = V * T / 2    // SE DIVIDE ENTRE 2 POR EL TIEMPO DE IDA Y VUELTA
  // V sonido = 340 m/s = 0.0340 cm / us

  float distancia = tiempo * 0.0340 / 2;
  
  return distancia;
}