#include <Servo.h>
Servo myservo;
const int trig = 6;
const int echo = 5;
int led = 7;
long durasi,jarak;
void setup() {
Serial.begin(9600);
myservo.attach(9);
pinMode(echo, INPUT);
pinMode(trig, OUTPUT);
pinMode(led, OUTPUT);
myservo.write(0);
}
void loop() {
digitalWrite(trig, LOW);
delayMicroseconds(5);
digitalWrite(trig, HIGH);
delayMicroseconds(10);
digitalWrite(trig,LOW);
durasi = pulseIn(echo,HIGH);
jarak = (durasi * 0.034)/2;
Serial.println(jarak);
Serial.println("cm");
if (jarak <= 10){
myservo.write(90);
digitalWrite(led,HIGH);
}
if(jarak >= 11) {
myservo.write(0);
digitalWrite(led, LOW);
}
}