#include "ArduinoTrace.h"
#include "ptScheduler.h"
#include "ezButton.h"

#include "Led.h"
#include "Button.h"

ptScheduler TasksSch=ptScheduler(1000000);
ezButton button0(2);
ezButton button1(3);

bool btn0Psd,btn1Psd;

Led led1(4);
Led led2(6);
Button buttonI0(2);

void setup() {
  // put your setup code here, to run once:
  Serial.begin(9600);
  button0.setDebounceTime(50);
  button1.setDebounceTime(50);
  pinMode(4, OUTPUT);
  pinMode(6, OUTPUT);
  pinMode(8, OUTPUT);
  pinMode(10, OUTPUT);
  pinMode(11, OUTPUT);
}

// void loop()
// {
//   static int i=0;
//   digitalWrite(6,HIGH);
 
//   digitalWrite(4,HIGH);
//   delay(100);
//   digitalWrite(4,LOW);
//   delay(100);  

//   i++;
//   if(i==10)
//   {
//     digitalWrite(6,LOW);   
//     BREAK(); 
//   }  
// }

void loop() {
  // put your main code here, to run repeatedly:

  static int i=0;
  digitalWrite(8,HIGH);

  button0.loop();
  button1.loop();
  if(button0.isPressed()) btn0Psd=true;
  if(button1.isPressed()) btn1Psd=true;
  if(TasksSch.call())
  {
    //DUMP(millis());
    buttonI0.handle(led1,led2);
    led1.seq();
    led2.seq();
    btn0Psd=false;
    //DUMP(millis());
    

  i++;
  if(i==20)
  {
    digitalWrite(8,LOW);   
    BREAK(); 
  } 

  digitalWrite(10,led1.I0);
  digitalWrite(11,led1.I1);
  
  }
}

void FunctionCalls()
{

}

void prnMsg(String msg)
{
  Serial.print(msg);
}