#include <NewPing.h>
#include <Servo.h>

#define TRIGGER_PIN   2       // pin trigger untuk sensor ultrasonik pertama
#define ECHO_PIN      3       // pin echo untuk sensor ultrasonik pertama
#define TRIGGER_PIN2  4       // pin trigger untuk sensor ultrasonik kedua
#define ECHO_PIN2     5       // pin echo untuk sensor ultrasonik kedua
#define MAX_DISTANCE 100      // jarak maksimum untuk sensor ultrasonik

Servo servoAne;
NewPing sampah(TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE);      // membuat objek sensor ultrasonik pertama
NewPing kapasitas(TRIGGER_PIN2, ECHO_PIN2, MAX_DISTANCE); // membuat objek sensor ultrasonik kedua

void setup() {
  Serial.begin(9600);

  servoAne.attach(9);            // inisialisasi pin servo
  servoAne.write(0);
}

void loop() {
  delay(50);
  int US1 = sampah.ping_cm();
  int US2 = kapasitas.ping_cm();   // nilai kapasitas tanpa penambahan konstanta

  Serial.print("sampah : ");
  Serial.print(US1);
  Serial.print("cm, kapasitas: ");
  Serial.println(US2);

  if (US2 <= 5) {  // Periksa kapasitas bak sampah terdeteksi penuh (jarak sekitar 5 cm dari sampah)
    Serial.println("Kapasitas bak sampah penuh!");
    // Tambahkan logika atau tindakan lain yang sesuai jika kapasitas penuh
  } else {
    if (US1 <= 10) {
      servoAne.write(90);
      delay(2000);  // sesuaikan durasi sesuai kebutuhan
    } else {
      servoAne.write(0);
      delay(5);
    }
  }
}