//Deklarasi PIN
int trig = 6; // membuat varibel trig yang di set ke-pin D6
int echo = 7; // membuat variabel echo yang di set ke-pin D7
long durasi, jarak;     // membuat variabel durasi dan jarak
int merah = 4;
int kuning = 3;
int hijau = 2;

void setup() {
  pinMode(trig, OUTPUT);    // set pin trig menjadi OUTPUT
  pinMode(echo, INPUT);     // set pin echo menjadi INPUT
  pinMode(merah, OUTPUT);
  pinMode(kuning, OUTPUT);
  pinMode(hijau, OUTPUT);

  Serial.begin(9600);       // digunakan untuk komunikasi Serial dengan komputer
}

void loop() {
  digitalWrite(trig, LOW);
  delayMicroseconds(8);
  digitalWrite(trig, HIGH);
  delayMicroseconds(8);
  digitalWrite(trig, LOW);
  delayMicroseconds(8);
  durasi = pulseIn(echo, HIGH); // menerima suara ultrasonic
  jarak = (durasi / 2) / 29.1;  // mengubah durasi menjadi jarak (cm)
  if(jarak >= 16){
    digitalWrite(hijau, HIGH);
    digitalWrite(merah, LOW);
    digitalWrite(kuning, LOW);
    
  }else if((jarak > 10)&&(jarak <20)){
    digitalWrite(hijau, LOW);
    digitalWrite(merah, LOW);
    digitalWrite(kuning, HIGH);
    
  }else {
    digitalWrite(hijau, LOW);
    digitalWrite(merah, HIGH);
    digitalWrite(kuning, LOW);
    
  }
//  Serial.print("Jarak Benda : ");
//  Serial.print(jarak) ;      // menampilkan jarak pada Serial Monitor
//  Serial.println(" Cm");
}