#if CONFIG_FREERTOS_UNICORE
static const BaseType_t app_cpu = 0;
#else
static const BaseType_t app_cpu = 1;
#endif

// Some string to print.
const char msg[] = "I have been to Denmark. ";

// Task handles.
static TaskHandle_t task_1 = NULL;
static TaskHandle_t task_2 = NULL;

// Tasks

// Task: print to serial terminal with lower priority.
void task1(void* parameter) {
  int len = strlen(msg);

  while (1) {
    Serial.println();
    for (int i = 0; i < len; i++) {
      Serial.print(msg[i]);
    }
    Serial.println();
    vTaskDelay(1000 / portTICK_PERIOD_MS);
  }
}

// Task: print to serial terminal with higher priority.
void task2(void* parameter) {
  while(1) {
    Serial.print('*');
    vTaskDelay(100 / portTICK_PERIOD_MS);
  }
}

void setup() {
  // put your setup code here, to run once:

  // Configure Serial (go slow so we can watch the preemption)
  Serial.begin(300);

  // Wait a moment to start (so we don't miss Serial output)
  vTaskDelay(1000 / portTICK_PERIOD_MS);
  Serial.println();
  Serial.print("---FreeRTOS Task Demo---");

  // Print self priority.
  Serial.print("Setup and loop task running on core. ");
  Serial.print(xPortGetCoreID());
  Serial.print("with priority: ");
  Serial.println(uxTaskPriorityGet(NULL));

  // Task to run forever.
  xTaskCreatePinnedToCore(
    task1,
    "Task 1",
    1024,
    NULL,
    1,
    &task_1,
    app_cpu);

  // Task to run once with higher priority.
  xTaskCreatePinnedToCore(
    task2,
    "Task 2",
    1024,
    NULL,
    2,
    &task_2,
    app_cpu);


}

void loop() {
  // put your main code here, to run repeatedly:
  
  // Suspend the higher priority task for some intervals.
  for (int i = 0; i < 3; i++) {
    vTaskSuspend(task_2);
    vTaskDelay(2000 / portTICK_PERIOD_MS);
    vTaskResume(task_2);
    vTaskDelay(2000 / portTICK_PERIOD_MS);
  }

  // Delete the lower priority task.
  if (task_1 != NULL) {
    vTaskDelete(task_1);
    task_1 = NULL;
  }
}