#define trig 7
#define echo 6

void setup() {
  pinMode(trig, OUTPUT);
  pinMode(5, OUTPUT);
  pinMode(4, OUTPUT);
  pinMode(echo, INPUT);
  Serial.begin(9600);

}
void loop(){  
  String mensaje = "";
  float distancia = calcularDistancia();
  Serial.println(distancia);
  if(distancia >= 200.0){    
    mensaje = "No hay usuario para el lavamanos";
    digitalWrite(5, 1);
    digitalWrite(4, 0);
  }else{
    mensaje = "Hola, bienvenido";
    digitalWrite(5, 0);
    digitalWrite(4, 1);
  }
  Serial.println(mensaje);
} 

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;
}