#include <Arduino_FreeRTOS.h>
#include <queue.h>

QueueHandle_t xQueue;

void setup() 
{
  Serial.begin(9600);
  xQueue = xQueueCreate( 5, sizeof( long ) );

  if( xQueue != NULL )
  {
    xTaskCreate( vSenderTask, "Sender1", 240, ( void * ) 100, 1, NULL );
    xTaskCreate( vSenderTask, "Sender2", 240, ( void * ) 200, 1, NULL );
    xTaskCreate( vReceiverTask, "Receiver", 240, NULL, 2, NULL );
    vTaskStartScheduler();
  }
  else
  {
    /* The queue could not be created. */
  }
}

void loop()
{
  // put your main code here, to run repeatedly:
}

void vSenderTask( void *pvParameters )
{
  long lValueToSend;
  lValueToSend = ( long ) pvParameters;

  for( ;; )
  {
    xQueueSend( xQueue, &lValueToSend, portMAX_DELAY );
    Serial.print( "Sent = ");
    Serial.println(lValueToSend);
    vTaskDelay(1000 / portTICK_PERIOD_MS); // Delay for 1 second
    taskYIELD();
  }
}

void vReceiverTask( void *pvParameters )
{
  long lReceivedValue;

  for( ;; )
  {
    if (xQueueReceive( xQueue, &lReceivedValue, portMAX_DELAY ) == pdPASS)
    {
      Serial.print( "Received = ");
      Serial.println(lReceivedValue);
      vTaskDelay(1000 / portTICK_PERIOD_MS); // Delay for 1 second
    }
    taskYIELD();
  }
}