#include "freertos/FreeRTOS.h"
#include "driver/temperature_sensor.h"
#include "driver/gpio.h"
#include "esp_log.h"
#include "esp_err.h"

#include "config.h"
#include "system_health.h"

static uint8_t sys_led_state = 1; // LED state variable
static temperature_sensor_handle_t temp_sensor;
//static const char *TAG = "SystemHealth"; 

/*
    EXP32-C3 Chip built-in temprature sensor
    Read & display the temperature value
*/
static void temp_sensor_task (void *arg) {
    while (true) {
        ESP_LOGI(TAG, "Reading sensor temperature");
        float tsens_value;
        ESP_ERROR_CHECK(temperature_sensor_get_celsius(temp_sensor, &tsens_value));
        ESP_LOGW(TAG, "Temperature value %.02f ℃", tsens_value);
        vTaskDelay(5000 / portTICK_PERIOD_MS);
    }
}

static void system_led_task (void *arg) {
    while (1) {
        gpio_set_level(SYS_LED_GPIO, sys_led_state);
        vTaskDelay(750 / portTICK_PERIOD_MS);
        sys_led_state = !sys_led_state; // Toggle the LED state
    }
}
void system_led_init () {
    gpio_reset_pin(SYS_LED_GPIO);
    gpio_set_direction(SYS_LED_GPIO, GPIO_MODE_OUTPUT);
    xTaskCreate(system_led_task, "System LED", 2048, NULL, 15, NULL);
}

void chip_sensor_init () {
    temp_sensor = NULL;
    temperature_sensor_config_t temp_sensor_config = TEMPERATURE_SENSOR_CONFIG_DEFAULT(10, 50);
    ESP_ERROR_CHECK(temperature_sensor_install(&temp_sensor_config, &temp_sensor));

    ESP_LOGI(TAG, "Enable temperature sensor");
    ESP_ERROR_CHECK(temperature_sensor_enable(temp_sensor));

    xTaskCreate(temp_sensor_task, "ESP32C3 Sensor", 2048, NULL, 15, NULL);
}