/*************************************************
*	Programm: Park Sensor                          *
*	Name: Suppaner Felix					                 *
*	Klasse: 2AHME							                     *
*	Datum: 23.04.2024						                   *
*************************************************/

#define TRIG_PIN  7
#define ECHO_PIN  2 
#define ROTE_LED  8 
#define GELBE_LED  13 
#define BLAUE_LED  12 

void setup() {
  Serial.begin(9600);
  pinMode(TRIG_PIN, OUTPUT);
  pinMode(ECHO_PIN, INPUT);
}

void loop() {
  long zeit, Stecke;
  digitalWrite(TRIG_PIN, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIG_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG_PIN, LOW);
  zeit = pulseIn(ECHO_PIN, HIGH);
  Stecke = zeit * 0.032 / 2;
  Serial.print("Entfernung: ");
  Serial.print(Stecke);
  Serial.println(" cm");

  if (Stecke > 30 || Stecke < 0) {
    //Blaue LED leuchten
    digitalWrite(BLAUE_LED, HIGH);
    digitalWrite(GELBE_LED, LOW);
    digitalWrite(ROTE_LED, LOW);
  } else if (Stecke >= 10 && Stecke <= 30) {
    //Gelbe LED leuchten
    digitalWrite(BLAUE_LED, LOW);
    digitalWrite(GELBE_LED, HIGH);
    digitalWrite(ROTE_LED, LOW);
  } else if (Stecke < 10) {
    //Rote LED leuchten
    digitalWrite(BLAUE_LED, LOW);
    digitalWrite(GELBE_LED, LOW);
    digitalWrite(ROTE_LED, HIGH);
    if (Stecke < 5) {
      // Rote LED blinken lassen
      digitalWrite(ROTE_LED, HIGH);
      delay(500);
      digitalWrite(ROTE_LED, LOW);
      delay(500);
    }
  }
  delay(1000);
}