#include <Servo.h>
#define echoPin 2
#define trigPin 3
int maximumRange = 300;
int minimumRange = 0;
long duration, distance;
Servo myServo;
void setup() {
Serial.begin(9600);
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
// Pin LED
pinMode(9, OUTPUT);
pinMode(10, OUTPUT);
pinMode(11, OUTPUT);
myServo.attach(3);
}
void loop() {
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
duration = pulseIn(echoPin, HIGH);
distance = duration / 58.2;
if (distance >= maximumRange || distance <= minimumRange) {
Serial.println("Di Luar Jangkauan");
} else {
Serial.print("Jarak : ");
Serial.print(distance);
Serial.println(" cm ");
delay(100);
}
if (distance <= 10) {
digitalWrite(11, HIGH);
digitalWrite(10, LOW);
digitalWrite(9, LOW);
myServo.write(0);
}
else if (distance > 10 && distance < 20) {
digitalWrite(11, LOW);
digitalWrite(10, HIGH);
digitalWrite(9, LOW);
myServo.write(90);
}
else if (distance >= 20) {
digitalWrite(11, LOW);
digitalWrite(10, LOW);
digitalWrite(9, HIGH);
myServo.write(180);
}
}