arduino uno ssrvo rfid rc522 door lock open

Код (C++):

boolean lockState = false; // zamok zakryt
loop()
{
...
if(..... // RFID valid card
{
lockState = true;
}
else lockState = false;
...
if(digitalRead(BUTTON_PIN) == HIGH) lockState = true;
...
if(lockState)
{
digitalWrite(LOCK_PIN, HIGH);
delay(2000);
lockState = false;
}
else digitalWrite(LOCK_PIN, LOW);

 

Код (C++):

#include <Servo.h>

#define BUTTON_PIN      2   // кнопка между пином и GND: http://www.pighixxx.com/test/portfolio-items/pushbutton-to-gnd/
#define LED_PIN         4   // http://www.pighixxx.com/test/portfolio-items/light-two-leds/
#define SERVO_PIN       6
boolean state = false;      // переменная, где хранится состояние замка: false - это закрыто
Servo myservo;              // create servo object to control a servo


void setup()
{
  pinMode(BUTTON_PIN, INPUT_PULLUP);
  pinMode(LED_PIN, OUTPUT);
  pinMode(SERVO_PIN, OUTPUT);
}


void readCard()    // читаем карту, состояние записываем в переменную state
{
  // код для работы с RFID
  /*
  if ( ..... ) // правильная карта
  {
    state = true;     // разрешено открывать замок
  }
  else state = false; // запрещено открывать замок
  */
}


void checkButton()    // проверяем кнопку, состояние записываем в переменную state
{
  if (digitalRead(BUTTON_PIN) == LOW) state = true; // нажатие кнопки меняет состояние переменной
}


void stateManager()    // обработчик событий
{
  static boolean runOnce = true;
  if (runOnce != state)
  {
    if (state == true)   // разрешено открывать замок
    {
      digitalWrite(LED_PIN, LOW);          // включаем зеленый светодиод
      myservo.attach(SERVO_PIN);           // активируем серву
      myservo.write(120);                  // крутим серву
      delay(200);
      // myservo.write(0);                 // если нужно "захлопнуть" замок
      // delay(200);
      myservo.detach();                    // отключаем серву, чтобы не скрипела
    }
    else                // запрещено открывать замок
    {
      digitalWrite(LED_PIN, HIGH);         // включаем красный светодиод
      myservo.attach(SERVO_PIN);           // активируем серву
      myservo.write(0);                    // крутим серву
      delay(200);
      myservo.detach();                    // отключаем серву, чтобы не скрипела
    }
  }
  runOnce = state;    // блокируем повторное срабатывание сервы в следующем цикле
}


void loop()          // основной цикл
{
  readCard();       // читаем карту
  checkButton();    // проверяем кнопку, событие кнопки имеет более высокий приоритет чем событие карты
  stateManager();   // обработчик событий
}

 

Светодиоды сидят на одном пине. Ссылка на схему подключения и кнопки и светодиодов есть