#include "pico/stdlib.h"
#include "pico/cyw43_arch.h"
#include "gctrl.h"
#include "als.h"

using namespace std;

GeneralControlModule GenCtrl;
AdvancedLoggingSystem ALS;

bool initError = false;
void SetGreen() {
    GenCtrl.SetStatusColour(0, 255, 0);  // Set LED green levels
}
void SetRed() {
    GenCtrl.SetStatusColour(255, 0, 0);  // Set LED red levels
}

void task1(std::string msg) {
std::cout << "task1 says: " << msg;
}


int main() {
  stdio_init_all();
  if(!initError && !GenCtrl.Initialize(4))  initError=true;
  if(!initError && !ALS.Initialize())       initError=true;

  if(initError) {
    GenCtrl.SetStatusColour(255, 0, 0);  // Set LED to red
    ALS.Log("An error has occurred. Please restart or try again later. Code: ", 0000);
  } else {

    std::thread t1(task1, "Hello");

    while (true) {
      sleep_ms(10);
    }
  }
}