meshx_utils.c

Go to the documentation of this file.

 
#include "interface/rtos/meshx_rtos_utils.h"
#include "interface/logging/meshx_log.h"
#include "freertos/FreeRTOS.h"
#include "freertos/task.h"
#include "freertos/portmacro.h"
#include <string.h>

meshx_err_t meshx_rtos_get_sys_time(unsigned int *millis)
{
    if(xPortInIsrContext() == pdFALSE)
    {
        *millis = xTaskGetTickCount() * (1000 / configTICK_RATE_HZ);
    }
    else
    {
        *millis = xTaskGetTickCountFromISR() * (1000 / configTICK_RATE_HZ);
    }
    return MESHX_SUCCESS;
}

meshx_err_t meshx_rtos_malloc(void **ptr, size_t size)
{
    if (!ptr || size == 0)
    {
        return MESHX_INVALID_ARG; // Invalid input
    }
 
    *ptr = pvPortMalloc(size);
    if (*ptr == NULL)
    {
        return MESHX_NO_MEM; // Memory allocation failed
    }
 
    return MESHX_SUCCESS;
}

meshx_err_t meshx_rtos_calloc(void **ptr, size_t num, size_t size)
{
    if (!ptr || num == 0 || size == 0)
    {
        return MESHX_INVALID_ARG; // Invalid input
    }
 
    *ptr = pvPortMalloc(size);
    if (*ptr == NULL)
    {
        return MESHX_NO_MEM; // Memory allocation failed
    }
 
    memset(*ptr, 0, num * size); // Initialize allocated memory to zero
 
    return MESHX_SUCCESS;
}

meshx_err_t meshx_rtos_free(void **ptr)
{
    if (ptr && *ptr)
    {                    // Ensure pointer is valid
        vPortFree(*ptr); // Free the actual allocated memory
        *ptr = NULL;     // Set pointer to NULL to avoid dangling reference
    }
    MESHX_LOGD(MODULE_ID_COMMON, "ESP Heap available: %d", meshx_rtos_get_free_heap());
    return MESHX_SUCCESS;
}

size_t meshx_rtos_get_free_heap(void)
{
    return xPortGetFreeHeapSize();
}

meshx_err_t meshx_rtos_get_curr_task_id_prio(unsigned int *task_id)
{
 
#ifdef configUSE_TRACE_FACILITY
    TaskStatus_t xTaskDetails;
    vTaskGetInfo(NULL, &xTaskDetails, pdTRUE, eInvalid);
    *task_id = xTaskDetails.xTaskNumber << 8 | xTaskDetails.uxCurrentPriority;
#else
    *task_id = 0x5A;    /* Dummy Task ID*/
#endif
    return MESHX_SUCCESS;
 
}