/*
 * Copyright (c) 2023 Juan Manuel Cruz <jcruz@fi.uba.ar> <jcruz@frba.utn.edu.ar>.
 * Copyright (c) 2026 Martin Javier Klöckner <mklockner@fi.uba.ar>
 *
 * See file `LICENSE` for full details
 */

/* Project includes */
#include "main.h"

#include "logger.h"
#include "dwt.h"

#include "app.h"
#include "task_leds_attribute.h"
#include "task_leds_interface.h"

#define G_TASK_LEDS_CNT_INIT     0ul
#define G_TASK_LEDS_TICK_CNT_INI 0ul

#define DEL_LED_XX_PUL      250ul
#define DEL_LED_XX_BLI      500ul
#define DEL_LED_XX_MIN      0ul

#define LED_ON  GPIO_PIN_SET
#define LED_OFF GPIO_PIN_RESET

static const task_leds_cfg_t task_leds_cfg_list[] = {
    {ID_LED_A, LD2_GPIO_Port, LD2_Pin, LED_ON, LED_OFF, DEL_LED_XX_BLI, DEL_LED_XX_PUL},
    {ID_LED_B, LD3_GPIO_Port, LD3_Pin, LED_ON, LED_OFF, DEL_LED_XX_BLI, DEL_LED_XX_PUL},
};

#define LEDS_CFG_QTY (sizeof(task_leds_cfg_list)/sizeof(task_leds_cfg_t))

#define LEDS_DTA_QTY (sizeof(task_leds_dta_list)/sizeof(task_leds_dta_t))

// Private functions declaration
static void task_leds_statechart(void);

// Exported data definition
uint32_t g_task_leds_cnt;
volatile uint32_t g_task_leds_tick_cnt;

task_leds_dta_t task_leds_dta_list[] = {
    {DEL_LED_XX_MIN, ST_LED_XX_OFF, EV_LED_XX_NOT_BLINK, false},
    {DEL_LED_XX_MIN, ST_LED_XX_OFF, EV_LED_XX_NOT_BLINK, false},
};

// External functions definition
void task_leds_init(void *parameters)
{
    uint32_t index;
    const task_leds_cfg_t *p_task_leds_cfg;
    task_leds_dta_t *p_task_leds_dta;

    LOGGER_INFO("Initializing `task_leds`...");

    g_task_leds_cnt = G_TASK_LEDS_CNT_INIT;
    for (index = 0; LEDS_DTA_QTY > index; index++)
    {
        p_task_leds_cfg = &task_leds_cfg_list[index];
        p_task_leds_dta = &task_leds_dta_list[index];

        p_task_leds_dta->state = ST_LED_XX_OFF;
        p_task_leds_dta->event = EV_LED_XX_OFF;
        p_task_leds_dta->flag = false;

        HAL_GPIO_WritePin(p_task_leds_cfg->gpio_port,
                p_task_leds_cfg->pin,
                p_task_leds_cfg->led_off);
    }
}

void task_leds_update(void *parameters)
{
    bool b_time_update_required = false;

    __asm("CPSID i");
    if (G_TASK_LEDS_TICK_CNT_INI < g_task_leds_tick_cnt)
    {
        g_task_leds_tick_cnt--;
        b_time_update_required = true;
    }
    __asm("CPSIE i");

    while (b_time_update_required)
    {
        g_task_leds_cnt++;

        task_leds_statechart();

        __asm("CPSID i");
        if (G_TASK_LEDS_TICK_CNT_INI < g_task_leds_tick_cnt)
        {
            g_task_leds_tick_cnt--;
            b_time_update_required = true;
        }
        else
        {
            b_time_update_required = false;
        }
        __asm("CPSIE i");
    }
}

static void task_leds_statechart(void)
{
    uint32_t index;
    const task_leds_cfg_t *p_task_leds_cfg;
    task_leds_dta_t *p_task_leds_dta;

    for (index = 0; LEDS_DTA_QTY > index; index++)
    {
        p_task_leds_cfg = &task_leds_cfg_list[index];
        p_task_leds_dta = &task_leds_dta_list[index];

        switch (p_task_leds_dta->state)
        {
            case ST_LED_XX_OFF:
                if (true == p_task_leds_dta->flag)
                {
                    p_task_leds_dta->flag = false;
                    switch(p_task_leds_dta->event)
                    {
                        case EV_LED_XX_ON:
                            p_task_leds_dta->state = ST_LED_XX_ON;
                            HAL_GPIO_WritePin(
                                    p_task_leds_cfg->gpio_port,
                                    p_task_leds_cfg->pin,
                                    p_task_leds_cfg->led_on);
                        break;

                        case EV_LED_XX_BLINK:
                            p_task_leds_dta->tick  = DEL_LED_XX_BLI;
                            p_task_leds_dta->state = ST_LED_XX_BLINK_ON;
                            HAL_GPIO_WritePin(
                                    p_task_leds_cfg->gpio_port,
                                    p_task_leds_cfg->pin,
                                    p_task_leds_cfg->led_on);
                        break;

                        case EV_LED_XX_PULSE:
                            p_task_leds_dta->tick  = DEL_LED_XX_PUL;
                            p_task_leds_dta->state = ST_LED_XX_PULSE;
                            HAL_GPIO_WritePin(
                                    p_task_leds_cfg->gpio_port,
                                    p_task_leds_cfg->pin,
                                    p_task_leds_cfg->led_on);
                        default:
                        break;
                    }
                }
            break;

            case ST_LED_XX_ON:
                if ((true == p_task_leds_dta->flag)
                        && (EV_LED_XX_OFF == p_task_leds_dta->event))
                {
                    p_task_leds_dta->flag = false;
                    p_task_leds_dta->state = ST_LED_XX_OFF;
                    HAL_GPIO_WritePin(
                            p_task_leds_cfg->gpio_port,
                            p_task_leds_cfg->pin,
                            p_task_leds_cfg->led_off);
                }

            break;

            case ST_LED_XX_BLINK_ON:
                if (true == p_task_leds_dta->flag)
                {
                    p_task_leds_dta->flag = false;
                    switch(p_task_leds_dta->event)
                    {
                        case EV_LED_XX_OFF:
                            p_task_leds_dta->state = ST_LED_XX_OFF;
                            HAL_GPIO_WritePin(
                                    p_task_leds_cfg->gpio_port,
                                    p_task_leds_cfg->pin,
                                    p_task_leds_cfg->led_off);
                        break;
                        case EV_LED_XX_ON:
                            p_task_leds_dta->state = ST_LED_XX_ON;
                            HAL_GPIO_WritePin(
                                    p_task_leds_cfg->gpio_port,
                                    p_task_leds_cfg->pin,
                                    p_task_leds_cfg->led_on);
                        default:
                        break;
                    }
                }

                if (DEL_LED_XX_MIN == p_task_leds_dta->tick)
                {
                    p_task_leds_dta->state = ST_LED_XX_BLINK_OFF;
                    p_task_leds_dta->tick = DEL_LED_XX_BLI;
                    HAL_GPIO_WritePin(
                            p_task_leds_cfg->gpio_port,
                            p_task_leds_cfg->pin,
                            p_task_leds_cfg->led_off);
                }

                if (DEL_LED_XX_MIN < p_task_leds_dta->tick)
                {
                    p_task_leds_dta->tick--;
                }
            break;

            case ST_LED_XX_BLINK_OFF:
                if (true == p_task_leds_dta->flag)
                {
                    p_task_leds_dta->flag = false;
                    switch(p_task_leds_dta->event)
                    {
                        case EV_LED_XX_OFF:
                            p_task_leds_dta->state = ST_LED_XX_OFF;
                            HAL_GPIO_WritePin(
                                    p_task_leds_cfg->gpio_port,
                                    p_task_leds_cfg->pin,
                                    p_task_leds_cfg->led_off);
                        break;
                        case EV_LED_XX_ON:
                            p_task_leds_dta->state = ST_LED_XX_ON;
                            HAL_GPIO_WritePin(
                                    p_task_leds_cfg->gpio_port,
                                    p_task_leds_cfg->pin,
                                    p_task_leds_cfg->led_on);
                        default:
                        break;
                    }
                }

                if (DEL_LED_XX_MIN == p_task_leds_dta->tick)
                {
                    p_task_leds_dta->state = ST_LED_XX_BLINK_ON;
                    p_task_leds_dta->tick = DEL_LED_XX_BLI;
                    HAL_GPIO_WritePin(
                            p_task_leds_cfg->gpio_port,
                            p_task_leds_cfg->pin,
                            p_task_leds_cfg->led_on);
                }

                if (DEL_LED_XX_MIN < p_task_leds_dta->tick)
                {
                    p_task_leds_dta->tick--;
                }
            break;

            case ST_LED_XX_PULSE:
                if (DEL_LED_XX_MIN == p_task_leds_dta->tick)
                {
                    p_task_leds_dta->state = ST_LED_XX_OFF;
                    HAL_GPIO_WritePin(
                            p_task_leds_cfg->gpio_port,
                            p_task_leds_cfg->pin,
                            p_task_leds_cfg->led_off);
                }

                if (DEL_LED_XX_MIN < p_task_leds_dta->tick)
                {
                    p_task_leds_dta->tick--;
                }
            break;

            default:
                p_task_leds_dta->tick  = DEL_LED_XX_MIN;
                p_task_leds_dta->state = ST_LED_XX_OFF;
                p_task_leds_dta->event = EV_LED_XX_OFF;
                p_task_leds_dta->flag = false;
            break;
        }
    }
}