#include <Servo.h>
int servopin= 9;
int trigpin=13;
int echopin=12;

Servo servo1;

void setup() {
  pinMode(trigpin, OUTPUT);
  pinMode(echopin, INPUT);
  Serial.begin(9600);
  servo1.attach(servopin);
  servo1.write(0); // Set servo ke posisi awal (0 derajat)
}

void loop() {
  long duration, distance;
  // Mengirim sinyal ultrasonik
  digitalWrite(trigpin, LOW);
  delayMicroseconds(2);
  digitalWrite(trigpin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigpin, LOW);
  // Membaca waktu pantulan sinyal ultrasonik
  duration = pulseIn(echopin, HIGH);
  // Menghitung jarak berdasarkan waktu pantulan
  distance = duration / 58.2;
  Serial.print("Jarak: ");
  Serial.print(distance);
  Serial.println(" cm");
  if (distance < 10) {
    servo1.write(90); // Set servo ke posisi tengah (90 derajat)
    delay(1000);
    // Dispenser menyemprotkan hand sanitizer
    // Tambahkan kode untuk mengoperasikan dispenser
    delay(2000);
    servo1.write(0); // Set servo ke posisi awal (0 derajat)
    delay(1000);
  } else {
    servo1.write(90); // Set servo ke posisi tengah (90 derajat)
    delay(1000);
  }
}