#include <stdio.h>
#include "freertos/FreeRTOS.h"
#include "freertos/task.h"
#include "driver/gpio.h"
#include "esp_rom_sys.h"
#include "esp_log.h"
#include "dht22.h"
#include "GPS_parser.h"
#include "driver/uart.h"


const char *DHT_TAG = "DHT22";
const char *GPS_TAG = "GPS_PARSER";

const int uart_buffer_size = (1024 * 2);
int length = 0;

uint8_t data;

static gps_parser_t gps;

void read_uart_char();

void uart_configurator();



void app_main(void)
{
    // Initialize DHT22 sensor
    /*
    float temperature;
    float humidity;
    esp_err_t err = dht_attach_pin();
    if (err != ESP_OK) {
        ESP_LOGE(DHT_TAG, "Failed to attach DHT pin: %s", esp_err_to_name(err));
        vTaskDelay(pdMS_TO_TICKS(5000)); // Wait for 5 seconds before retrying
        return;
    }
    vTaskDelay(pdMS_TO_TICKS(2000)); // Wait for 2 seconds before starting the main loop
    while (1) {
        if (dht_read(&temperature, &humidity) == ESP_OK) {
            ESP_LOGI(DHT_TAG, "Temperature: %.1f°C, Humidity: %.1f%%", temperature, humidity);
        } else {
            ESP_LOGE(DHT_TAG, "Failed to read from DHT22 sensor");
        }
        vTaskDelay(pdMS_TO_TICKS(5000)); // Wait for 5 seconds before the next reading
    }
    */
    // Initialize GPS parser
    uart_configurator();
    double latitude, longitude;
    gps_parser_init(&gps);
    while(1){
        while (uart_read_bytes(UART_NUM_2, &data, 1, 0)){
            gps_parser_encode(&gps, data);
        }
        if (gps_location_is_valid(&gps.location)) {
            double lat = gps_location_lat(&gps.location);
            double lng = gps_location_lng(&gps.location);
            ESP_LOGI(GPS_TAG, "Lat: %.8f, Lng: %.8f", lat, lng);
        }

        if (gps_date_is_valid(&gps.date) && gps_time_is_valid(&gps.time)) {
            ESP_LOGI(GPS_TAG, "Fecha: %02u/%02u/%04u Hora: %02u:%02u:%02u\n",
                    gps_date_day(&gps.date),
                    gps_date_month(&gps.date),
                    gps_date_year(&gps.date),
                    gps_time_hour(&gps.time),
                    gps_time_minute(&gps.time),
                    gps_time_second(&gps.time));
        }
        vTaskDelay(pdMS_TO_TICKS(2000)); // Wait for 1 second before the next reading
    }

}


void uart_configurator() {
    // Configure UART parameters
    uart_config_t uart_config = {
        .baud_rate = 115200,
        .data_bits = UART_DATA_8_BITS,
        .parity = UART_PARITY_DISABLE,
        .stop_bits = UART_STOP_BITS_1,
        .flow_ctrl = UART_HW_FLOWCTRL_DISABLE
    };
    QueueHandle_t uart_queue;
    // Install UART driver using an event queue here
    ESP_ERROR_CHECK(uart_driver_install(UART_NUM_2, uart_buffer_size, uart_buffer_size, 10, &uart_queue, 0));
    ESP_ERROR_CHECK(uart_param_config(UART_NUM_2, &uart_config));
    ESP_ERROR_CHECK(uart_set_pin(UART_NUM_2, GPIO_NUM_17, GPIO_NUM_16, UART_PIN_NO_CHANGE, UART_PIN_NO_CHANGE));
}

void read_uart_char() {
    ESP_ERROR_CHECK(uart_get_buffered_data_len(UART_NUM_2, (size_t*)&length));
     // Read one byte from UART
}