#include <Wire.h>
#include <Servo.h>
Servo myservo;
#define trigPin 8
#define echoPin 9
long duration;
int distance = 0;
int pos =0;
void setup() {
myservo.attach(10);
pinMode(trigPin, OUTPUT); // setting triggerpin sebagai output
pinMode(echoPin, INPUT); // setting echopin sebagai Input
Serial.begin(9600); // setting kecepatan pengiriman serial monitor
}
void loop() {
// put your main code here, to run repeatedly:
digitalWrite(trigPin, HIGH);// aktifkan sensor ultrasonic
delayMicroseconds(10); // selama 10 microseconds
digitalWrite(trigPin, LOW); // matikan sensor ultrasonic
duration = pulseIn(echoPin, HIGH); // baca rentan waktu dari trigPin High sampai echoPin high
distance = duration*0.034/2; //konversi selang waktu ke CM
if (distance < 30)
{
Serial.println(distance);
myservo.write(130);
delay(3000);
}
else
{
myservo.write(0);
}
}