Sensor de Distancia Ultrasónico | Compatible 3V/5V

// Constantes de pines
const int trigPin = 9;  // Pin Trig conectado al digital 9
const int echoPin = 10; // Pin Echo conectado al digital 10

// Variables para la medición
long duration; // Variable para almacenar la duración del pulso
int distanceCm; // Variable para almacenar la distancia en cm

void setup() {
  pinMode(trigPin, OUTPUT); // Pin Trig como salida
  pinMode(echoPin, INPUT);  // Pin Echo como entrada
  Serial.begin(9600);       // Inicializa la comunicación serial
  Serial.println("Sensor Ultrasónico Iniciado...");
}

void loop() {
  // 1. Generar un pulso de 10us para iniciar la medición
  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);

  // 2. Medir la duración del pulso de retorno (tiempo que tarda el sonido en ir y volver)
  duration = pulseIn(echoPin, HIGH);

  // 3. Convertir la duración a distancia en cm
  // Distancia = (Duración del eco * Velocidad del sonido (0.0343 cm/us)) / 2
  // Usamos 29.1 (microsegundos por cm) como la inversa de la velocidad (1 / 0.0343)
  distanceCm = duration / 58;

  // 4. Imprimir el resultado
  Serial.print("Distancia: ");
  Serial.print(distanceCm);
  Serial.println(" cm");

  delay(500); // Esperar medio segundo antes de la próxima medición
}