#define trigPin 7
#define echoPin 6
#define ledAman 8
#define led1 9
#define led2 10
#define led3 11
#define buzzer 12
void setup() {
Serial.begin(9600);
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
pinMode(ledAman, OUTPUT);
pinMode(led1, OUTPUT);
pinMode(led2, OUTPUT);
pinMode(led3, OUTPUT);
pinMode(buzzer, 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;
Serial.print("DURASI: ");
Serial.print(duration);
Serial.print(" , JARAK: ");
Serial.println(distance);
digitalWrite(ledAman,LOW );
digitalWrite(led1, LOW);
digitalWrite(led2, LOW);
digitalWrite(led3, LOW);
digitalWrite(buzzer, LOW);
if (distance >= 16) {
digitalWrite(ledAman, HIGH);
digitalWrite(led1, LOW);
digitalWrite(led2, LOW);
digitalWrite(led3, LOW);
digitalWrite(buzzer, LOW);
} else {
digitalWrite(ledAman, LOW);
}
if (distance <= 15 && distance >= 10) {
digitalWrite(led1, HIGH);
digitalWrite(led2, LOW);
digitalWrite(led3, LOW);
digitalWrite(buzzer, LOW);
}
if (distance < 10 && distance >= 5) {
digitalWrite(led2, HIGH);
digitalWrite(led1, LOW);
digitalWrite(led3, LOW);
digitalWrite(buzzer, LOW);
}
if (distance < 5) {
digitalWrite(led1, LOW);
digitalWrite(led2, LOW);
digitalWrite(led3, HIGH);
digitalWrite(buzzer, HIGH);
delay(200);
digitalWrite(led3, LOW);
digitalWrite(buzzer, LOW);
delay(200);
} else {
digitalWrite(led3, LOW);
digitalWrite(buzzer, HIGH);
}
delay(100);
}
0 comments:
Post a Comment