//Program HC-SR04 dengan LED
//Dibuat oleh : Rizki Rio Chandrawintana
//Kelas : X-RPL 3

int TRIG = 9;
int ECHO = 8;
int Merah = 12;
int Hijau = 11;
int Biru = 10;

void setup() {
  pinMode(TRIG, OUTPUT);
  pinMode(ECHO, INPUT);
  pinMode(Merah, OUTPUT);
  pinMode(Hijau, OUTPUT);
  pinMode(Biru, OUTPUT);
}

void loop() {
  long duration, distance;
  digitalWrite(TRIG, LOW);
  delayMicroseconds(2);
  digitalWrite(TRIG, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG, LOW);
  duration = pulseIn(ECHO, HIGH);
  distance = (duration / 2) / 29.1;

  if (distance < 100) {
    digitalWrite(Merah, LOW);
    digitalWrite(Hijau, HIGH);
    digitalWrite(Biru, HIGH);
  } else if (distance >= 100 && distance < 200) {
    digitalWrite(Merah, LOW);
    digitalWrite(Hijau, LOW);
    digitalWrite(Biru, HIGH);
  } else {
    digitalWrite(Merah, HIGH);
    digitalWrite(Hijau, LOW);
    digitalWrite(Biru, HIGH);
  }
  delay(100);
}