#include <Arduino_FreeRTOS.h>
#include <Arduino.h>
#include <semphr.h>

// Task handles and semaphore
TaskHandle_t Task1Handle = NULL;
TaskHandle_t Task2Handle = NULL;
SemaphoreHandle_t xBinarySemaphore;

void Task1(void *pvParameters) {
  while (1) {
    if (xSemaphoreTake(xBinarySemaphore, portMAX_DELAY) == pdTRUE) {
      Serial.println("Task 1 is running and using serial");
      xSemaphoreGive(xBinarySemaphore);
    }
    vTaskDelay(10 / portTICK_PERIOD_MS);
  }
}

void Task2(void *pvParameters) {
  while (1) {
    if (xSemaphoreTake(xBinarySemaphore, portMAX_DELAY) == pdTRUE) {
      Serial.println("Task 2 is running and using serial");
      xSemaphoreGive(xBinarySemaphore);
    }
    vTaskDelay(10 / portTICK_PERIOD_MS);
  }
}

void setup() {
  Serial.begin(9600);
  while (!Serial) {
    ; // Wait for serial port to connect
  }
  Serial.println("Setup complete");

  // Create binary semaphore
  xBinarySemaphore = xSemaphoreCreateBinary();
  if (xBinarySemaphore == NULL) {
    Serial.println("Failed to create binary semaphore!");
    return;
  }
  xSemaphoreGive(xBinarySemaphore);  // Initialize the semaphore as available
  
  // Create tasks
  if (xTaskCreate(Task1, "Task 1", 128, NULL, 1, &Task1Handle) != pdPASS) {
    Serial.println("Task 1 creation failed!");
  }
  if (xTaskCreate(Task2, "Task 2", 128, NULL, 1, &Task2Handle) != pdPASS) {
    Serial.println("Task 2 creation failed!");
  }
}

void loop() {
  // Nothing here
}