//Multithreading(Multi Core)
//Time-division multiplexing (One Core) : Arduino uno


#include <pt.h>
#define LED_1_PIN 9
#define LED_2_PIN 10
#define LED_3_PIN 11
#define LED_4_PIN 12
#define BUTTON_PIN 2



// Declare 3 protothreads
static struct pt pt1, pt2, pt3, pt4, pt5;
// In setup, set all LEDs as OUTPUT, push button as INPUT, and
// init all protothreads
void setup() {
  pinMode(LED_1_PIN, OUTPUT);
  pinMode(LED_2_PIN, OUTPUT);
  pinMode(LED_3_PIN, OUTPUT);
  pinMode(LED_4_PIN, OUTPUT);
  pinMode(BUTTON_PIN, INPUT);
  pinMode(A0,INPUT);
  PT_INIT(&pt1);
  PT_INIT(&pt2);
  PT_INIT(&pt3);
  PT_INIT(&pt4);
  PT_INIT(&pt5);

  Serial.begin(9600);
}
// In the loop we just need to call the protothreads one by one
void loop() {
  protothreadBlinkLED1(&pt1);
  protothreadBlinkLED2(&pt2);
  protothreadPushButton(&pt3);
  protothreadPotentiometer(&pt4);
  protothreadPotenLED(&pt5);

}

// First protothread function to blink LED 1 every 1 second
static int protothreadBlinkLED1(struct pt *pt)
{
  static unsigned long lastTimeBlink = 0;
  PT_BEGIN(pt);
  while(1) {
  lastTimeBlink = millis();
  PT_WAIT_UNTIL(pt, millis() - lastTimeBlink > 1000);
  digitalWrite(LED_1_PIN, HIGH);
  lastTimeBlink = millis();
  PT_WAIT_UNTIL(pt, millis() - lastTimeBlink > 1000);
  digitalWrite(LED_1_PIN, LOW);
  }
  PT_END(pt);
}
// Second protothread function to blink LED 2 every 0.5 second
static int protothreadBlinkLED2(struct pt *pt)
{
  static unsigned long lastTimeBlink = 0;
  PT_BEGIN(pt);
  while(1) {
  lastTimeBlink = millis();
  PT_WAIT_UNTIL(pt, millis() - lastTimeBlink > 500);
  digitalWrite(LED_2_PIN, HIGH);
  lastTimeBlink = millis();
  PT_WAIT_UNTIL(pt, millis() - lastTimeBlink > 500);
  digitalWrite(LED_2_PIN, LOW);
  }
  PT_END(pt);
}
// Third protothread function to power on LED 3 if
// the push button is pressed.
static int protothreadPushButton(struct pt *pt)
{
  static unsigned long lastTimeCheck = 0;
  PT_BEGIN(pt);
  while (1) {
  lastTimeCheck = millis();
  PT_WAIT_UNTIL(pt, digitalRead(BUTTON_PIN) == HIGH);
  digitalWrite(LED_3_PIN, HIGH);
  PT_WAIT_UNTIL(pt, digitalRead(BUTTON_PIN) == LOW);
  digitalWrite(LED_3_PIN, LOW);
  }
  PT_END(pt);
}

static int protothreadPotentiometer(struct pt *pt)
{
  static unsigned long lastTimeTurn = 0;
  PT_BEGIN(pt);
    while(1) {

    lastTimeTurn = millis();
    PT_WAIT_UNTIL(pt, millis() - lastTimeTurn > 2000);

    Serial.println(analogRead(A0));
    }
    PT_END(pt);
}

static int protothreadPotenLED (struct pt *pt)
{
  static unsigned long lastTimeTurn = 0;
  PT_BEGIN(pt);
    while(1) {

    lastTimeTurn = millis();
    PT_WAIT_UNTIL(pt, analogRead(A0) > 512);
    digitalWrite(LED_4_PIN, HIGH);

    PT_WAIT_UNTIL(pt, analogRead(A0) <= 512);
    digitalWrite(LED_4_PIN, LOW);
    Serial.println(analogRead(A0));

    }
    PT_END(pt);
}