#define ledPin1 21
#define ledPin2 19
#define ledPin3 18

#define button1 32
#define button2 33
#define button3 25
#define buttonrst 14

#define ESTADO_0 0
#define ESTADO_1 1
#define ESTADO_2 2
#define ESTADO_3 3

volatile int state = ESTADO_0;
volatile int counter = 0;
volatile int counter1 = 0;


volatile bool b1_interrupted = false;
volatile bool b1_pressed = false;

volatile bool b2_interrupted = false;
volatile bool b2_pressed = false;

volatile bool b3_interrupted = false;
volatile bool b3_pressed = false;

volatile bool rst_pressed = false;

volatile bool timer0_interrupted = false;
volatile bool timer1_interrupted = false;

volatile bool long_pressed = false;
volatile bool ok = false;  //Variable de fin de cuenta del parpadeo

hw_timer_t *timer0 = NULL;
hw_timer_t *timer1 = NULL;

void IRAM_ATTR button_1_ISR() {
  b1_interrupted = true;
  b1_pressed = !b1_pressed; // Cambiar estado al detectar cambio
}

void IRAM_ATTR button_2_ISR() {
  b2_interrupted = true;
  b2_pressed = !b2_pressed;
}

void IRAM_ATTR button_3_ISR() {
  b3_interrupted = true;
  b3_pressed = !b3_pressed;
}

void IRAM_ATTR button_rst_ISR() {
  rst_pressed = true;
  // if(state != 0) state = ESTADO_0;
  resetVariables();
}

void IRAM_ATTR timer_count() {
  timer0_interrupted = true;
  //Serial.println(counter);
}

void IRAM_ATTR timer_blink() {
  timer1_interrupted = true;
}

void resetVariables() {
  counter = 0;
  long_pressed = false;
  ok = false;
  timer0_interrupted = false;
  timer1_interrupted = false;
  b1_interrupted = false;
  b2_interrupted = false;
  // timerAlarmDisable(timer1);
  // timerAlarmDisable(timer0);

}


void FineStateMachine() {
  switch (state) {
    case ESTADO_0:

      if (b1_interrupted) {
        counter = 0;
        b1_interrupted = false;
        if (b1_pressed) {
          Serial.println("Boton 1, presionado. Timer 0 arrancado");
          timerRestart(timer0);
          timerAlarm(timer0,500000, true, 0);
        } else {
          Serial.println("Boton 1, soltado. Timer 0 parado");
          // timerAlarmDisable(timer0);
          if (!long_pressed) {
            Serial.println("Pulsacion corta, parpadea 3 veces y estado 1");
            timerRestart(timer1);
            timerAlarm(timer1,500000, true, 0);
          } else {
            Serial.println("Pulsacion larga parpadea 3 veces y , reset a estado 0");
            timerRestart(timer1);
            timerAlarm(timer1,500000, true, 0);
          }
        }
      }

      if (timer0_interrupted) {
        Serial.println("Es larga");
        long_pressed = true;
        timer0_interrupted = false;
      }

      if (timer1_interrupted) {
        counter++;
        if (counter < 6) {
          digitalWrite(ledPin1, !digitalRead(ledPin1));
        } else {
          counter = 0;
          ok = true;
          //timerAlarmDisable(timer1);
        }
        timer1_interrupted = false;
      }

      //Si ha cumplido los parpadeos, y fue corta. Estado 1

      if (ok && !long_pressed) {
        state = ESTADO_1;
        digitalWrite(ledPin1, HIGH);
        Serial.println("Siguiente estado -> 1");
        resetVariables();
      }
      //Si ha cumplido los parpadeos, y fue larga. Estado 0

      if (ok && long_pressed) {
        state = ESTADO_0;
        digitalWrite(ledPin1, LOW);
        digitalWrite(ledPin2, LOW);
        digitalWrite(ledPin3, LOW);
        Serial.println("Siguiente estado -> 0");
        resetVariables();
      }
      break;

    case ESTADO_1:

      if (b2_interrupted) {
        counter = 0;
        b2_interrupted = false;
        if (b2_pressed) {
          Serial.println("Boton 2, presionado. Timer 0 arrancado");
          timerRestart(timer0);
          timerAlarm(timer0,500000, true, 0);
        } else {
          Serial.println("Boton 2, soltado. Timer 0 parado");
          //timerAlarmDisable(timer0);
          if (long_pressed) {
            Serial.println("Pulsacion larga, parpadea 3 veces y estado 2");
            timerRestart(timer1);
            timerAlarm(timer1,500000, true, 0);
          } else {
            Serial.println("Pulsacion corta parpadea 3 veces y , reset a estado 0");
            timerRestart(timer1);
            timerAlarm(timer1,500000, true, 0);
          }
        }
      }

      if (timer0_interrupted) {
        Serial.println("Es larga");
        long_pressed = true;
        timer0_interrupted = false;
      }

      if (timer1_interrupted) {
        Serial.println("Estado 1, se mete en contador");
        counter++;
        if (counter < 6) {
          digitalWrite(ledPin2, !digitalRead(ledPin2));
        } else {
          counter = 0;
          ok = true;
          //timerAlarmDisable(timer1);
        }
        timer1_interrupted = false;
      }

      //Si ha cumplido los parpadeos, y fue larga. Estado 2

      if (ok && long_pressed) {
        state = ESTADO_2;
        digitalWrite(ledPin2, HIGH);
        Serial.println("Siguiente estado -> 2");
        ok = false;
        resetVariables();
      }
      //Si ha cumplido los parpadeos, y fue corta. Estado 0
      if (ok && !long_pressed) {
        state = ESTADO_0;
        digitalWrite(ledPin1, LOW);
        digitalWrite(ledPin2, LOW);
        digitalWrite(ledPin3, LOW);
        Serial.println("Siguiente estado -> 0");
        ok = false;
        resetVariables();
      }
      break;

    case ESTADO_2:

      if (b3_interrupted) {
        counter = 0;
        b3_interrupted = false;
        if (b3_pressed) {
          Serial.println("Boton 3, presionado. Timer 0 arrancado");
          timerRestart(timer0);
          timerAlarm(timer0,500000, true, 0);
        } else {
          Serial.println("Boton 3, soltado. Timer 0 parado");
          //timerAlarmDisable(timer0);
          if (!long_pressed) {
            Serial.println("Pulsacion corta, parpadea 3 veces y estado 3");
            timerRestart(timer1);
            timerAlarm(timer1,500000, true, 0);
          } else {
            Serial.println("Pulsacion larga parpadea 3 veces y , reset a estado 0");
            timerRestart(timer1);
            timerAlarm(timer1,500000, true, 0);
          }
        }
      }

      if (timer0_interrupted) {
        Serial.println("Es larga");
        long_pressed = true;
        timer0_interrupted = false;
      }

      if (timer1_interrupted) {
        counter++;
        if (counter < 6) {
          digitalWrite(ledPin3, !digitalRead(ledPin3));
        } else {
          counter = 0;
          ok = true;
          //timerAlarmDisable(timer1);
        }
        timer1_interrupted = false;
      }

      //Si ha cumplido los parpadeos, y fue larga. Estado 0

      if (ok && long_pressed) {
        state = ESTADO_0;
        digitalWrite(ledPin1, LOW);
        digitalWrite(ledPin2, LOW);
        digitalWrite(ledPin3, LOW);
        Serial.println("Siguiente estado -> 0");
        resetVariables();
      }

      //Si ha cumplido los parpadeos, y fue corta. Estado 3

      if (ok && !long_pressed) {
        digitalWrite(ledPin1, HIGH);
        digitalWrite(ledPin2, HIGH);
        digitalWrite(ledPin3, HIGH);
        state = ESTADO_3;
        Serial.println("Siguiente estado -> 3");
        resetVariables();
        timerRestart(timer1);
        timerAlarm(timer1,500000, true, 0);
      }

      break;

    case ESTADO_3:

      if (timer1_interrupted) {
        digitalWrite(ledPin1, !digitalRead(ledPin1));
        digitalWrite(ledPin2, !digitalRead(ledPin2));
        digitalWrite(ledPin3, !digitalRead(ledPin3));
        timer1_interrupted = false;
      }

      if (rst_pressed) {
        rst_pressed = false;
        state = ESTADO_0;
        Serial.println("FINAL, CODIGO CORRECTO. ESTADO 0");
        digitalWrite(ledPin1, LOW);
        digitalWrite(ledPin2, LOW);
        digitalWrite(ledPin3, LOW);
        resetVariables();
      }
      break;
  }
}
void setup() {
  Serial.begin(9600);

  // Configurar pines de botones y LEDs
  pinMode(button1, INPUT_PULLUP);
  pinMode(button2, INPUT_PULLUP);
  pinMode(button3, INPUT_PULLUP);
  pinMode(buttonrst, INPUT_PULLUP);
  pinMode(ledPin1, OUTPUT);
  pinMode(ledPin2, OUTPUT);
  pinMode(ledPin3, OUTPUT);

  // Configurar interrupciones
  attachInterrupt(digitalPinToInterrupt(button1), button_1_ISR, CHANGE);
  attachInterrupt(digitalPinToInterrupt(button2), button_2_ISR, CHANGE);
  attachInterrupt(digitalPinToInterrupt(button3), button_3_ISR, CHANGE);
  attachInterrupt(digitalPinToInterrupt(buttonrst), button_rst_ISR, FALLING);

  // Configurar temporizador
  timer0 = timerBegin(80);
  timerAttachInterrupt(timer0, &timer_count);
  timerAlarm(timer0, 1000000, true, 0); // Aviso cada 1s

  timer1 = timerBegin(80);
  timerAttachInterrupt(timer1, &timer_blink);
  timerAlarm(timer1, 500000, true, 0); // Aviso cada 0.5s
  digitalWrite(ledPin1, LOW);
  digitalWrite(ledPin2, LOW);
  digitalWrite(ledPin3, LOW);

}
void loop() {
  FineStateMachine();
  delay(10); // Pequeña espera para evitar rebotes
  //Serial.println(state);
}