#include <main.h>
#include <show.h>
#include <PontCoopScheduler.h>
#include <show.h>

#include <stdint.h>
#include <stdlib.h>

#include <stm32f103xb.h>


typedef struct {
    GPIO_TypeDef *port;
    uint16_t pin;
    signalAction_t currentState;
} showElement_t;

showElement_t showElement[] = {
    { .port = Debug_Signal_1_GPIO_Port, .pin = Debug_Signal_1_Pin, .currentState = OFF },
    { .port = Debug_Signal_2_GPIO_Port, .pin = Debug_Signal_2_Pin, .currentState = OFF },
    { .port = LED_Red_GPIO_Port, .pin = LED_Red_Pin, .currentState = OFF },
    { .port = LED_Green_GPIO_Port, .pin = LED_Green_Pin, .currentState = OFF },
    { .port = LED_Blue_GPIO_Port, .pin = LED_Blue_Pin, .currentState = OFF },
    { .port = NULL, .pin = 0, .currentState = OFF }
};

static void showHandler(void *handle) {
    const uint8_t MAX_CNT = 3;
    static uint8_t cnt = 0;
    cnt += 1;
    if (cnt > MAX_CNT) {
        cnt = 0;
    }

    uint8_t idx = 0;
    while (showElement[idx].port) {
        if (showElement[idx].currentState == BLINK) {
            if (cnt == MAX_CNT) {
                HAL_GPIO_TogglePin(showElement[idx].port, showElement[idx].pin);
            }
        } else if (showElement[idx].currentState == BLINK_FAST) {
            HAL_GPIO_TogglePin(showElement[idx].port, showElement[idx].pin);
        }
        idx++;
    }
}

void show(signalPin_t signalPin, signalAction_t action) {
    showElement[signalPin].currentState = action;
    if (action == ON || action == OFF) {
        HAL_GPIO_WritePin(showElement[signalPin].port, showElement[signalPin].pin, ((action == ON) ? GPIO_PIN_SET : GPIO_PIN_RESET));
    } else if (action == TOGGLE) {
        HAL_GPIO_TogglePin(showElement[signalPin].port, showElement[signalPin].pin);
    }
}

void showInit() {
    schAdd(showHandler, NULL, 0, 100);
}