#include <Servo.h>

const int pinTrig = 3;
const int pinEcho = 2;
const int ledr = 8;
const int ledg = 9;
Servo servo1;
const int pinServo = 5;


void setup() {
  //servo
  servo1.attach (pinServo);
  servo1.write(0);

//led
  pinMode(ledr, OUTPUT);
  pinMode(ledg, OUTPUT);

// ultrasonik
pinMode(pinTrig, OUTPUT);
pinMode(pinEcho, INPUT);
Serial.begin(9600);
}

void loop() {

int waktu, jarak;
digitalWrite(pinTrig, LOW);
delayMicroseconds(2);
digitalWrite(pinTrig, HIGH);
delayMicroseconds(10);
digitalWrite(pinTrig, LOW);

waktu = pulseIn(pinEcho, HIGH);
jarak = waktu / 2 / 29.1;

Serial.print("Jarak : ");
Serial.print(jarak);
Serial.print("cm");
delay(1000);

  if(jarak<20){
  digitalWrite(ledr, LOW);
  digitalWrite(ledg, HIGH);
  servo1.write(0);
  delay(1000);
  }
  else if (jarak>20){
  digitalWrite(ledr, HIGH);
  digitalWrite(ledg, LOW);
  servo1.write(90);
  delay(1000);
}
}