#include <Servo.h>

// Deklarasi pin
#define TRIG_PIN 12
#define ECHO_PIN 13
#define SERVO_PIN 9

// Deklarasi objek
Servo myservo;

void setup() {
  // Inisialisasi serial
  Serial.begin(9600);

  // Inisialisasi pin
  pinMode(ECHO_PIN, INPUT);
  myservo.attach(SERVO_PIN);
}
void loop() {
  // Mengirim sinyal trigger
  digitalWrite(TRIG_PIN, HIGH);
  delayMicroseconds(5);
  digitalWrite(TRIG_PIN, HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG_PIN, LOW);

  // Menerima sinyal echo
  long duration = pulseIn(ECHO_PIN, HIGH);

  // Menghitung jarak
  float distance = duration * 0.034 / 2;

  // Mencetak jarak ke serial
  Serial.print("Jarak: ");
  Serial.print(distance);
  Serial.println(" cm");

  // Menggerakkan servo berdasarkan jarak
  if (distance<6){
  myservo.write(0); }

  else if(distance>=6) {
  myservo.write(180);
  }
}