// Obsluha LED signalizace
#include <Arduino.h>
#include "SigLed.h"

SigLED::SigLED(int pin, int ledon, int ledoff)
{

    _pin = pin;
    _ledon = ledon;
    _ledoff = ledoff;
}

void SigLED::rtLed(void)
{

    switch (_state) {
    case LS_RUN: {
        uint8_t instr;

        if (NULL != _signal)
            instr = *_ptr; // instrukce
        else if (NULL != _psignal)
            instr = pgm_read_byte(_pptr);
        else
            instr = LEDS_STOP;
        switch (instr & 0xc0) {
        case LEDS_ONFOR:
            digitalWrite(_pin, _ledon);
            _timer = 10ul * ((instr & 0x3F) + 1);
            _state = LS_WAIT;
            break;

        case LEDS_OFFFOR:
            digitalWrite(_pin, _ledoff);
            _timer = 10ul * ((instr & 0x3F) + 1);
            _state = LS_WAIT;
            break;

        case LEDS_STOP:
            _state = LS_IDLE;
            break;

        case LEDS_RESTART:
            _ptr = _signal;
            _pptr = _psignal;
            break;
        }
    }
    break;

    case LS_WAIT:
        --_timer;
        if (0 == _timer) {
            _state = LS_RUN;
            ++_ptr;
            ++_pptr;
        }
        break;

    default:
        break;
    }
}

void SigLED::begin(void)
{

    pinMode(_pin, OUTPUT);
    digitalWrite(_pin, _ledoff);
    _state = LS_IDLE;
    _handler.attach_ms(10, lh, this);
}

void SigLED::set(const uint8_t *signal)
{

    noInterrupts();
    _signal = signal;
    _ptr = _signal;
    _psignal = NULL;
    _state = LS_RUN;
    interrupts();
}

void SigLED::set(PGM_P signal)
{

    noInterrupts();
    _psignal = signal;
    _pptr = _psignal;
    _signal = NULL;
    _state = LS_RUN;
    interrupts();
}

void SigLED::start(void)
{

    noInterrupts();
    _ptr = _signal;
    _pptr = _psignal;
    _state = LS_RUN;
    interrupts();
}

void SigLED::lh(SigLED *ptr)
{

    SigLED *pled = ptr;
    pled->rtLed();
}