#include "Servo.h"
#define trigPin 12
#define echoPin 13

int LEDmerah = 3;
int LEDhijau = 2;
Servo myservo;

void setup() {
  Serial.begin (115200);
  pinMode(trigPin,OUTPUT);
  pinMode(echoPin,INPUT);
  pinMode(LEDmerah,OUTPUT);
  pinMode(LEDhijau,OUTPUT);
  myservo.attach(9);
}

void loop() {
  int duration, jarak, posisi = 0,i;
  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(2);
  digitalWrite(trigPin, LOW);

  duration  = pulseIn(echoPin, HIGH);
  jarak     = (duration/2) / 29.1;

    Serial.print(jarak);
    Serial.println(" cm");

  if(jarak <= 15) {
    digitalWrite(LEDhijau, LOW);
    digitalWrite(LEDmerah, HIGH);
    myservo.write(90);
    delay(500);
  }
  else {
    digitalWrite(LEDhijau, HIGH);
    digitalWrite(LEDmerah, LOW);
    myservo.write(180);
    delay(450);
  }
}