void setup() {
Serial.begin(115200);
pinMode(2, OUTPUT);
pinMode(3, INPUT);
pinMode(4, OUTPUT);
pinMode(5, OUTPUT);
pinMode(6, OUTPUT);
}
void loop() {
//Sensor
digitalWrite(2, HIGH);
delayMicroseconds(10);
digitalWrite(2, LOW);
//Logic
int jarak = pulseIn(3, HIGH);
int cm = jarak / 58;
Serial.print(cm);
Serial.println(" cm");
if (cm <= 100) {
digitalWrite(4, HIGH);
digitalWrite(5, LOW);
digitalWrite(6, LOW);
}
else if (cm > 100 && cm <= 200){
digitalWrite(4, LOW);
digitalWrite(5, HIGH);
digitalWrite(6, LOW);
}
else {
digitalWrite(4, LOW);
digitalWrite(5, LOW);
digitalWrite(6, HIGH);
}
}