#include <Servo.h>

//09030582327103
//09030582327094
//09030582327115
//09030282327052
//09030282327067

Servo pintu;
Servo pintu2;

void setup() {
  Serial.begin(9600);
  pinMode(3, OUTPUT); // Pin TRIG
  pinMode(2, INPUT);  // Pin ECHO
  pinMode(7, OUTPUT); // Pin lampu
  pinMode(5, OUTPUT); // Pin TRIG2
  pinMode(4, INPUT);  // Pin ECHO2
  pinMode(8, OUTPUT); // Pin lampu

  pintu.attach(10);    // Pin untuk servo pintu
  pintu2.attach(6);    // Pin untuk servo pintu2
}

void loop() {
  digitalWrite(3, HIGH);
  delayMicroseconds(10);
  digitalWrite(3, LOW);

  int range = pulseIn(2, HIGH);
  int jarak = range / 58;

  if (jarak <= 80) {
    pintu.write(0);  // Membuka pintu
    digitalWrite(7, HIGH); // Lampu hidup saat pintu terbuka

    
  } else {
    pintu.write(90);   // Menutup pintu
    digitalWrite(7, LOW); // Lampu mati saat pintu tertutup
  }
//delay(1000);

//code servo2

  digitalWrite(5, HIGH);
  delayMicroseconds(10);
  digitalWrite(5, LOW);

  int range2 = pulseIn(4, HIGH);
  int jarak2 = range2 / 58; 

  if (jarak2 > 80) {
    pintu2.write(90);  // menutup pintu ke2
    digitalWrite(7, LOW); // Lampu mati saat pintu tertutup
    digitalWrite(8, LOW); // Lampu mati saat pintu tertutup


  } else {
    pintu2.write(0);   // Membuka pintu ke2
    digitalWrite(7, HIGH); //lampu hidup ketika pintu terbuka
    digitalWrite(8, HIGH); //lampu hidup ketika pintu terbuka
  }

  //delay(1000); // Delay untuk mengurangi frekuensi pembacaan jarak
}