/*******************************************************************************
   THIS SOFTWARE IS PROVIDED IN AN "AS IS" CONDITION. NO WARRANTY AND SUPPORT
   IS APPLICABLE TO THIS SOFTWARE IN ANY FORM. CYTRON TECHNOLOGIES SHALL NOT,
   IN ANY CIRCUMSTANCES, BE LIABLE FOR SPECIAL, INCIDENTAL OR CONSEQUENTIAL
   DAMAGES, FOR ANY REASON WHATSOEVER.
 ********************************************************************************
   DESCRIPTION:
   The code controls the front and the rear lights in the hull of the tank. The front lights are
   white LEDs, and the rear lights are red LEDs. The LEDs are separately controlled by 
   two Arduino digital outputs (A2, A7) switching on the CTRL supply (+5V) via the ULN2001AN to the 
   LEDs. The different states for the lights are: OFF, ON, BLINK. The OFF and ON can be done separately 
   for the front- and rear lights. The blinking function has the front and rear lights operating simultaneously.
   The blinking should not interrupt the rest of the loop and is taken into a threading function. 

   CONNECTIONS (Arduino nano v3 - Atmega328P, old bootloader):

   Arduino A2   - Front lights (white)
   Arduino A7   - Rear lights (red)
 *******************************************************************************/

#include <Arduino.h>
#include <Thread.h>

// Define pins
const int frontLightPin = A2;     // Front LEDs connected on A2
const int rearLightPin = A7;      // Rear LEDs connected on A7

// Parameters
Thread blinkThread;               // Create a thread for blinking
//bool blinkCmd = false;            // Variable to control blinking

// Define states for the Light FSM
enum LightState {
  ON,
  OFF,
  BLINKING
};

void setup_Light_ctrl() {
  // Initialization of Light_ctrl 

  // pinout light control
  pinMode(frontLightPin, OUTPUT);   // Set the LED pin as an output
  pinMode(rearLightPin, OUTPUT);    // Set the LED pin as an output

  // Set initial state for the lights
  LightState currentState = OFF; // Initial state is OFF

  // Start blink/light thread
  blinkThread.start(light_ctrl); // Start the thread for light control
}


// Function to control the lights based on states
void light_ctrl() {
  while (true) {
    switch (currentState) {
      case ON:
        digitalWrite(frontLightPin, HIGH);   // Turn on Front lights
        digitalWrite(rearLightPin, HIGH);    // Turn on Rear lights
        break;

      case OFF:
        digitalWrite(frontLightPin, LOW);   // Turn on Front lights
        digitalWrite(rearLightPin, LOW);    // Turn on Rear lights
        break;

      case BLINKING:
        digitalWrite(frontLightPin, HIGH);   // Turn on Front lights
        digitalWrite(rearLightPin, HIGH);    // Turn on Rear lights
        delay(500); // Wait for 0.5 seconds
        digitalWrite(frontLightPin, LOW);   // Turn on Front lights
        digitalWrite(rearLightPin, LOW);    // Turn on Rear lights
        delay(500); // Wait for 0.5 seconds
        break;
    }
  }
}

/*******************************************************************************
   THIS SOFTWARE IS PROVIDED IN AN "AS IS" CONDITION. NO WARRANTY AND SUPPORT
   IS APPLICABLE TO THIS SOFTWARE IN ANY FORM. CYTRON TECHNOLOGIES SHALL NOT,
   IN ANY CIRCUMSTANCES, BE LIABLE FOR SPECIAL, INCIDENTAL OR CONSEQUENTIAL
   DAMAGES, FOR ANY REASON WHATSOEVER.
 ********************************************************************************
   DESCRIPTION:
   This is the test code for testing the light control function.
   The function shows how to set up light control and use the functions for 
   turning separately the front and rear lights On/OFF. And the blinking function. 
   

   CONNECTIONS (Arduino nano v3 - Atmega328P, old bootloader):
 *******************************************************************************/

// Keyboard WASD movement for track control
#define LIGHTS_ON '1'
#define LIGHTS_BLINK '2'
#define LIGHTS_OFF '0'

// Initialisation
void setup() {
  Serial.begin(9600);

  setup_Light_ctrl();             // Setting up light control 
}

void loop() {
  char byte = 0;
  // press q to cancel and exit
  while (byte != 'z') {
    Serial.readBytes(&byte, 1);

    // LIGHT CONTROL VIA KEYBOARD CONTROL  
    // -----------------------------------
    // press 1 for Lights On
    if (byte == LIGHTS_ON) {
      //Set Light On
      Serial.print("Front & rear - Light On \n");
      currentState = ON;
    }

    // press 2 for Lights Blinking
    if (byte == LIGHTS_BLINK) {
      //Set Light Blinking
      Serial.print("Front & rear - Light Blinking \n");
      currentState = BLINKING;
    }

    // press 0 Lights Off
    if (byte == LIGHTS_OFF) {
      //Set Light Off
      Serial.print("Front & rear - Light Off \n");
      currentState = OFF;
    }

  }
  Serial.print("Done \n");
  Serial.end();
}

#include <Arduino.h>
#include <Thread.h>

const int ledPin = 13; // Define the LED pin

Thread blinkThread; // Create a thread for blinking
bool blinkCmd = false; // Variable to control blinking

void blink() {
  while (true) {
    if (blinkCmd) {
      digitalWrite(ledPin, HIGH); // Turn on the LED
      delay(500); // Wait for 0.5 seconds
      digitalWrite(ledPin, LOW); // Turn off the LED
      delay(500); // Wait for 0.5 seconds
    }
  }
}

void setup() {
  pinMode(ledPin, OUTPUT); // Set the LED pin as an output

  blinkThread.start(blink); // Start the blink thread
}

void loop() {
  // Your code here

  // Set blinkCmd to true or false based on your conditions
  // For example, to enable blinking:
  blinkCmd = true;

  // To disable blinking:
  // blinkCmd = false;

  // Other code that does not affect blinking
}

#include <Thread.h>
#include <ThreadController.h>

// ThreadController that will controll all threads
ThreadController controll = ThreadController();

//My Thread (as a pointer)
Thread* myThread = new Thread();
//His Thread (not pointer)
Thread hisThread = Thread();

// callback for myThread
void niceCallback(){
	Serial.print("COOL! I'm running on: ");
	Serial.println(millis());
}

// callback for hisThread
void boringCallback(){
	Serial.println("BORING...");
}

void setup(){
	Serial.begin(9600);

	// Configure myThread
	myThread->onRun(niceCallback);
	myThread->setInterval(500);

	// Configure myThread
	hisThread.onRun(boringCallback);
	hisThread.setInterval(250);

	// Adds both threads to the controller
	controll.add(myThread);
	controll.add(&hisThread); // & to pass the pointer to it
}

void loop(){
	// run ThreadController
	// this will check every thread inside ThreadController,
	// if it should run. If yes, he will run it;
	controll.run();

	// Rest of code
	float h = 3.1415;
	h/=2;
}