#include <Servo.h>

const int trigPin = 2;
const int echoPin = 3;

Servo myservo;

void setup() {
    pinMode(trigPin, OUTPUT);  // Set trigPin sebagai OUTPUT
    pinMode(echoPin, INPUT);   // Set echoPin sebagai INPUT
    myservo.attach(11);         // Sambungkan servo ke pin 5
    Serial.begin(115200);      // Memulai komunikasi serial
}

void loop() {
    // Mengirim pulsa ke sensor ultrasonik
    digitalWrite(trigPin, HIGH);
    delayMicroseconds(10);
    digitalWrite(trigPin, LOW);

    // Menghitung jarak berdasarkan waktu pantulan
    float jarak = pulseIn(echoPin, HIGH) / 58.34;

    Serial.println(jarak); // Menampilkan jarak di Serial Monitor

    // Menggerakkan servo berdasarkan jarak
    if (jarak <= 30) {
        myservo.write(180);   // Jika jarak <= 30 cm, servo ke posisi 180 derajat
    } else {
        myservo.write(0);     // Jika jarak > 30 cm, servo kembali ke posisi 0 derajat
    }

    delay(100); // Menunggu sebentar sebelum pengukuran berikutnya
}