Разблокировка Arduino Hardlid

Я пытаюсь создать анлокер на своем хардлиде для своего ute. Я заменил механизм ручной разблокировки двумя такими https://www.jaycar.com .au/slave-door-lock-actuator/p/LR8813.

Теперь мой код иногда работает, и я не могу понять, почему. Код должен работать так:

1. Нажмите кнопку разблокировки (количество шагов)
2. Нажмите кнопку разблокировки еще раз
3. Когда count = 2, включите реле на 4 секунды, затем выключите.
4. сбросить счетчик до 0
5. Если время между нажатиями больше 10 секунд, сбросьте счетчик до 0

Основная схема ниже. Обратите внимание, что кнопка на самом деле подключена к реле, которое срабатывает от пульта дистанционного управления отпиранием автомобиля, а светодиод — это приводы.

Это мой код

int switchPin = 2; // выбираем входной пин (для кнопки)
int relayPin = 4; // выбираем входной пин (для кнопки)
int val = 0; // переменная для чтения состояния пина
int counter = 0;
int currentState = 0;
int previousState = 0;
bool lockOn = false;

unsigned long currentMillis = 0;
unsigned long previousMillis = 0;

unsigned long LockcurrentMillis = 0;
unsigned long LockpreviousMillis = 0;


const long interval = 10000;
const long Lockinterval = 4000;

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

  pinMode(switchPin, INPUT); // объявляем кнопку как вход
  pinMode(relayPin, OUTPUT); // объявляем кнопку как вход


  Serial.println("Ready");
  Serial.print("IP address: ");

}

void loop() {



  currentMillis = millis();
  LockcurrentMillis = millis();
/*
  Serial.print("Current ");
  Serial.print(currentMillis);
  Serial.print(" | Previous ");
  Serial.println(previousMillis);
    //Serial.println(lockOn);


  Serial.print("Lock Current ");
  Serial.print(LockcurrentMillis);
  Serial.print(" | Lock Previous ");
  Serial.println(LockpreviousMillis);
  */
  if (lockOn == true){

    if (LockcurrentMillis - LockpreviousMillis >= Lockinterval) {
      // сохранить время последнего мигания светодиодом
      LockpreviousMillis = LockcurrentMillis;
      digitalWrite(relayPin, LOW); // выключаем relayPin
      lockOn = false;
      Serial.println("relay off");
    }
  }

  val = digitalRead(switchPin); // чтение входного значения
  if (val == HIGH) { // проверяем, является ли вход ВЫСОКИМ (кнопка отпущена)
    currentState = 1;
  }
  else {
    currentState = 0;
  }
  if (currentState != previousState) {
    if (currentState == 1) {
      counter = counter + 1;
      previousMillis = currentMillis;   //сбросить таймер
      Serial.println(counter);
    }
  }
  if (counter == 2) {
    counter = 0;
    digitalWrite(relayPin, HIGH); // включить relayPin
    // задержка (4000);
    // цифровая запись (relayPin, LOW); // выключаем relayPin
    lockOn = true;
          LockpreviousMillis = LockcurrentMillis;

    Serial.println("relay on");
  }

  previousState = currentState;
  // задержка (250);
  if (currentMillis - previousMillis >= interval) {
    // сохранить время последнего нажатия кнопки
    previousMillis = currentMillis;
    //Заблокировать предыдущую Миллис = Блокироватьтекущую Миллис;
    //если (счетчик >= 1) {
    Serial.println("Took too long reset count");
    counter = 0;
    lockOn = false;
    //}
  }
}

Мы будем очень признательны за любую помощь

Спасибо