#include <Servo.h>
#define RLED 2
#define GLED 3

Servo myservo;  // Objek untuk mengendalikan servo
int trigPin = 12;  // Pin Trigger sensor ultrasonik
int echoPin = 11; // Pin Echo sensor ultrasonik
long duration;
int distance;

void setup() {
  Serial.begin(9600); // Inisialisasi komunikasi serial
  myservo.attach(9); // Menghubungkan servo ke pin 11
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  pinMode(RLED, OUTPUT);
  pinMode(GLED, OUTPUT);
  
}

void loop() {
  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);
  digitalWrite(trigPin, HIGH); // Mengirimkan sinyal ultrasonik
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);

  duration = pulseIn(echoPin, HIGH); // Menerima waktu pantulan ultrasonik
  distance = duration * 0.034 / 2; // Menghitung jarak dalam centimeter

  Serial.print("Jarak: ");
  Serial.print(distance);
  Serial.println(" cm");

  if (distance >= 0 && distance <= 200) {
    myservo.write(90); // Menggerakkan servo ke posisi 90 derajat
    BUDI(GLED);

  } else {
    myservo.write(0); // Jika jarak lebih dari 200 cm, servo tetap di posisi 0 derajat
    BUDI(RLED);
  }
}

void BUDI(int whatled1) {
  digitalWrite(whatled1, HIGH);
  digitalWrite(whatled1, LOW);
}