wen/luban-lite-t3e-pro
1
0
Fork 0
mirror of https://gitee.com/Vancouver2017/luban-lite-t3e-pro.git synced 2025-12-13 18:08:54 +00:00
Code Issues Packages Projects Releases Wiki Activity
Files
dc2329642527c95df7181810bd50ffb0f391323f
luban-lite-t3e-pro/packages/third-party/FreeRTOS-Wrapper/FreeRTOS/queue.c
wen 9ff0846ba3 first commit
2025-09-30 11:56:06 +08:00

817 lines
27 KiB
C
Raw Blame History

/*
* FreeRTOS Kernel V10.4.6
* Copyright (C) 2021 Amazon.com, Inc. or its affiliates. All Rights Reserved.
*
* SPDX-License-Identifier: MIT
*
* Permission is hereby granted, free of charge, to any person obtaining a copy of
* this software and associated documentation files (the "Software"), to deal in
* the Software without restriction, including without limitation the rights to
* use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies of
* the Software, and to permit persons to whom the Software is furnished to do so,
* subject to the following conditions:
*
* The above copyright notice and this permission notice shall be included in all
* copies or substantial portions of the Software.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS
* FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR
* COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER
* IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
* CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
*
* https://www.FreeRTOS.org
* https://github.com/FreeRTOS
*
*/
#include <stdlib.h>
#include <string.h>
#include "FreeRTOS.h"
#include "queue.h"
/* Semaphores do not actually store or copy data, so have an item size of
* zero. */
#define queueSEMAPHORE_QUEUE_ITEM_LENGTH ( ( UBaseType_t ) 0 )
#define queueMUTEX_GIVE_BLOCK_TIME ( ( TickType_t ) 0U )
typedef struct QueueDefinition
{
struct rt_ipc_object *rt_ipc;
} xQUEUE;
typedef xQUEUE Queue_t;
static volatile rt_uint8_t mutex_index = 0;
static volatile rt_uint8_t sem_index = 0;
static volatile rt_uint8_t queue_index = 0;
/*-----------------------------------------------------------*/
BaseType_t xQueueGenericReset( QueueHandle_t xQueue,
BaseType_t xNewQueue )
{
Queue_t * const pxQueue = xQueue;
struct rt_ipc_object *pipc;
rt_uint8_t type;
configASSERT( pxQueue );
pipc = pxQueue->rt_ipc;
RT_ASSERT( pipc != RT_NULL );
type = rt_object_get_type( &pipc->parent );
if ( type == RT_Object_Class_Semaphore )
{
rt_sem_control( ( rt_sem_t ) pipc, RT_IPC_CMD_RESET, ( void * ) 0);
}
else if ( type == RT_Object_Class_MessageQueue )
{
rt_mq_control( ( rt_mq_t ) pipc, RT_IPC_CMD_RESET, RT_NULL );
}
return pdPASS;
}
/*-----------------------------------------------------------*/
#if ( configSUPPORT_STATIC_ALLOCATION == 1 )
QueueHandle_t xQueueGenericCreateStatic( const UBaseType_t uxQueueLength,
const UBaseType_t uxItemSize,
uint8_t * pucQueueStorage,
StaticQueue_t * pxStaticQueue,
const uint8_t ucQueueType )
{
Queue_t * pxNewQueue = NULL;
char name[RT_NAME_MAX] = {0};
/* The StaticQueue_t structure and the queue storage area must be
* supplied. */
configASSERT( pxStaticQueue );
if( ( uxQueueLength > ( UBaseType_t ) 0 ) &&
( pxStaticQueue != NULL ) &&
/* A queue storage area should be provided if the item size is not 0, and
* should not be provided if the item size is 0. */
( !( ( pucQueueStorage != NULL ) && ( uxItemSize == 0 ) ) ) &&
( !( ( pucQueueStorage == NULL ) && ( uxItemSize != 0 ) ) ) )
{
if ( ucQueueType == queueQUEUE_TYPE_RECURSIVE_MUTEX || ucQueueType == queueQUEUE_TYPE_MUTEX )
{
rt_snprintf( name, RT_NAME_MAX, "mutex%02d", mutex_index++ );
rt_mutex_init( ( rt_mutex_t ) &( ( StaticSemaphore_t * ) pxStaticQueue )->ipc_obj.mutex, name, RT_IPC_FLAG_PRIO );
}
else if ( ucQueueType == queueQUEUE_TYPE_BINARY_SEMAPHORE || ucQueueType == queueQUEUE_TYPE_COUNTING_SEMAPHORE )
{
rt_snprintf( name, RT_NAME_MAX, "sem%02d", sem_index++ );
rt_sem_init( ( rt_sem_t ) &( ( StaticSemaphore_t * ) pxStaticQueue )->ipc_obj.semaphore, name, 0, RT_IPC_FLAG_PRIO );
( ( StaticSemaphore_t * ) pxStaticQueue )->ipc_obj.semaphore.max_value = uxQueueLength;
}
else if ( ucQueueType == queueQUEUE_TYPE_BASE )
{
rt_snprintf( name, RT_NAME_MAX, "queue%02d", queue_index++ );
rt_mq_init( &( pxStaticQueue->ipc_obj ), name, pucQueueStorage, uxItemSize, QUEUE_BUFFER_SIZE( uxQueueLength, uxItemSize ), RT_IPC_FLAG_PRIO );
}
else
{
return pxNewQueue;
}
pxStaticQueue->rt_ipc = ( struct rt_ipc_object * ) &pxStaticQueue->ipc_obj;
pxNewQueue = ( QueueHandle_t ) pxStaticQueue;
}
return pxNewQueue;
}
#endif /* configSUPPORT_STATIC_ALLOCATION */
/*-----------------------------------------------------------*/
#if ( configSUPPORT_DYNAMIC_ALLOCATION == 1 )
QueueHandle_t xQueueGenericCreate( const UBaseType_t uxQueueLength,
const UBaseType_t uxItemSize,
const uint8_t ucQueueType )
{
Queue_t * pxNewQueue = NULL;
char name[RT_NAME_MAX] = {0};
struct rt_ipc_object * pipc = RT_NULL;
if( ( uxQueueLength > ( UBaseType_t ) 0 ) &&
/* Check for multiplication overflow. */
( ( SIZE_MAX / uxQueueLength ) >= uxItemSize ) &&
/* Check for addition overflow. */
( ( SIZE_MAX - sizeof( Queue_t ) ) >= ( uxQueueLength * uxItemSize ) ) )
{
pxNewQueue = ( Queue_t * ) RT_KERNEL_MALLOC( sizeof( Queue_t ) );
if ( pxNewQueue == NULL )
{
return ( QueueHandle_t ) pxNewQueue;
}
if ( ucQueueType == queueQUEUE_TYPE_RECURSIVE_MUTEX || ucQueueType == queueQUEUE_TYPE_MUTEX )
{
rt_snprintf( name, RT_NAME_MAX, "mutex%02d", mutex_index++ );
pipc = ( struct rt_ipc_object * ) rt_mutex_create( name, RT_IPC_FLAG_PRIO );
}
else if ( ucQueueType == queueQUEUE_TYPE_BINARY_SEMAPHORE || ucQueueType == queueQUEUE_TYPE_COUNTING_SEMAPHORE )
{
rt_snprintf( name, RT_NAME_MAX, "sem%02d", sem_index++ );
pipc = ( struct rt_ipc_object * ) RT_KERNEL_MALLOC( sizeof( struct rt_semaphore_wrapper ) );
if ( pipc != RT_NULL )
{
rt_sem_init( ( rt_sem_t ) pipc, name, 0, RT_IPC_FLAG_PRIO );
( ( struct rt_semaphore_wrapper * ) pipc )->max_value = uxQueueLength;
/* Mark as dynamic so we can distinguish in vQueueDelete */
pipc->parent.type &= ~RT_Object_Class_Static;
}
}
else if ( ucQueueType == queueQUEUE_TYPE_BASE )
{
rt_snprintf( name, RT_NAME_MAX, "queue%02d", queue_index++ );
pipc = ( struct rt_ipc_object * ) rt_mq_create( name, uxItemSize, uxQueueLength, RT_IPC_FLAG_PRIO);
}
if ( pipc == RT_NULL )
{
RT_KERNEL_FREE( pxNewQueue );
return NULL;
}
pxNewQueue->rt_ipc = pipc;
}
return ( QueueHandle_t ) pxNewQueue;
}
#endif /* configSUPPORT_STATIC_ALLOCATION */
/*-----------------------------------------------------------*/
#if ( ( configUSE_MUTEXES == 1 ) && ( configSUPPORT_DYNAMIC_ALLOCATION == 1 ) )
QueueHandle_t xQueueCreateMutex( const uint8_t ucQueueType )
{
QueueHandle_t xNewQueue;
const UBaseType_t uxMutexLength = ( UBaseType_t ) 1, uxMutexSize = ( UBaseType_t ) 0;
xNewQueue = xQueueGenericCreate( uxMutexLength, uxMutexSize, ucQueueType );
return xNewQueue;
}
#endif /* configUSE_MUTEXES */
/*-----------------------------------------------------------*/
#if ( ( configUSE_MUTEXES == 1 ) && ( configSUPPORT_STATIC_ALLOCATION == 1 ) )
QueueHandle_t xQueueCreateMutexStatic( const uint8_t ucQueueType,
StaticQueue_t * pxStaticQueue )
{
QueueHandle_t xNewQueue;
const UBaseType_t uxMutexLength = ( UBaseType_t ) 1, uxMutexSize = ( UBaseType_t ) 0;
xNewQueue = xQueueGenericCreateStatic( uxMutexLength, uxMutexSize, NULL, pxStaticQueue, ucQueueType );
return xNewQueue;
}
#endif /* configUSE_MUTEXES */
/*-----------------------------------------------------------*/
#if ( ( configUSE_MUTEXES == 1 ) && ( INCLUDE_xSemaphoreGetMutexHolder == 1 ) )
TaskHandle_t xQueueGetMutexHolder( QueueHandle_t xSemaphore )
{
TaskHandle_t pxReturn;
struct rt_ipc_object *pipc;
rt_uint8_t type;
rt_base_t level;
configASSERT( xSemaphore );
pipc = xSemaphore->rt_ipc;
RT_ASSERT( pipc != RT_NULL );
type = rt_object_get_type( &pipc->parent );
if ( type == RT_Object_Class_Mutex )
{
level = rt_hw_interrupt_disable();
pxReturn = ( TaskHandle_t ) ( ( rt_mutex_t ) pipc )->owner;
rt_hw_interrupt_enable( level );
}
else
{
pxReturn = NULL;
}
return pxReturn;
}
#endif /* if ( ( configUSE_MUTEXES == 1 ) && ( INCLUDE_xSemaphoreGetMutexHolder == 1 ) ) */
/*-----------------------------------------------------------*/
#if ( ( configUSE_MUTEXES == 1 ) && ( INCLUDE_xSemaphoreGetMutexHolder == 1 ) )
TaskHandle_t xQueueGetMutexHolderFromISR( QueueHandle_t xSemaphore )
{
return xQueueGetMutexHolder( xSemaphore );
}
#endif /* if ( ( configUSE_MUTEXES == 1 ) && ( INCLUDE_xSemaphoreGetMutexHolder == 1 ) ) */
/*-----------------------------------------------------------*/
#if ( configUSE_RECURSIVE_MUTEXES == 1 )
BaseType_t xQueueGiveMutexRecursive( QueueHandle_t xMutex )
{
Queue_t * const pxMutex = ( Queue_t * ) xMutex;
configASSERT( pxMutex );
return xQueueGenericSend( pxMutex, NULL, queueMUTEX_GIVE_BLOCK_TIME, queueSEND_TO_BACK );
}
#endif /* configUSE_RECURSIVE_MUTEXES */
/*-----------------------------------------------------------*/
#if ( configUSE_RECURSIVE_MUTEXES == 1 )
BaseType_t xQueueTakeMutexRecursive( QueueHandle_t xMutex,
TickType_t xTicksToWait )
{
Queue_t * const pxMutex = ( Queue_t * ) xMutex;
configASSERT( pxMutex );
return xQueueSemaphoreTake( pxMutex, xTicksToWait );
}
#endif /* configUSE_RECURSIVE_MUTEXES */
/*-----------------------------------------------------------*/
#if ( ( configUSE_COUNTING_SEMAPHORES == 1 ) && ( configSUPPORT_STATIC_ALLOCATION == 1 ) )
QueueHandle_t xQueueCreateCountingSemaphoreStatic( const UBaseType_t uxMaxCount,
const UBaseType_t uxInitialCount,
StaticQueue_t * pxStaticQueue )
{
QueueHandle_t xHandle = NULL;
if( ( uxMaxCount != 0 ) &&
( uxInitialCount <= uxMaxCount ) )
{
xHandle = xQueueGenericCreateStatic( uxMaxCount, queueSEMAPHORE_QUEUE_ITEM_LENGTH, NULL, pxStaticQueue, queueQUEUE_TYPE_COUNTING_SEMAPHORE );
if( xHandle != NULL )
{
( ( rt_sem_t ) ( ( Queue_t * ) xHandle )->rt_ipc )->value = uxInitialCount;
}
}
else
{
configASSERT( xHandle );
}
return xHandle;
}
#endif /* ( ( configUSE_COUNTING_SEMAPHORES == 1 ) && ( configSUPPORT_DYNAMIC_ALLOCATION == 1 ) ) */
/*-----------------------------------------------------------*/
#if ( ( configUSE_COUNTING_SEMAPHORES == 1 ) && ( configSUPPORT_DYNAMIC_ALLOCATION == 1 ) )
QueueHandle_t xQueueCreateCountingSemaphore( const UBaseType_t uxMaxCount,
const UBaseType_t uxInitialCount )
{
QueueHandle_t xHandle = NULL;
if( ( uxMaxCount != 0 ) &&
( uxInitialCount <= uxMaxCount ) )
{
xHandle = xQueueGenericCreate( uxMaxCount, queueSEMAPHORE_QUEUE_ITEM_LENGTH, queueQUEUE_TYPE_COUNTING_SEMAPHORE );
if( xHandle != NULL )
{
( ( rt_sem_t ) ( ( Queue_t * ) xHandle )->rt_ipc )->value = uxInitialCount;
}
}
else
{
configASSERT( xHandle );
}
return xHandle;
}
#endif /* ( ( configUSE_COUNTING_SEMAPHORES == 1 ) && ( configSUPPORT_DYNAMIC_ALLOCATION == 1 ) ) */
/*-----------------------------------------------------------*/
BaseType_t xQueueGenericSend( QueueHandle_t xQueue,
const void * const pvItemToQueue,
TickType_t xTicksToWait,
const BaseType_t xCopyPosition )
{
Queue_t * const pxQueue = xQueue;
struct rt_ipc_object *pipc;
rt_uint8_t type;
rt_base_t level;
rt_err_t err = -RT_ERROR;
configASSERT( pxQueue );
#if ( INCLUDE_xTaskGetSchedulerState == 1 )
{
configASSERT( !( ( xTaskGetSchedulerState() == taskSCHEDULER_SUSPENDED ) && ( xTicksToWait != 0 ) ) );
}
#endif
pipc = pxQueue->rt_ipc;
RT_ASSERT( pipc != RT_NULL );
type = rt_object_get_type( &pipc->parent );
if ( type == RT_Object_Class_Mutex )
{
err = rt_mutex_release( ( rt_mutex_t ) pipc );
}
else if ( type == RT_Object_Class_Semaphore )
{
level = rt_hw_interrupt_disable();
if ( ( ( rt_sem_t ) pipc )->value < ( ( struct rt_semaphore_wrapper * ) pipc )->max_value )
{
err = rt_sem_release( ( rt_sem_t ) pipc );
}
rt_hw_interrupt_enable( level );
}
else if ( type == RT_Object_Class_MessageQueue )
{
if ( xCopyPosition == queueSEND_TO_BACK )
{
err = rt_mq_send_wait( ( rt_mq_t ) pipc, pvItemToQueue, ( ( rt_mq_t ) pipc )->msg_size, ( rt_int32_t ) xTicksToWait );
}
else if ( xCopyPosition == queueSEND_TO_FRONT )
{
// TODO: need to implement the timeout for LIFO
err = rt_mq_urgent( ( rt_mq_t ) pipc, pvItemToQueue, ( ( rt_mq_t ) pipc )->msg_size );
}
}
return rt_err_to_freertos( err );
}
/*-----------------------------------------------------------*/
BaseType_t xQueueGenericSendFromISR( QueueHandle_t xQueue,
const void * const pvItemToQueue,
BaseType_t * const pxHigherPriorityTaskWoken,
const BaseType_t xCopyPosition )
{
Queue_t * const pxQueue = xQueue;
struct rt_ipc_object *pipc;
rt_uint8_t type;
rt_err_t err = -RT_ERROR;
configASSERT( pxQueue );
pipc = pxQueue->rt_ipc;
RT_ASSERT( pipc != RT_NULL );
type = rt_object_get_type( &pipc->parent );
if ( type == RT_Object_Class_MessageQueue )
{
if ( xCopyPosition == queueSEND_TO_BACK )
{
err = rt_mq_send( ( rt_mq_t ) pipc, pvItemToQueue, ( ( rt_mq_t ) pipc )->msg_size);
}
else if ( xCopyPosition == queueSEND_TO_FRONT )
{
err = rt_mq_urgent( ( rt_mq_t ) pipc, pvItemToQueue, ( ( rt_mq_t ) pipc )->msg_size );
}
}
return rt_err_to_freertos( err );
}
/*-----------------------------------------------------------*/
BaseType_t xQueueGiveFromISR( QueueHandle_t xQueue,
BaseType_t * const pxHigherPriorityTaskWoken )
{
Queue_t * const pxQueue = xQueue;
struct rt_ipc_object *pipc;
rt_uint8_t type;
rt_base_t level;
rt_err_t err = -RT_ERROR;
configASSERT( pxQueue );
pipc = pxQueue->rt_ipc;
RT_ASSERT( pipc != RT_NULL );
type = rt_object_get_type( &pipc->parent );
RT_ASSERT( type != RT_Object_Class_Mutex );
if ( type == RT_Object_Class_Semaphore )
{
level = rt_hw_interrupt_disable();
if ( ( ( rt_sem_t ) pipc )->value < ( ( struct rt_semaphore_wrapper * ) pipc )->max_value )
{
err = rt_sem_release( ( rt_sem_t ) pipc );
}
rt_hw_interrupt_enable( level );
}
if ( pxHigherPriorityTaskWoken != NULL )
{
*pxHigherPriorityTaskWoken = pdFALSE;
}
return rt_err_to_freertos( err );
}
/*-----------------------------------------------------------*/
BaseType_t xQueueReceive( QueueHandle_t xQueue,
void * const pvBuffer,
TickType_t xTicksToWait )
{
Queue_t * const pxQueue = xQueue;
struct rt_ipc_object *pipc;
rt_uint8_t type;
rt_err_t err = -RT_ERROR;
/* Check the queue pointer is not NULL. */
configASSERT( ( pxQueue ) );
/* Cannot block if the scheduler is suspended. */
#if ( INCLUDE_xTaskGetSchedulerState == 1 )
{
configASSERT( !( ( xTaskGetSchedulerState() == taskSCHEDULER_SUSPENDED ) && ( xTicksToWait != 0 ) ) );
}
#endif
pipc = pxQueue->rt_ipc;
RT_ASSERT( pipc != RT_NULL );
type = rt_object_get_type( &pipc->parent );
if ( type == RT_Object_Class_MessageQueue )
{
err = ( rt_err_t ) rt_mq_recv( ( rt_mq_t ) pipc, pvBuffer, ( ( rt_mq_t ) pipc )->msg_size, ( rt_int32_t ) xTicksToWait );
#if RT_VER_NUM >= 0x50001
if (( rt_ssize_t ) err >= 0)
{
err = RT_EOK;
}
#endif
}
return rt_err_to_freertos( err );
}
/*-----------------------------------------------------------*/
BaseType_t xQueueSemaphoreTake( QueueHandle_t xQueue,
TickType_t xTicksToWait )
{
Queue_t * const pxQueue = xQueue;
struct rt_ipc_object *pipc;
rt_uint8_t type;
rt_err_t err = -RT_ERROR;
/* Check the queue pointer is not NULL. */
configASSERT( ( pxQueue ) );
/* Cannot block if the scheduler is suspended. */
#if ( INCLUDE_xTaskGetSchedulerState == 1 )
{
configASSERT( !( ( xTaskGetSchedulerState() == taskSCHEDULER_SUSPENDED ) && ( xTicksToWait != 0 ) ) );
}
#endif
pipc = pxQueue->rt_ipc;
RT_ASSERT( pipc != RT_NULL );
type = rt_object_get_type( &pipc->parent );
if ( type == RT_Object_Class_Mutex )
{
err = rt_mutex_take( ( rt_mutex_t ) pipc, ( rt_int32_t ) xTicksToWait );
}
else if ( type == RT_Object_Class_Semaphore )
{
err = rt_sem_take( ( rt_sem_t ) pipc, ( rt_int32_t ) xTicksToWait );
}
return rt_err_to_freertos( err );
}
/*-----------------------------------------------------------*/
BaseType_t xQueueReceiveFromISR( QueueHandle_t xQueue,
void * const pvBuffer,
BaseType_t * const pxHigherPriorityTaskWoken )
{
Queue_t * const pxQueue = xQueue;
struct rt_ipc_object *pipc;
rt_uint8_t type;
rt_err_t err = -RT_ERROR;
configASSERT( pxQueue );
pipc = pxQueue->rt_ipc;
RT_ASSERT( pipc != RT_NULL );
type = rt_object_get_type( &pipc->parent );
RT_ASSERT( type != RT_Object_Class_Mutex );
if ( type == RT_Object_Class_Semaphore )
{
err = rt_sem_take( ( rt_sem_t ) pipc, RT_WAITING_NO );
}
else if ( type == RT_Object_Class_MessageQueue )
{
err = ( rt_err_t ) rt_mq_recv( ( rt_mq_t ) pipc, pvBuffer, ( ( rt_mq_t ) pipc )->msg_size, RT_WAITING_NO );
#if RT_VER_NUM >= 0x50001
if (( rt_ssize_t ) err >= 0)
{
err = RT_EOK;
}
#endif
}
if ( pxHigherPriorityTaskWoken != NULL )
{
*pxHigherPriorityTaskWoken = pdFALSE;
}
return rt_err_to_freertos( err );
}
/*-----------------------------------------------------------*/
UBaseType_t uxQueueMessagesWaiting( const QueueHandle_t xQueue )
{
UBaseType_t uxReturn = 0;
struct rt_ipc_object *pipc;
rt_uint8_t type;
rt_base_t level;
configASSERT( xQueue );
pipc = xQueue->rt_ipc;
RT_ASSERT( pipc != RT_NULL );
type = rt_object_get_type( &pipc->parent );
level = rt_hw_interrupt_disable();
if ( type == RT_Object_Class_Mutex )
{
if ( ( ( rt_mutex_t ) pipc )->owner == RT_NULL )
{
uxReturn = 1;
}
else
{
uxReturn = 0;
}
}
else if ( type == RT_Object_Class_Semaphore )
{
uxReturn = ( ( rt_sem_t ) pipc )->value;
}
else if ( type == RT_Object_Class_MessageQueue )
{
uxReturn = ( ( rt_mq_t ) pipc )->entry;
}
rt_hw_interrupt_enable( level );
return uxReturn;
}
/*-----------------------------------------------------------*/
UBaseType_t uxQueueSpacesAvailable( const QueueHandle_t xQueue )
{
UBaseType_t uxReturn = 0;
struct rt_ipc_object *pipc;
rt_uint8_t type;
rt_base_t level;
configASSERT( xQueue );
pipc = xQueue->rt_ipc;
RT_ASSERT( pipc != RT_NULL );
type = rt_object_get_type( &pipc->parent );
level = rt_hw_interrupt_disable();
if ( type == RT_Object_Class_Mutex )
{
if ( ( ( rt_mutex_t ) pipc )->owner == RT_NULL )
{
uxReturn = 0;
}
else
{
uxReturn = 1;
}
}
else if ( type == RT_Object_Class_Semaphore )
{
uxReturn = ( ( struct rt_semaphore_wrapper * ) pipc )->max_value - ( ( rt_sem_t ) pipc )->value;
}
else if ( type == RT_Object_Class_MessageQueue )
{
uxReturn = ( ( rt_mq_t ) pipc )->max_msgs - ( ( rt_mq_t ) pipc )->entry;
}
rt_hw_interrupt_enable( level );
return uxReturn;
}
/*-----------------------------------------------------------*/
UBaseType_t uxQueueMessagesWaitingFromISR( const QueueHandle_t xQueue )
{
return uxQueueMessagesWaiting( xQueue );
}
/*-----------------------------------------------------------*/
void vQueueDelete( QueueHandle_t xQueue )
{
Queue_t * const pxQueue = xQueue;
struct rt_ipc_object *pipc;
rt_uint8_t type;
configASSERT( pxQueue );
pipc = pxQueue->rt_ipc;
RT_ASSERT( pipc != RT_NULL );
type = rt_object_get_type( &pipc->parent );
#if ( ( configSUPPORT_DYNAMIC_ALLOCATION == 1 ) && ( configSUPPORT_STATIC_ALLOCATION == 1 ) )
if ( rt_object_is_systemobject( ( rt_object_t ) pipc ) )
#endif
{
#if ( configSUPPORT_STATIC_ALLOCATION == 1 )
if ( type == RT_Object_Class_Mutex )
{
rt_mutex_detach( ( rt_mutex_t ) pipc );
}
else if ( type == RT_Object_Class_Semaphore )
{
rt_sem_detach( ( rt_sem_t ) pipc );
}
else if ( type == RT_Object_Class_MessageQueue )
{
rt_mq_detach( ( rt_mq_t ) pipc );
}
#endif
#if ( ( configSUPPORT_DYNAMIC_ALLOCATION == 1 ) && ( configSUPPORT_STATIC_ALLOCATION == 1 ) )
}
else
{
#endif
#if ( configSUPPORT_DYNAMIC_ALLOCATION == 1 )
if ( type == RT_Object_Class_Mutex )
{
rt_mutex_delete( ( rt_mutex_t ) pipc );
}
else if ( type == RT_Object_Class_Semaphore )
{
/* Allocated with rt_sem_init in xQueueGenericCreate */
pipc->parent.type |= RT_Object_Class_Static;
rt_sem_detach( ( rt_sem_t ) pipc );
RT_KERNEL_FREE( pipc );
}
else if ( type == RT_Object_Class_MessageQueue )
{
rt_mq_delete( ( rt_mq_t ) pipc );
}
else
{
return;
}
RT_KERNEL_FREE( pxQueue );
#endif
}
}
/*-----------------------------------------------------------*/
BaseType_t xQueueIsQueueEmptyFromISR( const QueueHandle_t xQueue )
{
BaseType_t xReturn;
configASSERT( xQueue );
if( uxQueueMessagesWaiting( xQueue ) == ( UBaseType_t ) 0 )
{
xReturn = pdTRUE;
}
else
{
xReturn = pdFALSE;
}
return xReturn;
}
/*-----------------------------------------------------------*/
BaseType_t xQueueIsQueueFullFromISR( const QueueHandle_t xQueue )
{
BaseType_t xReturn;
configASSERT( xQueue );
if ( uxQueueSpacesAvailable( xQueue ) == ( UBaseType_t ) 0 )
{
xReturn = pdTRUE;
}
else
{
xReturn = pdFALSE;
}
return xReturn;
}
/*-----------------------------------------------------------*/
#ifdef ESP_PLATFORM
/* Unimplemented */
#include "esp_log.h"
static const char *TAG = "freertos";
QueueSetHandle_t xQueueCreateSet( const UBaseType_t uxEventQueueLength )
{
ESP_LOGE(TAG, "xQueueCreateSet unimplemented");
configASSERT(0);
return NULL;
}
BaseType_t xQueueAddToSet( QueueSetMemberHandle_t xQueueOrSemaphore,
QueueSetHandle_t xQueueSet )
{
ESP_LOGE(TAG, "xQueueAddToSet unimplemented");
configASSERT(0);
return pdFAIL;
}
BaseType_t xQueueRemoveFromSet( QueueSetMemberHandle_t xQueueOrSemaphore,
QueueSetHandle_t xQueueSet )
{
ESP_LOGE(TAG, "xQueueRemoveFromSet unimplemented");
configASSERT(0);
return pdFAIL;
}
QueueSetMemberHandle_t xQueueSelectFromSet( QueueSetHandle_t xQueueSet,
const TickType_t xTicksToWait )
{
ESP_LOGE(TAG, "xQueueSelectFromSet unimplemented");
configASSERT(0);
return NULL;
}
QueueSetMemberHandle_t xQueueSelectFromSetFromISR( QueueSetHandle_t xQueueSet )
{
ESP_LOGE(TAG, "xQueueSelectFromSetFromISR unimplemented");
configASSERT(0);
return NULL;
}
BaseType_t xQueuePeek( QueueHandle_t xQueue,
void * const pvBuffer,
TickType_t xTicksToWait )
{
ESP_LOGE(TAG, "xQueuePeek unimplemented");
configASSERT(0);
return pdFAIL;
}
BaseType_t xQueueOverwrite(QueueHandle_t xQueue, const void * pvItemToQueue)
{
ESP_LOGE(TAG, "xQueueOverwrite unimplemented");
configASSERT(0);
return pdFAIL;
}
BaseType_t xQueueOverwriteFromISR(QueueHandle_t xQueue, const void * pvItemToQueue, BaseType_t *pxHigherPriorityTaskWoken)
{
ESP_LOGE(TAG, "xQueueOverwriteFromISR unimplemented");
configASSERT(0);
return pdFAIL;
}
#endif
Reference in New Issue View Git Blame Copy Permalink