Sensor 3 Warna

const int trigPin = 13;
const int echoPin = 12;
const int LedMerah = 7;
const int LedKuning = 6;
const int LedHijau = 5;


long duration;
int distance;
int sefetyDistance;

void setup(){
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  pinMode(LedMerah, OUTPUT);
  pinMode(LedKuning, OUTPUT);
  pinMode(LedHijau, OUTPUT);
  Serial.begin(9600);
}

void loop(){
  digitalWrite(trigPin,LOW);
  delayMicroseconds(10);

  digitalWrite(trigPin, HIGH);
  delayMicroseconds(50);
  digitalWrite(trigPin, LOW);

  duration = pulseIn(echoPin, HIGH);

  distance = duration * 0.034/2;

  sefetyDistance = distance;
  if(sefetyDistance <= 300){

    if (sefetyDistance <= 10){

      digitalWrite(LedMerah, HIGH);
      digitalWrite(LedKuning, LOW);
      digitalWrite(LedHijau, LOW);

    }else if(sefetyDistance <= 20){

      digitalWrite(LedKuning, HIGH);
      digitalWrite(LedMerah, LOW);
      digitalWrite(LedHijau, LOW);

    }else if(sefetyDistance <= 30){

      digitalWrite(LedHijau, HIGH);
      digitalWrite(LedMerah, LOW);
      digitalWrite(LedKuning, LOW);
    }else{
      digitalWrite(LedMerah, LOW);
      digitalWrite(LedKuning, LOW);
      digitalWrite(LedHijau, LOW);
    }

    Serial.print("Distance : ");
    Serial.print(distance);
    Serial.println("");
  }

}