#include <Servo.h>
#define trigPin 13
#define echoPin 12
Servo myservo;
int jarak = 0;
int durasi;
void setup() {
// put your setup code here, to run once:
pinMode(trigPin,OUTPUT);
pinMode(echoPin, INPUT);
Serial.begin (9600);
myservo.attach(9);
}
void loop() {
// put your main code here, to run repeatedly:
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
durasi = pulseIn(echoPin, HIGH);
jarak = durasi/58.2;
if (jarak>=2 && jarak<=10){
myservo.write(90);
delay(15);
}
if (jarak<=10){
myservo.write(0);
delay(15);
}
Serial.print("jarak ke Benda =");
Serial.println(jarak);
delay(1000);
}