//TP MODUL 2
//KARTIKA NURUL AULIA_A021002
//SENSOR ULTRASONIK


#define trigPin 7
#define echoPin 6
#define ledAman 11
#define led1 10
#define led2 9
#define led3 8

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

pinMode(ledAman, OUTPUT); pinMode(led1, OUTPUT); pinMode(led2, OUTPUT); pinMode(led3, OUTPUT);

}

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

if (distance <= 250)
{ Serial.println(" LED MERAH MENYALA <= 250 ");
digitalWrite(ledAman, HIGH);
digitalWrite(led1, LOW); 
digitalWrite(led2, LOW); 
digitalWrite(led3,LOW);
}
else { digitalWrite(ledAman,LOW);
}

if (distance > 300)
{ Serial.println(" LED KUNING MENYALA > 300 ");
digitalWrite(led1, HIGH);
digitalWrite(led2, LOW); 
digitalWrite(led3,LOW);
}

if (distance <= 50) 
{ Serial.println(" LED HIJAU MENYALA <= 50 ");
digitalWrite(led2, HIGH); 
digitalWrite(led1, LOW); 
digitalWrite(led3,LOW);
}

if (distance <= 300) 
{ Serial.println(" LED UNGU MENYALA <= 300 ");
  digitalWrite(led3, HIGH); 
  digitalWrite(led2, LOW); 
  digitalWrite(led1, LOW);
}
delay(250);
}