#include <freertos/FreeRTOS.h>
#include <freertos/task.h>
#include <esp_log.h>
#include "leds.h"

#define LED_INT GPIO_NUM_2
#define LED1 GPIO_NUM_4
#define LED2 GPIO_NUM_5


static const char * TAG = "leds.c";

void led_blink_task(void *pvParameter)
{
    led_init();

    while (1) {
        //ESP_LOGI(TAG, "Blink LEDs...");
        // Blink the LEDs
        gpio_set_level(LED1, 0);
        gpio_set_level(LED2, 0);
        //gpio_set_level(LED_INT, 1);
        vTaskDelay(800 / portTICK_PERIOD_MS);
        gpio_set_level(LED1, 1);
        vTaskDelay(50 / portTICK_PERIOD_MS);
        gpio_set_level(LED2, 1);
        vTaskDelay(50 / portTICK_PERIOD_MS);
        gpio_set_level(LED1, 0);
        //gpio_set_level(LED_INT, 0);
        vTaskDelay(50 / portTICK_PERIOD_MS);
        gpio_set_level(LED2, 0);
        vTaskDelay(50 / portTICK_PERIOD_MS);
    }
}

esp_err_t led_init() {
    gpio_set_direction(LED1,GPIO_MODE_OUTPUT);
    gpio_set_direction(LED2,GPIO_MODE_OUTPUT);
    gpio_set_direction(LED_INT,GPIO_MODE_OUTPUT);
    led0_on();
    led1_off();
    led2_off();
    return ESP_OK;
}



void led0_toggle() {
    gpio_set_level(LED_INT, gpio_get_level(LED_INT));
    //ESP_LOGI(TAG, "LED 3 turned on");
}

void led0_on() {
    gpio_set_level(LED_INT, 0);
    //ESP_LOGI(TAG, "LED 3 turned on");
}

void led1_on() {
    gpio_set_level(LED1, 1);
    //ESP_LOGI(TAG, "LED 1 turned on");
}

void led2_on() {
    gpio_set_level(LED2, 1);
    //ESP_LOGI(TAG, "LED 2 turned on");
}



void led0_off()
{
    gpio_set_level(LED_INT, 1);
    //ESP_LOGI(TAG, "LED 3 turned off");
}

void led1_off()
{
    gpio_set_level(LED1, 0);
    //ESP_LOGI(TAG, "LED 1 turned off");
}

void led2_off()
{
    gpio_set_level(LED2, 0);
    //ESP_LOGI(TAG, "LED 2 turned off");
}