#include <BluetoothSerial.h>
#include <Servo.h>

// ---------------- Bluetooth ----------------
BluetoothSerial SerialBT;

// ---------------- Pins ----------------
#define SERVO_PIN 13
#define RELAY_PIN 26

// ---------------- Servo ----------------
Servo lockServo;

// Servo angles (you can change)
int LOCK_ANGLE = 0;
int UNLOCK_ANGLE = 90;

// Lock status
bool isUnlocked = false;

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

  // Start Bluetooth
  SerialBT.begin("ESP32_DoorLock");  // Bluetooth Name
  Serial.println("Bluetooth Door Lock Started!");
  Serial.println("Pair with: ESP32_DoorLock");

  // Relay pin
  pinMode(RELAY_PIN, OUTPUT);
  digitalWrite(RELAY_PIN, LOW); // Relay OFF initially (solenoid OFF)

  // Servo attach
  lockServo.attach(SERVO_PIN);

  // Start in LOCK position
  lockServo.write(LOCK_ANGLE);
  isUnlocked = false;

  SerialBT.println("Welcome!");
  SerialBT.println("Send:");
  SerialBT.println("1 = Unlock");
  SerialBT.println("0 = Lock");
  SerialBT.println("S = Status");
}

void loop() {

  // Check if Bluetooth received something
  if (SerialBT.available()) {
    char cmd = SerialBT.read();  // read 1 character

    // Remove unwanted new line / spaces
    if (cmd == '\n' || cmd == '\r' || cmd == ' ') return;

    Serial.print("Command Received: ");
    Serial.println(cmd);

    if (cmd == '1') {
      unlockDoor();
    }
    else if (cmd == '0') {
      lockDoor();
    }
    else if (cmd == 'S' || cmd == 's') {
      showStatus();
    }
    else {
      SerialBT.println("❌ Invalid Command!");
      SerialBT.println("Use: 1 / 0 / S");
    }
  }
}

// ---------------- Functions ----------------

void unlockDoor() {
  SerialBT.println("🔓 Unlocking Door...");

  // Step 1: Servo rotate to unlock latch
  lockServo.write(UNLOCK_ANGLE);
  delay(700);

  // Step 2: Turn ON relay (Solenoid ON)
  digitalWrite(RELAY_PIN, HIGH);
  delay(200);

  isUnlocked = true;

  SerialBT.println("✅ Door Unlocked!");
}

void lockDoor() {
  SerialBT.println("🔒 Locking Door...");

  // Step 1: Turn OFF relay (Solenoid OFF)
  digitalWrite(RELAY_PIN, LOW);
  delay(200);

  // Step 2: Servo rotate to lock latch
  lockServo.write(LOCK_ANGLE);
  delay(700);

  isUnlocked = false;

  SerialBT.println("✅ Door Locked!");
}

void showStatus() {
  if (isUnlocked) {
    SerialBT.println("📌 Status: Door is UNLOCKED 🔓");
  } else {
    SerialBT.println("📌 Status: Door is LOCKED 🔒");
  }
}