#include <Servo.h>
int trigPin = 5;
int echoPin = 6;
Servo myservo;
void setup() {
Serial.begin(9600);
pinMode(trigPin, INPUT);
pinMode(echoPin, INPUT);
myservo.attach(10);
}
void loop() {
long duration, distance;
digitalWrite(trigPin, LOW);
delayMicroseconds(5);
digitalWrite(trigPin, HIGH);
delayMicroseconds(5);
digitalWrite(trigPin, LOW);
// mengukur durasi dari echo
duration = pulseIn(echoPin, HIGH);
// Menghitung jarak
distance = duration*0.034/2;
Serial.print("Jarak : ");
Serial.println(distance);
// Mengecek apabila sampah dapat dibuka
if (distance<= 30) {
myservo.write(0);
delay(5);
} else {
myservo.write(90);
delay(5);
}
}