112 lines
1.9 KiB
C++
112 lines
1.9 KiB
C++
// 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();
|
|
}
|