#include <stdio.h>
#include "freertos/FreeRTOS.h"
#include "freertos/task.h"
#include "freertos/queue.h"
#include "driver/gpio.h"
#include "esp_timer.h"  

#define INPUT_PIN 17
#define LED_PIN 2
#define DEBOUNCE_TIME_MS 200  

int state = 0;
QueueHandle_t handlerQueue;
int64_t lastInterruptTime = 0;  
int64_t buttonPressedTime = 0;  
int64_t buttonReleasedTime = 0; 

static void IRAM_ATTR gpio_interrupt_handler(void *args)
{
  int64_t currentTime = esp_timer_get_time() / 1000; 
  if (currentTime - lastInterruptTime > DEBOUNCE_TIME_MS)
  {
    int pinNumber = (int)args;
    xQueueSendFromISR(handlerQueue, &pinNumber, NULL);
    lastInterruptTime = currentTime;
  }
}

void LED_Control_Task(void *params)
{
  int pinNumber, count = 0;
  while(true)
  {
    if (xQueueReceive(handlerQueue, &pinNumber, portMAX_DELAY))
    {
      int buttonState = gpio_get_level(INPUT_PIN);
      if (buttonState == 1)  
      {
        buttonPressedTime = esp_timer_get_time();  
        printf("GPIO %d was pressed %d times. The state is %d \n",
               pinNumber, count++, buttonState);
      }
      else  // Se detecta cuando el botón es soltado
      {
        buttonReleasedTime = esp_timer_get_time();  
        int64_t pressDuration = (buttonReleasedTime - buttonPressedTime) / 1000;  // Convertir a milisegundos
        printf("GPIO %d was released. Button held for %lld ms\n", pinNumber, pressDuration);
      }

      
      gpio_set_level(LED_PIN, buttonState);
    }
  }
}

void app_main() {
  gpio_reset_pin(LED_PIN);
  gpio_set_direction(LED_PIN, GPIO_MODE_OUTPUT);

  gpio_reset_pin(INPUT_PIN);
  gpio_set_direction(INPUT_PIN, GPIO_MODE_INPUT);
  gpio_pulldown_en(INPUT_PIN);
  gpio_pullup_dis(INPUT_PIN);
  gpio_set_intr_type(INPUT_PIN, GPIO_INTR_ANYEDGE);  /

  handlerQueue = xQueueCreate(10, sizeof(int));
  xTaskCreate(LED_Control_Task, "LED_Control_Task", 2048, NULL, 1, NULL);

  gpio_install_isr_service(0);
  gpio_isr_handler_add(INPUT_PIN, gpio_interrupt_handler, (void *)INPUT_PIN);
}