#define echoPin 2
#define trigPin 15
#define ledRed 4
#define ledYellow 5
#define ledGreen 18
void setup() {
// put your setup code here, to run once:
Serial.begin(115200);
pinMode(LED_BUILTIN, OUTPUT);
pinMode(trigPin, OUTPUT);
pinMode(echoPin, OUTPUT);
pinMode(ledRed, OUTPUT);
pinMode(ledYellow, OUTPUT);
pinMode(ledGreen, OUTPUT);
}
void loop() {
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
int duration = pulseIn(echoPin, HIGH);
float distance = duration * 0.034 / 2;
Serial.print(" = ");
Serial.println(distance);
delay(1000);
if (distance > 150){
Serial.print("Jarak Jauh");
digitalWrite(18, HIGH);
digitalWrite(5, LOW);
digitalWrite(4, LOW);
}
else if (distance < 150 && distance > 75){
Serial.print("Jarak Sedang");
digitalWrite(18, LOW);
digitalWrite(5, HIGH);
digitalWrite(4, LOW);
}
if (distance < 75){
Serial.print( "Jarak dekat" );
digitalWrite(18, LOW);
digitalWrite(5, LOW);
digitalWrite(4, HIGH);
}
else {}
}