#include <Servo.h> // library servo
Servo servo; // bagian dari library servo

const int trigPin1 = 12;      //Deklarasi trig terhubung pada pin 12
const int echoPin1 = 11;      //Deklarasi echo terhubung pada pin 11

int angle = 10;
long duration;        // variabel durasi suara
int distance;         // variabel untuk mengukur jarak


void setup() {
  // put your setup code here, to run once:
  servo.attach(8);
  servo.write(angle);
  pinMode(trigPin1, OUTPUT);      // deklarasi pin trig sebagai output
  pinMode(echoPin1, INPUT);       // deklarasi pin echo sebagai input

}

void loop() {
  // put your main code here, to run repeatedly:
digitalWrite(trigPin1, LOW);        // Intruksi untuk menon-aktifkan trig
delayMicroseconds(2);
digitalWrite(trigPin1, HIGH);       // Intruksi untuk mengaktifkan trig
delayMicroseconds(10);
digitalWrite(trigPin1, LOW);        // Intruksi untuk menon-aktifkan trig
duration = pulseIn(echoPin1, HIGH);
distance = (duration / 2) / 29.1;

if(distance<25)
{
  servo.write(90);
  }
  else
  {
  servo.write(0);
  }
}