#include <ezButton.h>

int RestCoord = 512;
int MaxCoord = 1023;
int MinCoord = 0;

// { RestCoord, MaxCoord },  // JoystickTop
// { RestCoord, MinCoord },     // JoystickBottom
// { MaxCoord, RestCoord },  // JoystickLeft
// { MinCoord, RestCoord },  // JoystickRight

int passcode[6][2] = {
  { RestCoord, MaxCoord },  // JoystickTop
  { RestCoord, MinCoord },     // JoystickBottom
  { MaxCoord, RestCoord },  // JoystickLeft
  { RestCoord, MaxCoord },  // JoystickTop
  { RestCoord, MinCoord },     // JoystickBottom
  { MaxCoord, RestCoord },  // JoystickLeft
};
int passcodeCurrentIndex = 0;
int enteredPasscode[6][2];  // Declare with same dimensions as passcode
bool isPasswordCorrect = false;

int lastJoystickPosX = 512;
int lastJoystickPosY = 512;

ezButton button(5);

boolean isMax(int pos) {
  return pos >= MaxCoord - 100 && pos <= MaxCoord + 100;
}
boolean isMin(int pos) {
  return pos >= MinCoord - 100 && pos <= MinCoord + 100;
}
boolean isRest(int pos) {
  return pos >= RestCoord - 100 && pos <= RestCoord + 100;
}

void setup() {
  // put your setup code here, to run once:
  pinMode(2, OUTPUT);
  pinMode(3, OUTPUT);
  pinMode(4, OUTPUT);
  Serial.begin(9600);
  button.setDebounceTime(50);
}

void loop() {
  button.loop();

  int joystickPosX = analogRead(A0);
  int joystickPosY = analogRead(A1);
  int bValue = button.getState();

  if (isRest(lastJoystickPosX) && isRest(lastJoystickPosY) && (!isRest(joystickPosX) || !isRest(joystickPosY))) {
    enteredPasscode[passcodeCurrentIndex][0] = isMax(joystickPosX) ? MaxCoord : isMin(joystickPosX) ? MinCoord : RestCoord;  // Append to enteredPasscode
    enteredPasscode[passcodeCurrentIndex][1] = isMax(joystickPosY) ? MaxCoord : isMin(joystickPosY) ? MinCoord : RestCoord;  // Append to enteredPasscode

    passcodeCurrentIndex++;
    digitalWrite(4, HIGH);
  }

  if (button.isPressed()) {
    Serial.println("The button is pressed");

    if (!isPasswordCorrect) {
      int isCorrect = true;
      for (int i = 0; i < 6; i++) {
        Serial.println("password ");
        Serial.print(enteredPasscode[i][0]);
        Serial.print(",");
        Serial.print(enteredPasscode[i][1]);
        Serial.print(", ");
        if (enteredPasscode[i][0] != passcode[i][0] || enteredPasscode[i][1] != passcode[i][1]) {
          isCorrect = false;
          break;
        }
      }

      isPasswordCorrect = isCorrect;

      digitalWrite(4, HIGH);
    }
  }

  if (button.isReleased()) {
    Serial.println("The button is released");
    
    if (isPasswordCorrect) {
      digitalWrite(2, HIGH);

      isPasswordCorrect = false;
    } else {
      digitalWrite(3, HIGH);
    }

    // Reset enteredPasscode
    for (int i = 0; i < 6; i++) {
      enteredPasscode[i][0] = -1;  // Set default value for reset
      enteredPasscode[i][1] = -1;
    }
    passcodeCurrentIndex = 0;
  }


  Serial.print("x = ");
  Serial.print(joystickPosX);
  Serial.print(", y = ");
  Serial.println(joystickPosY);

  lastJoystickPosX = joystickPosX;
  lastJoystickPosY = joystickPosY;

  delay(100);

  digitalWrite(2, LOW);
  digitalWrite(3, LOW);
  digitalWrite(4, LOW);
}