#define PIN_SENSOR1_ECHO  18
#define PIN_SENSOR1_TRIG  19
#define PIN_SENSOR2_ECHO  16
#define PIN_SENSOR2_TRIG  17

void setup() {
  Serial.begin(115200);
  pinMode(PIN_SENSOR1_TRIG, OUTPUT);
  pinMode(PIN_SENSOR1_ECHO, INPUT);
  pinMode(PIN_SENSOR2_TRIG, OUTPUT);
  pinMode(PIN_SENSOR2_ECHO, INPUT);
  // put your setup code here, to run once:

}

void loop() {
  unsigned int distance1 = GetDistance(PIN_SENSOR1_ECHO,PIN_SENSOR1_TRIG);

  Serial.print("Distancia1: ");
  Serial.print(distance1);      //Enviamos serialmente el valor de la distancia
  Serial.print("cm");
  Serial.println();
  
  delay(1);

  unsigned int distance2 = GetDistance(PIN_SENSOR2_ECHO,PIN_SENSOR2_TRIG);

  Serial.print("Distancia2: ");
  Serial.print(distance2);      //Enviamos serialmente el valor de la distancia
  Serial.print("cm");
  Serial.println();

  delay(1000);
  // put your main code here, to run repeatedly:

}

unsigned int GetDistance(int echo,int trig)
{
  digitalWrite(trig, LOW);
  delayMicroseconds(2);
  digitalWrite(trig, HIGH);
  delayMicroseconds(10);
  digitalWrite(trig, LOW);

  unsigned long duration = pulseIn(echo, HIGH);

  return (duration * 0.0343 / 2);
}