#include <Servo.h>
int trig =4;
int echo =3;
int ledm =5;
int ledk =7;
int ledh =6;
int ledb =8;
int ledu =9;
long durasi, jarak;
Servo servoku;

void setup()
{
  pinMode(ledm, OUTPUT);
  pinMode(ledk, OUTPUT); 
  pinMode(ledh, OUTPUT);
  pinMode(ledb, OUTPUT);
  pinMode(ledu, OUTPUT);
  servoku.attach(12);
  Serial.begin(9600);
}

void loop()
{
  digitalWrite(trig,LOW);
  delayMicroseconds(0);
  digitalWrite(trig,HIGH);
  delayMicroseconds(0);
  digitalWrite(trig,LOW);
  delayMicroseconds(0);
  
  durasi=pulseIn(echo, HIGH);
  jarak=(durasi/2)/29.1;
  Serial.println(jarak);

   if(jarak <25)
   {
  digitalWrite(ledm, HIGH);
  digitalWrite(ledk, HIGH);
  digitalWrite(ledh, HIGH);
  digitalWrite(ledb, HIGH);
  digitalWrite(ledu, HIGH);
  servoku.write(180);
  
  servoku.write(0);
   }
  else
  {
  digitalWrite(ledm, HIGH);
  digitalWrite(ledk, HIGH);
  digitalWrite(ledh, HIGH);
  digitalWrite(ledb, HIGH);
  digitalWrite(ledu, HIGH);
  servoku.write(180);
  
  servoku.write(0);
  }
}