#include <Servo.h>
Servo servoku;
#define pele 3
#define pene 2
long duration;// variable untuk durasi perjalanan gelombang suara
int distance;// variable untuk pengukuran jarak
void setup(){
//memperkenalkan seluruh hardware yang kita gunakan dan
//fungsi nya kepada arduino
servoku.attach(5);
pinMode(pele, OUTPUT);
pinMode(pene, INPUT);
Serial.begin(9600);
Serial.println("Ultrasonic Sensor HC_SR04 Test");
Serial.println("with Arduino UNO R3");
}
void loop(){
//memerintahkan arduino agar mengatur dan mengunakan semua hardware sesuai
//dengan jadwal yang kita buat
digitalWrite(pele, LOW);
delayMicroseconds(2);
digitalWrite(pele, HIGH);
delayMicroseconds(10);
digitalWrite(pele, LOW);
duration=pulseIn(pene, HIGH);
distance=duration * 0.0345/ 2;// penjelasan kecepatan gelombang elektromagnetik
Serial.print("Distance: ");
Serial.print(distance);
Serial.println("cm");
//memerintahkan arduino untuk menghidup k
if(distance <11 ){
Serial.println("Jarak kurang dari 10cm");
servoku.write(10);
delay(1000);
servoku.write(100);
delay(1000);
}
}