#define trig 7
#define echo 6
void setup() {
  pinMode(trig, OUTPUT);
  pinMode(echo, INPUT);
  pinMode(5, OUTPUT);
  pinMode(4, OUTPUT);
  Serial.begin(9600);
}

void loop(){  
  String mensaje = "";
  float distancia = calcularDistancia();
  Serial.println(distancia);
  if(distancia >= 200.0){    
    digitalWrite(5, 1);
    digitalWrite(4, 0);
    mensaje = "NO HAY USUARIO EN EL LAVAMANOS";
  }else{
    digitalWrite(5, 0);
    digitalWrite(4, 1);
    mensaje = "HOLA, BIENVENIDO AL LAVAMOS INTELIGENTE";
  }
}
float calcularDistancia(){
  // Enviar pulso de activación
  digitalWrite(trig, LOW);
  delayMicroseconds(2);
  digitalWrite(trig, HIGH);
  delayMicroseconds(10);
  digitalWrite(trig, LOW);
  // Medir duración del pulso de eco
  long duration = pulseIn(echo, HIGH);
  // Calcular distancia en centímetros
  float distance = duration * 0.034 / 2;
  delay(500);
  return distance;
}