#include <NewPing.h>
#include <Servo.h> // Memanggil library servo

Servo myservo; // Inisialisasi myservo

#define TRIGGER_PIN 5 // Pin Trigger dihubungkan ke Pin Digital 5 Arduino
#define ECHO_PIN 6    // Pin Echo dihubungkan ke Pin Digital 6 Arduino
#define MAX_DISTANCE 70 // Batas jarak pengukuran sensor ultrasonic 

NewPing sonar(TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE); 

void setup() {
  myservo.attach(2); // Pin Out Servo dihubungkan ke Pin Digital 2 Arduino
  Serial.begin(9600);
}

void loop() {
  delay(50); 
  int jarak = sonar.ping_cm(); // Variabel "jarak" untuk menampung hasil pengukuran jarak
  Serial.println(jarak);
  
  if ((jarak > 0) && (jarak <= 70)) {
    delay(50); // Jeda waktu 50 ms
    myservo.write(10); // Membuka kotak sampah pada 10°
    delay(2000); // Jeda waktu kotak sampah terbuka 2 detik
    myservo.write(120); // Menutup kotak sampah pada 120°
    delay(1500); // Jeda waktu kotak sampah tertutup 1,5 detik 
  }
}