/*
  Kelompok 1

  JAROT WIWOHO              (41422110036)
  RAIHAN RAMANDHA SAPUTRA   (41422110039) 

*/

/* ------------------------------------------------------------------------- */

#include <Servo.h>      // LIBRARY SERVO MOTOR

int SERVO = 11;         // PIN SERVO MOTOR
int PIR = 8;            // PIN PIR MOTION SENSOR
int LED1 = 3;           // HIJAU
int LED2 = 6;           // MERAH

bool motionDetected = false;
bool doorLocked = true;

Servo doorLock;

void setup() {
  Serial.begin(115200);
  Serial.println("TUGAS ROBOTIKA DAN SISTEM OTONOM");
  Serial.println("JAROT WIWOHO                 (41422110036)");
  Serial.println("RAIHAN RAMANDHA SAPUTRA      (41422110039)");
  Serial.println("---------------------------");
  Serial.println(" ");

  pinMode(PIR, INPUT);
  pinMode(LED1, OUTPUT);
  pinMode(LED2, OUTPUT);

  doorLock.attach(SERVO);
  doorLock.write(0);
}

void loop() {
  motionDetected = digitalRead(PIR);
  if (motionDetected) {
    if (doorLocked) {
      unlockDoor();
    } else {
      lockDoor();
    }
  }
  delay(200);
}



void unlockDoor() {
  doorLocked = false;
  Serial.println("Gerakan Terdeteksi");
  Serial.println("Pintu Terbuka");
  doorLock.write(90);

  digitalWrite(LED1, HIGH);
  digitalWrite(LED2, LOW);

  delay(5000);
  doorLocked = true;
  lockDoor();
}


void lockDoor() {
  doorLock.write(0);
  Serial.println("Pintu Tertutup");
  Serial.println("----------------");
  digitalWrite(LED1, LOW);
  digitalWrite(LED2, HIGH);
}