// Definir los pines para los Trig y Echo de ambos sensores
const int trigPinA = 9;
const int echoPinA = 10;
const int trigPinB = 11;
const int echoPinB = 12;

// Variables para almacenar la duración del pulso y la distancia calculada para cada sensor
long durationA;
int distanceA;
long durationB;
int distanceB;

void setup() {
  // Inicializar la comunicación serie para monitorear la distancia
  Serial.begin(9600);
  
  // Configurar los pines Trig y Echo como salidas y entradas respectivamente
  pinMode(trigPinA, OUTPUT);
  pinMode(echoPinA, INPUT);
  pinMode(trigPinB, OUTPUT);
  pinMode(echoPinB, INPUT);
}

void loop() {
  // Leer y calcular la distancia del Sensor A
  distanceA = readDistance(trigPinA, echoPinA);
  Serial.print("Distance A: ");
  Serial.print(distanceA);
  Serial.println(" cm");

  // Leer y calcular la distancia del Sensor B
  distanceB = readDistance(trigPinB, echoPinB);
  Serial.print("Distance B: ");
  Serial.print(distanceB);
  Serial.println(" cm");

  // Pequeña pausa antes de la siguiente lectura
  delay(500);
}

int readDistance(int trigPin, int echoPin) {
  // Asegurarse de que el pin Trig esté en estado bajo
  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);

  // Enviar un pulso de 10 microsegundos en el pin Trig para activar el sensor
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);

  // Leer el tiempo en microsegundos que tarda en recibir el eco
  long duration = pulseIn(echoPin, HIGH);

  // Calcular la distancia en centímetros
  int distance = duration * 0.034 / 2;

  return distance;
}