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

#define INPUT_PIN 17
#define LED_PIN 2
#define debounce_delay 50


int state = 0, LAST_STATE = 0, TIME_PERIOD = 0;

TimerHandle_t timer_d;
QueueHandle_t handlerQueue;


static void IRAM_ATTR gpio_interrupt_handler(void *args)
{
  xTimerStartFromISR(timer_d, NULL);
}

void debouncer(TimerHandle_t TIMER)
{
  int pinNumber = (int)pvTimerGetTimerID(TIMER);
  xQueueSendFromISR(handlerQueue, &pinNumber, NULL);
  
}

void LED_Control_Task(void *params)
{
  int pinNumber, count = 0;
  while(true)
  {
    if(xQueueReceive(handlerQueue, &pinNumber, portMAX_DELAY))
    { 
      
      printf("GPIO %d was pressed %d times, the state is %d\n",pinNumber, count++, gpio_get_level(INPUT_PIN));
      gpio_set_level(LED_PIN, gpio_get_level(INPUT_PIN));
    }
  }


}



void app_main() 
{

  gpio_reset_pin(LED_PIN);
  gpio_set_direction(LED_PIN, GPIO_MODE_OUTPUT);

  gpio_pulldown_en(INPUT_PIN);
  gpio_pullup_dis(INPUT_PIN);
  gpio_set_intr_type(INPUT_PIN, GPIO_INTR_POSEDGE);

  timer_d = xTimerCreate("timer_d", pdMS_TO_TICKS(debounce_delay), NULL, (void*)INPUT_PIN, debouncer);

  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);


}