meshx_msg_q.c

Go to the documentation of this file.

 
#include "interface/rtos/meshx_msg_q.h"
#include "freertos/FreeRTOS.h"
#include "freertos/queue.h"

meshx_err_t meshx_msg_q_create(meshx_msg_q_t *msg_q_handle)
{
    if (msg_q_handle == NULL)
    {
        return MESHX_INVALID_ARG;
    }
 
    // Create a FreeRTOS queue
    QueueHandle_t queue = xQueueCreate(msg_q_handle->max_msg_length, msg_q_handle->max_msg_depth);
 
    if (queue == NULL)
    {
        // Failed to create queue
        return MESHX_NO_MEM;
    }
 
    // Store the queue handle in the msg_q_handle
    msg_q_handle->__msg_q_handle = queue;
 
    return MESHX_SUCCESS;
}

meshx_err_t meshx_msg_q_delete(meshx_msg_q_t *msg_q_handle)
{
    if (msg_q_handle == NULL)
    {
        return MESHX_INVALID_ARG;
    }
 
    // Delete the FreeRTOS queue
    vQueueDelete((QueueHandle_t)msg_q_handle->__msg_q_handle);
 
    return MESHX_SUCCESS;
}

meshx_err_t meshx_msg_q_send(meshx_msg_q_t *msg_q_handle, void const *msg, size_t msg_len, uint32_t delay_ms)
{
    if (msg_q_handle == NULL || msg == NULL || msg_len == 0)
    {
        return MESHX_INVALID_ARG;
    }
 
    BaseType_t pxHigherPriorityTaskWoken = pdFALSE;
 
    BaseType_t ret =  xPortInIsrContext() ? xQueueSendFromISR(msg_q_handle->__msg_q_handle, msg, &pxHigherPriorityTaskWoken)
        : xQueueSend(msg_q_handle->__msg_q_handle, msg, pdMS_TO_TICKS(delay_ms));
 
    if (ret!= pdPASS)
    {
        return MESHX_FAIL;
    }
 
    return MESHX_SUCCESS;
}

meshx_err_t meshx_msg_q_send_front(meshx_msg_q_t *msg_q_handle, void const *msg, size_t msg_len, uint32_t delay_ms)
{
    if (msg_q_handle == NULL || msg == NULL || msg_len == 0)
    {
        return MESHX_INVALID_ARG;
    }
 
    BaseType_t pxHigherPriorityTaskWoken = pdFALSE;
 
    BaseType_t ret =  xPortInIsrContext() ? xQueueSendToFrontFromISR(msg_q_handle->__msg_q_handle, msg, &pxHigherPriorityTaskWoken)
        : xQueueSendToFront(msg_q_handle->__msg_q_handle, msg, pdMS_TO_TICKS(delay_ms));
 
    if (ret!= pdPASS)
    {
        return MESHX_FAIL;
    }
 
    return MESHX_SUCCESS;
}

meshx_err_t meshx_msg_q_recv(meshx_msg_q_t *msg_q_handle, void *msg, uint32_t delay_ms)
{
    if (msg_q_handle == NULL || msg == NULL)
    {
        return MESHX_INVALID_ARG;
    }
    BaseType_t pxHigherPriorityTaskWoken = pdFALSE;
 
    BaseType_t ret =  xPortInIsrContext() ? xQueueReceiveFromISR(msg_q_handle->__msg_q_handle, msg, &pxHigherPriorityTaskWoken)
        : xQueueReceive(msg_q_handle->__msg_q_handle, msg, pdMS_TO_TICKS(delay_ms));
 
    if (ret!= pdPASS)
    {
        return MESHX_FAIL;
    }
 
    return MESHX_SUCCESS;
}

meshx_err_t meshx_msg_q_peek(meshx_msg_q_t *msg_q_handle, void *msg, uint32_t delay_ms)
{
    if (msg_q_handle == NULL || msg == NULL)
    {
        return MESHX_INVALID_ARG;
    }
 
    BaseType_t ret =  xPortInIsrContext() ? xQueuePeekFromISR(msg_q_handle->__msg_q_handle, msg)
        : xQueuePeek(msg_q_handle->__msg_q_handle, msg, pdMS_TO_TICKS(delay_ms));
 
    if (ret!= pdPASS)
    {
        return MESHX_FAIL;
    }
 
    return MESHX_SUCCESS;
}