#include <Arduino_FreeRTOS.h>
#include"semphr.h"
#define LED 7    
#define LED 8  
static const char *pcStringToPrint[] =
{
  "Task 1 ############################## Task1 \r\n",
  "Task 2 ------------------------------ Task2 \r\n",
  "TICK HOOK&&&&&&&&&&&&&&&&&&&&&&&&&&&& TICK HOOK \r\n"
  
};

QueueHandle_t xPrintQueue;
void setup()
{
   Serial.begin(9600);
  xPrintQueue = xQueueCreate(5,sizeof(char *));
   pinMode(LED, OUTPUT);
   pinMode(LED2, OUTPUT);
  xTaskCreate(OutputTask,"Printer 1", 100,(void *)0,3,NULL );
  xTaskCreate(OutputTask,"Printer 2", 100,(void *)2,2,NULL );
  xTaskCreate(OutputTask,"Printer 2", 100,(void *)1,1,NULL );
  xTaskCreate(GateKeeperTask, "GateKeeper", 100,NULL,0,NULL);
  
}
void OutputTask(void *pvParameters)
{
  int indexToString ;
  indexToString = (int)pvParameters;

  while(1)
  {
   xQueueSend(xPrintQueue,&(pcStringToPrint[indexToString]),portMAX_DELAY); 
   vTaskDelay(pdMS_TO_TICKS(1000));

  }
  
}

void GateKeeperTask(void *pvParameters)
{
  char *pcMessageToPrint;
  while(1)
  {
   xQueueReceive(xPrintQueue,&pcMessageToPrint,portMAX_DELAY);
  
   Serial.println(pcMessageToPrint); 
   digitalWrite(LED,!digitalRead(LED));
   digitalWrite(LED2,!digitalRead(LED2));
   }
}

//void vApplicationTickHook(void)
//{
//  static int counter =0;
//  counter++;
//  if(counter >=200)
//  {
//    xQueueSendToFrontFromISR(xPrintQueue,&(pcStringToPrint[2]),NULL);
//    counter =0;
//  }
//}

void loop(){}