#include "leds.h"

void processLEDState()
{
	static uint16_t LEDArmedBlinkCount, LEDErrorBlinkCount;

	if (LEDState != LED_ARMED) LEDArmedBlinkCount = 0;
	if (LEDState != LED_ERROR) LEDErrorBlinkCount = 0;

	switch (LEDState) {
		case LED_OFF:
			greenLEDOff();
			redLEDOn();

			break;
		case LED_ARMED:
			LEDArmedBlinkCount++;

			if (LEDArmedBlinkCount < LED_ARMED_BLINK_TIME) {
				greenLEDOn();
				redLEDOn();
			} else if (LEDArmedBlinkCount < LED_ARMED_BLINK_TIME * 2) {
				greenLEDOff();
				redLEDOn();
			} else {
				LEDArmedBlinkCount = 0;
			}
			break;
		case LED_ON:
			greenLEDOn();
			redLEDOn();

			break;
		case LED_ERROR:
			LEDErrorBlinkCount++;

			if (LEDErrorBlinkCount < LED_ERROR_BLINK_TIME) {
				greenLEDOff();
				redLEDOff();
			} else if (LEDErrorBlinkCount < LED_ERROR_BLINK_TIME * 2) {
				greenLEDOff();
				redLEDOn();
			} else {
				LEDErrorBlinkCount = 0;
				LEDState = LED_OFF;
			}
			break;
		default:
			if (SERIAL_LOGGING) Serial.println("[ERROR] Invalid LED state.");
			LEDState = LED_OFF;
			break;
	}
}