버튼 비밀번호 도어락

#include <Servo.h>

Servo lockServo;
const int BTN_PINS[] = {2, 3, 4};
const int GREEN_LED = 7;
const int RED_LED = 8;
const int SERVO_PIN = 9;
const int BUZZER = 10;

int password[] = {0, 2, 1}; // 비밀번호: 1번→3번→2번 버튼
int inputIndex = 0;
bool locked = true;

void setup() {
  for (int i = 0; i < 3; i++) pinMode(BTN_PINS[i], INPUT);
  pinMode(GREEN_LED, OUTPUT);
  pinMode(RED_LED, OUTPUT);
  lockServo.attach(SERVO_PIN);
  lockServo.write(0); // 잠금 위치
  digitalWrite(RED_LED, HIGH);
  Serial.begin(9600);
  Serial.println("도어락 준비 완료!");
}

void loop() {
  for (int i = 0; i < 3; i++) {
    if (digitalRead(BTN_PINS[i]) == HIGH) {
      delay(200); // 디바운싱
      tone(BUZZER, 1000, 100);
      
      if (password[inputIndex] == i) {
        inputIndex++;
        Serial.print("올바른 입력! (");
        Serial.print(inputIndex);
        Serial.println("/3)");
        
        if (inputIndex >= 3) {
          // 잠금 해제!
          locked = false;
          lockServo.write(90);
          digitalWrite(GREEN_LED, HIGH);
          digitalWrite(RED_LED, LOW);
          tone(BUZZER, 2000, 500);
          Serial.println("=== 잠금 해제! ===");
          delay(5000); // 5초 후 다시 잠금
          lockServo.write(0);
          digitalWrite(GREEN_LED, LOW);
          digitalWrite(RED_LED, HIGH);
          locked = true;
          inputIndex = 0;
        }
      } else {
        // 틀림 - 초기화
        inputIndex = 0;
        tone(BUZZER, 200, 500);
        Serial.println("비밀번호 틀림! 초기화");
        for (int j = 0; j < 3; j++) {
          digitalWrite(RED_LED, LOW); delay(100);
          digitalWrite(RED_LED, HIGH); delay(100);
        }
      }
      while (digitalRead(BTN_PINS[i]) == HIGH); // 버튼 떼기 대기
    }
  }
}