#include "LedController.h"
#include "Timer.h"

LedController leds;

void setup() {
  // put your setup code here, to run once:
  Serial.begin(9600);
  Serial.println("Startup");

 leds.init();
 leds.showWarning();

}

void loop() {
  // put your main code here, to run repeatedly:
  leds.check();
  delay(1000);
}


sketch.ino

diagram.json

#ifndef LedController_h
#define LedController_h
#include <Arduino.h>
#include "Led.h"
#include "Timer.h"

class LedController {
public:
  LedController();
  void init();
  void check();
  void showError();
  void showOk();
  void showWarning();
  
  
private:
  Led _red;
  Led _blue;
  Led _yellow;
  Led _green;
};


#endif

LedController.h

#include <Arduino.h>
#include "LedController.h"
#include "Led.h"
#include "Timer.h"

LedController::LedController(){}

void LedController::init() {
  _red=Led(11);
  _blue=Led(10);
  _yellow=Led(9);
  _green=Led(8);
}

void LedController::showWarning() {
  Serial.println("Activate yellow");
  _yellow.activate();
}

void LedController::showError() {
  _red.activate();
}

void LedController::showOk() {
  _green.activate();
}

void LedController::check() {
  Serial.print("Current time: ");
  Serial.println(Timer::getTime(),DEC);

  Serial.println("Check red");
  _red.check();

  Serial.println("Check blue");
  _blue.check();

  Serial.println("Check yellow");
  _yellow.check();

  Serial.println("Check green");
  _green.check();
}




LedController.cpp

#ifndef Timer_h
#define Timer_h
#include <Arduino.h>

class Timer {
public:
  static void addOffset(unsigned long);
  static void init();
  static unsigned long getTime();
private:
  inline static unsigned long _offset;
};


#endif

Timer.h

#include "Arduino.h"
#include "Timer.h"

unsigned long _offset=0;

void Timer::addOffset(unsigned long _offset) {
  Timer::_offset+=_offset;
  //Serial.println("new offset:");
  //Serial.println(Timer::_offset, DEC);
}

unsigned long Timer::getTime() {
  return millis()+Timer::_offset;
}




Timer.cpp

#ifndef Led_h
#define Led_h
#include <Arduino.h>


class Led {
  public:
    Led();
    Led(int pin);
    void activate();
    void deactivate();
    void check();
    int _pin;
  private:
    
    void _turnOn();
    void _turnOff();
};


#endif

Led.h

#include "Print.h"
#include <Arduino.h>
#include "Led.h"
#include "Timer.h"

boolean _active=false;
boolean _isOn=false;
int _pin;
unsigned long _toggleAt=0;
unsigned long _intervall = 5000;
unsigned long _shineDuration = 50;

Led::Led() {}

Led::Led(int pin) {
  _pin=pin;

  pinMode(_pin, OUTPUT);  //initialize the digital pin as an output
  digitalWrite(_pin, LOW);

  Serial.println("Init");
  Serial.println(_pin, DEC);

}

void Led::activate(){
  if(_active){
    return;
  }
  _active=true;
  _turnOn();
}

void Led::deactivate(){
  if(!_active){
    return;
  }
  _active=false;
  _turnOff();
}

void Led::_turnOn(){
  digitalWrite(_pin, HIGH);
  _toggleAt=Timer::getTime()+_shineDuration;
  _isOn=true;

  Serial.print("Toggle to OFF at ");
  Serial.println(_toggleAt, DEC);
}

void Led::_turnOff(){
  digitalWrite(_pin, LOW);
  _toggleAt=Timer::getTime()+_intervall;
  _isOn=false;

  Serial.print("Toggle to ON at ");
  Serial.println(_toggleAt, DEC);
}

void Led::check(){
  if(!_active || _toggleAt>Timer::getTime()){
    return;
  }
  if(_isOn){
    _turnOff();
  }else{
    _turnOn();
  }
}



