#define trigPin 2
#define echoPin 3
#define led 13
#include <Servo.h>;
long duration;
int distance;
Servo SERVO1;

void setup() {
pinMode(trigPin, OUTPUT);
 pinMode(echoPin, INPUT);
 pinMode(led, OUTPUT);
 Serial.begin(9600);
 Serial.println("Ultrasonic Sensor HC-SR04 test");
 Serial.println("with Arduino Uno R3");
SERVO1.attach(5);

}

void loop() {
 digitalWrite(trigPin, LOW);//hapus kondisi trigpin
 digitalWrite(trigPin, HIGH);
 delayMicroseconds(10);
 digitalWrite(trigPin, LOW);
long duration = pulseIn(echoPin, HIGH); // hitung jarak
int distance = int(duration) * 0.0344 / 2.0; //kecepatan dibagi 2
Serial.print("distance: "); 
Serial.print((distance));
Serial.println(" cm");

if (distance < 10)
{ SERVO1.write(0);
  delay(1000);
}
else {
SERVO1.write(90);
delay(1000);

}
}