#include <Servo.h>
Servo myservo;
int trig=2;
int echo=3;
long durasi, jarak;

void setup()
{
  pinMode(trig,OUTPUT);
  pinMode(echo,INPUT);
  Serial.begin(9600);
  myservo.attach (11);
}

void loop()
{
  digitalWrite(trig,LOW);
  delayMicroseconds(8);
  digitalWrite(trig,HIGH);
  delayMicroseconds(8);
  digitalWrite(trig,LOW);
  delayMicroseconds(8);

  durasi=pulseIn(echo,HIGH);
  jarak=(durasi/2)/29.1;
  Serial.println(jarak);

  if(jarak <25){
  myservo.write(90);
  }
else{
  myservo.write(0);
}
}