//#define _TASK_TIMECRITICAL       // Enable monitoring scheduling overruns
//#define _TASK_SLEEP_ON_IDLE_RUN  // Enable 1 ms SLEEP_IDLE powerdowns between runs if no callback methods were invoked during the pass
// #define _TASK_STATUS_REQUEST     // Compile with support for StatusRequest functionality - triggering tasks on status change events in addition to time only
// #define _TASK_WDT_IDS            // Compile with support for wdt control points and task ids
// #define _TASK_LTS_POINTER        // Compile with support for local task storage pointer
// #define _TASK_PRIORITY           // Support for layered scheduling priority
#define _TASK_MICRO_RES          // Support for microsecond resolution
// #define _TASK_STD_FUNCTION       // Support for std::function (ESP8266 ONLY)
// #define _TASK_DEBUG              // Make all methods and variables public for debug purposes
// #define _TASK_INLINE             // Make all methods "inline" - needed to support some multi-tab, multi-file implementations
// #define _TASK_TIMEOUT            // Support for overall task timeout
// #define _TASK_OO_CALLBACKS       // Support for callbacks via inheritance
// #define _TASK_EXPOSE_CHAIN       // Methods to access tasks in the task chain
//#define _TASK_SCHEDULING_OPTIONS // Support for multiple scheduling options
// #define _TASK_DEFINE_MILLIS      // Force forward declaration of millis() and micros() "C" style
// #define _TASK_EXTERNAL_TIME      // Custom millis() and micros() methods
// #define _TASK_THREAD_SAFE        // Enable additional checking for thread safety
// #define _TASK_SELF_DESTRUCT      // Enable tasks to "self-destruct" after disable
// #define _TASK_TICKLESS           // Enable support for tickless sleep on FreeRTOS
// #define _TASK_DO_NOT_YIELD       // Disable yield() method in execute()

#include <EncButton.h>
#include <Blinker.h>
#include <TaskScheduler.h>


// Debug and Test options
#define _DEBUG_
//#define _TEST_

#ifdef _DEBUG_
#define _PP(a) Serial.print(a);
#define _PL(a) Serial.println(a);
#else
#define _PP(a)
#define _PL(a)
#endif


// Scheduler
Scheduler ts;

/*
   Approach 1: LED is driven by the boolean variable; false = OFF, true = ON
*/
#define _TASK_MICRO_RES
#include <TaskScheduler.h>

#define T1_INIT (25UL)

Scheduler runner;
// Callback methods prototypes
void t1Callback();
void t1OnDisable();
void t2Callback();


unsigned long t1_interval = T1_INIT;

// Tasks
Task t1(T1_INIT, 1, &t1Callback, &runner, true, NULL, &t1OnDisable);      //adding task to the chain on creation
Task t2(5 * TASK_SECOND, TASK_FOREVER, &t2Callback, &runner, true);  //adding task to the chain on creation



void t1Callback() {
  unsigned long t = micros();
  Serial.print("t1: ");
  Serial.println(t);
}

void t1OnDisable() {
  t1_interval += t1_interval; 
  if (t1_interval < T1_INIT) t1_interval = T1_INIT;
  t1.setInterval(t1_interval);
  t1.restartDelayed();
}

void t2Callback() {
  unsigned long t = micros();
  Serial.print("t2: ");
  Serial.print(t);
  Serial.println(" heartbeat");
}


void setup () {
  Serial.begin(115200);
  Serial.println("Scheduler TEST Microsecond Resolution");
  
  Serial.println("5 seconds delay");
  delay(5000);
   
  runner.startNow(); // This creates a new scheduling starting point for all ACTIVE tasks. 
                      // PLEASE NOTE - THIS METHOD DOES NOT ACTIVATE TASKS, JUST RESETS THE START TIME
  t1.delay();        // Tasks which need to start delayed, need to be delayed again after startNow();

// Alternatively, tasks should be just enabled at the bottom of setup() method
//  runner.enableAll();    
//  t1.delay();
}


void loop () {
  runner.execute();
}