#include <Servo.h>
Servo servo1;
const int pinTRIGGER = 6;
const int pinECHO = 5;
float durasi, jarak;
void setup()
{
Serial.begin(9600);
servo1.attach(3);
// menulis derajat awal servo (menutup)
servo1.write(0);
pinMode(pinTRIGGER, OUTPUT);
pinMode(pinECHO, INPUT);
delay(1000);
}
void loop()
{
digitalWrite(pinTRIGGER, HIGH);
delayMicroseconds(10);
digitalWrite(pinTRIGGER, LOW);
durasi = pulseIn(pinECHO, HIGH);
jarak = ((durasi * 0.034) / 2);
Serial.print("Jarak: ");
Serial.println(jarak);
if (jarak <= 7)
{
servo1.write(90);
// delay membuka servo
// di sini disetting 3 detik membukanya
// ubah durasi buka di sini
delay(3000);
// servo menutup kembali, menuju derajat 0
// ubah dan sesuaikan derajat tutup di sini
servo1.write(0);
}
// jika jarak objek terbaca lebih dari pernyataan di atas
else
{
// servo menutup, menuju derajat 0
// ubah dan sesuaikan derajat tutup di sini
servo1.write(0);
}
// delay program
delay(100);
}