#include <Servo.h>

Servo myservo;
int pinServo = 6;

int ledk = 11;
int ledo = 12;
int ledm = 13;
const int trigpin = 10;
const int echopin = 9;
long timer;
int jarak;




void setup() {
  // put your setup code here, to run once:
Serial.begin(9600);
pinMode(ledk, OUTPUT);
pinMode(ledo, OUTPUT);
pinMode(ledm, OUTPUT);
pinMode(trigpin, OUTPUT);
pinMode(echopin, INPUT);

myservo.attach(pinServo);

}




void loop() {
  // put your main code here, to run repeatedly:
digitalWrite(trigpin, LOW);
delayMicroseconds(2);
digitalWrite(trigpin, HIGH);
delayMicroseconds(10);
digitalWrite(trigpin, LOW);

timer = pulseIn(echopin, HIGH);
jarak = timer/58;
Serial.println(jarak);
delay(200);



if(jarak <50){
  digitalWrite(ledk, LOW);
  digitalWrite(ledo, LOW);
  digitalWrite(ledm, HIGH);
  myservo.write(130);
}else if (jarak <100){
  digitalWrite(ledk, LOW);
  digitalWrite(ledo, HIGH);
  digitalWrite(ledm, LOW);
  myservo.write(90);
}


else if (jarak <200){
  digitalWrite(ledk, HIGH);
  digitalWrite(ledo, LOW);
  digitalWrite(ledm, LOW);
  myservo.write(45);
}else{


  digitalWrite(ledk, LOW);
  digitalWrite(ledo, LOW);
  digitalWrite(ledm, LOW);
  myservo.write(0);
}


}