// Library untuk kontrol servo
#include <Servo.h>

// Pin untuk sensor ultrasonik
const int trigPin = 7;
const int echoPin = 6;

// Pin untuk LED
const int ledPin = 13;

// Pin untuk servo
const int servoPin = 9;
Servo myservo;

void setup() {
  Serial.begin(9600);
  
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  pinMode(ledPin, OUTPUT);
  
  myservo.attach(servoPin);
}

void loop() {
  // Mengirimkan pulsa ultrasonik
  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);
  
  // Menerima waktu pantulan pulsa ultrasonik
  long duration = pulseIn(echoPin, HIGH);
  
  // Menghitung jarak berdasarkan waktu
  float distance = duration * 0.034 / 2;
  
  Serial.print("Jarak: ");
  Serial.print(distance);
  Serial.println(" cm");
  
  // Mengatur LED dan servo berdasarkan jarak
  if (distance <= 30) {
    digitalWrite(ledPin, HIGH);  // Menghidupkan LED
    myservo.write(90);            // Mengatur posisi servo ke tengah (90 derajat)
  } else {
    digitalWrite(ledPin, LOW);   // Mematikan LED
    myservo.write(0);             // Mengatur posisi servo ke awal (0 derajat)
  }
  
  delay(500); // Delay untuk stabilitas pembacaan
}