// Exercício 3
// Breno Correia Lociks

#define PIN_ECHO 2
#define PIN_TRIG 3
#define LED_VERMELHO 4
#define LED_VERDE 5

unsigned long tempoAnterior = 0;

void setup() {
  pinMode(PIN_TRIG, OUTPUT);
  pinMode(PIN_ECHO, INPUT);
  pinMode(LED_VERMELHO, OUTPUT);
  pinMode(LED_VERDE, OUTPUT);
}

void loop() {

  unsigned long tempoAtual = millis();

  digitalWrite(PIN_TRIG, HIGH);
  delayMicroseconds(10);
  digitalWrite(PIN_TRIG, LOW);

  int duration = pulseIn(PIN_ECHO, HIGH);

  int distCM = duration / 58;

  if(distCM < 182 && (tempoAtual - tempoAnterior) > 5000) {
    
    tempoAnterior = tempoAtual;

    digitalWrite(LED_VERMELHO, HIGH);
    digitalWrite(LED_VERDE, LOW);

  }
  if(distCM > 182){
    digitalWrite(LED_VERMELHO, LOW);
    digitalWrite(LED_VERDE, HIGH);
  }
}