#include <NewPing.h>

#define PIN_TRIG 26
#define PIN_ECHO 27

int ledV  = 32;
int ledA = 33;
int ledR = 25;



void setup(){
  pinMode(ledV, OUTPUT);
  pinMode(ledA, OUTPUT);
  pinMode(ledR, OUTPUT);

  Serial.begin(115200);
  pinMode(PIN_TRIG, OUTPUT);
  pinMode(PIN_ECHO, INPUT);
}

void loop(){
  delay(1000);
  digitalWrite(PIN_TRIG, HIGH);
  delayMicroseconds(10);
  digitalWrite(PIN_TRIG, LOW);

  long duration = pulseIn(PIN_ECHO, HIGH);
  int distance = duration / 58;
  Serial.print("Distance in: ");
  Serial.println(distance);
  
  if (distance > 200) {
    digitalWrite(ledV, HIGH);
    digitalWrite(ledA, LOW);
    digitalWrite(ledR, LOW);
  } else if (distance <= 200 && distance > 2) {
    digitalWrite(ledV, LOW);
    digitalWrite(ledA, HIGH);
    digitalWrite(ledR, LOW);
  } else if (distance <= 2) {
    digitalWrite(ledV, LOW);
    digitalWrite(ledA, LOW);
    digitalWrite(ledR, HIGH);
  } else {
    digitalWrite(ledV, LOW);
    digitalWrite(ledA, LOW);
    digitalWrite(ledR, LOW);
  }
}