#define TRIG_PIN A7
#define ECHO_PIN A6
#define LED_ROUGE D2
#define LED_ORANGE D3
#define LED_VERTE D4



long duration;
float distance;



void setup() {
  Serial.begin(115200);
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);
  pinMode(LED_ROUGE, OUTPUT);
  pinMode(LED_VERTE, OUTPUT);
  pinMode(LED_ORANGE, OUTPUT);


 
}

void loop() {
  digitalWrite(TRIG_PIN, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIG_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG_PIN, LOW);

  duration=pulseIn(ECHO_PIN,HIGH);

  distance=(duration*0.034)/2;

  Serial.print("distance est ");
  Serial.println(distance );

  if(distance>120){
    digitalWrite(LED_VERTE, HIGH);
    digitalWrite(LED_ORANGE, LOW);
    digitalWrite(LED_ROUGE, LOW);

  }
  else if(distance>30 && distance<=120){
    digitalWrite(LED_VERTE, LOW);
    digitalWrite(LED_ORANGE, HIGH);
    digitalWrite(LED_ROUGE, LOW);

  }
  else{
    digitalWrite(LED_VERTE, LOW);
    digitalWrite(LED_ORANGE, LOW);
    digitalWrite(LED_ROUGE, HIGH);
  }
  
  delay(500); // this speeds up the simulation
}