2 FreeRTOS V7.4.2 - Copyright (C) 2013 Real Time Engineers Ltd.
\r
4 FEATURES AND PORTS ARE ADDED TO FREERTOS ALL THE TIME. PLEASE VISIT
\r
5 http://www.FreeRTOS.org TO ENSURE YOU ARE USING THE LATEST VERSION.
\r
7 ***************************************************************************
\r
9 * FreeRTOS tutorial books are available in pdf and paperback. *
\r
10 * Complete, revised, and edited pdf reference manuals are also *
\r
13 * Purchasing FreeRTOS documentation will not only help you, by *
\r
14 * ensuring you get running as quickly as possible and with an *
\r
15 * in-depth knowledge of how to use FreeRTOS, it will also help *
\r
16 * the FreeRTOS project to continue with its mission of providing *
\r
17 * professional grade, cross platform, de facto standard solutions *
\r
18 * for microcontrollers - completely free of charge! *
\r
20 * >>> See http://www.FreeRTOS.org/Documentation for details. <<< *
\r
22 * Thank you for using FreeRTOS, and thank you for your support! *
\r
24 ***************************************************************************
\r
27 This file is part of the FreeRTOS distribution.
\r
29 FreeRTOS is free software; you can redistribute it and/or modify it under
\r
30 the terms of the GNU General Public License (version 2) as published by the
\r
31 Free Software Foundation AND MODIFIED BY the FreeRTOS exception.
\r
33 >>>>>>NOTE<<<<<< The modification to the GPL is included to allow you to
\r
34 distribute a combined work that includes FreeRTOS without being obliged to
\r
35 provide the source code for proprietary components outside of the FreeRTOS
\r
38 FreeRTOS is distributed in the hope that it will be useful, but WITHOUT ANY
\r
39 WARRANTY; without even the implied warranty of MERCHANTABILITY or FITNESS
\r
40 FOR A PARTICULAR PURPOSE. See the GNU General Public License for more
\r
41 details. You should have received a copy of the GNU General Public License
\r
42 and the FreeRTOS license exception along with FreeRTOS; if not it can be
\r
43 viewed here: http://www.freertos.org/a00114.html and also obtained by
\r
44 writing to Real Time Engineers Ltd., contact details for whom are available
\r
45 on the FreeRTOS WEB site.
\r
49 ***************************************************************************
\r
51 * Having a problem? Start by reading the FAQ "My application does *
\r
52 * not run, what could be wrong?" *
\r
54 * http://www.FreeRTOS.org/FAQHelp.html *
\r
56 ***************************************************************************
\r
59 http://www.FreeRTOS.org - Documentation, books, training, latest versions,
\r
60 license and Real Time Engineers Ltd. contact details.
\r
62 http://www.FreeRTOS.org/plus - A selection of FreeRTOS ecosystem products,
\r
63 including FreeRTOS+Trace - an indispensable productivity tool, and our new
\r
64 fully thread aware and reentrant UDP/IP stack.
\r
66 http://www.OpenRTOS.com - Real Time Engineers ltd license FreeRTOS to High
\r
67 Integrity Systems, who sell the code with commercial support,
\r
68 indemnification and middleware, under the OpenRTOS brand.
\r
70 http://www.SafeRTOS.com - High Integrity Systems also provide a safety
\r
71 engineered and independently SIL3 certified version for use in safety and
\r
72 mission critical applications that require provable dependability.
\r
78 /* Defining MPU_WRAPPERS_INCLUDED_FROM_API_FILE prevents task.h from redefining
\r
79 all the API functions to use the MPU wrappers. That should only be done when
\r
80 task.h is included from an application file. */
\r
81 #define MPU_WRAPPERS_INCLUDED_FROM_API_FILE
\r
83 #include "FreeRTOS.h"
\r
87 #if ( configUSE_CO_ROUTINES == 1 )
\r
88 #include "croutine.h"
\r
91 #undef MPU_WRAPPERS_INCLUDED_FROM_API_FILE
\r
93 /* Constants used with the cRxLock and xTxLock structure members. */
\r
94 #define queueUNLOCKED ( ( signed portBASE_TYPE ) -1 )
\r
95 #define queueLOCKED_UNMODIFIED ( ( signed portBASE_TYPE ) 0 )
\r
97 #define queueERRONEOUS_UNBLOCK ( -1 )
\r
99 /* When the xQUEUE structure is used to represent a base queue its pcHead and
\r
100 pcTail members are used as pointers into the queue storage area. When the
\r
101 xQUEUE structure is used to represent a mutex pcHead and pcTail pointers are
\r
102 not necessary, and the pcHead pointer is set to NULL to indicate that the
\r
103 pcTail pointer actually points to the mutex holder (if any). Map alternative
\r
104 names to the pcHead and pcTail structure members to ensure the readability of
\r
105 the code is maintained despite this dual use of two structure members. An
\r
106 alternative implementation would be to use a union, but use of a union is
\r
107 against the coding standard (although an exception to the standard has been
\r
108 permitted where the dual use also significantly changes the type of the
\r
109 structure member). */
\r
110 #define pxMutexHolder pcTail
\r
111 #define uxQueueType pcHead
\r
112 #define queueQUEUE_IS_MUTEX NULL
\r
114 /* Semaphores do not actually store or copy data, so have an item size of
\r
116 #define queueSEMAPHORE_QUEUE_ITEM_LENGTH ( ( unsigned portBASE_TYPE ) 0 )
\r
117 #define queueDONT_BLOCK ( ( portTickType ) 0U )
\r
118 #define queueMUTEX_GIVE_BLOCK_TIME ( ( portTickType ) 0U )
\r
122 * Definition of the queue used by the scheduler.
\r
123 * Items are queued by copy, not reference.
\r
125 typedef struct QueueDefinition
\r
127 signed char *pcHead; /*< Points to the beginning of the queue storage area. */
\r
128 signed char *pcTail; /*< Points to the byte at the end of the queue storage area. Once more byte is allocated than necessary to store the queue items, this is used as a marker. */
\r
130 signed char *pcWriteTo; /*< Points to the free next place in the storage area. */
\r
132 union /* Use of a union is an exception to the coding standard to ensure two mutually exclusive structure members don't appear simultaneously (wasting RAM). */
\r
134 signed char *pcReadFrom; /*< Points to the last place that a queued item was read from when the structure is used as a queue. */
\r
135 unsigned portBASE_TYPE uxRecursiveCallCount;/*< Maintains a count of the numebr of times a recursive mutex has been recursively 'taken' when the structure is used as a mutex. */
\r
138 xList xTasksWaitingToSend; /*< List of tasks that are blocked waiting to post onto this queue. Stored in priority order. */
\r
139 xList xTasksWaitingToReceive; /*< List of tasks that are blocked waiting to read from this queue. Stored in priority order. */
\r
141 volatile unsigned portBASE_TYPE uxMessagesWaiting;/*< The number of items currently in the queue. */
\r
142 unsigned portBASE_TYPE uxLength; /*< The length of the queue defined as the number of items it will hold, not the number of bytes. */
\r
143 unsigned portBASE_TYPE uxItemSize; /*< The size of each items that the queue will hold. */
\r
145 volatile signed portBASE_TYPE xRxLock; /*< Stores the number of items received from the queue (removed from the queue) while the queue was locked. Set to queueUNLOCKED when the queue is not locked. */
\r
146 volatile signed portBASE_TYPE xTxLock; /*< Stores the number of items transmitted to the queue (added to the queue) while the queue was locked. Set to queueUNLOCKED when the queue is not locked. */
\r
148 #if ( configUSE_TRACE_FACILITY == 1 )
\r
149 unsigned char ucQueueNumber;
\r
150 unsigned char ucQueueType;
\r
153 #if ( configUSE_QUEUE_SETS == 1 )
\r
154 struct QueueDefinition *pxQueueSetContainer;
\r
158 /*-----------------------------------------------------------*/
\r
161 * The queue registry is just a means for kernel aware debuggers to locate
\r
162 * queue structures. It has no other purpose so is an optional component.
\r
164 #if ( configQUEUE_REGISTRY_SIZE > 0 )
\r
166 /* The type stored within the queue registry array. This allows a name
\r
167 to be assigned to each queue making kernel aware debugging a little
\r
168 more user friendly. */
\r
169 typedef struct QUEUE_REGISTRY_ITEM
\r
171 signed char *pcQueueName;
\r
172 xQueueHandle xHandle;
\r
173 } xQueueRegistryItem;
\r
175 /* The queue registry is simply an array of xQueueRegistryItem structures.
\r
176 The pcQueueName member of a structure being NULL is indicative of the
\r
177 array position being vacant. */
\r
178 xQueueRegistryItem xQueueRegistry[ configQUEUE_REGISTRY_SIZE ];
\r
180 #endif /* configQUEUE_REGISTRY_SIZE */
\r
183 * Unlocks a queue locked by a call to prvLockQueue. Locking a queue does not
\r
184 * prevent an ISR from adding or removing items to the queue, but does prevent
\r
185 * an ISR from removing tasks from the queue event lists. If an ISR finds a
\r
186 * queue is locked it will instead increment the appropriate queue lock count
\r
187 * to indicate that a task may require unblocking. When the queue in unlocked
\r
188 * these lock counts are inspected, and the appropriate action taken.
\r
190 static void prvUnlockQueue( xQUEUE *pxQueue ) PRIVILEGED_FUNCTION;
\r
193 * Uses a critical section to determine if there is any data in a queue.
\r
195 * @return pdTRUE if the queue contains no items, otherwise pdFALSE.
\r
197 static signed portBASE_TYPE prvIsQueueEmpty( const xQUEUE *pxQueue ) PRIVILEGED_FUNCTION;
\r
200 * Uses a critical section to determine if there is any space in a queue.
\r
202 * @return pdTRUE if there is no space, otherwise pdFALSE;
\r
204 static signed portBASE_TYPE prvIsQueueFull( const xQUEUE *pxQueue ) PRIVILEGED_FUNCTION;
\r
207 * Copies an item into the queue, either at the front of the queue or the
\r
208 * back of the queue.
\r
210 static void prvCopyDataToQueue( xQUEUE *pxQueue, const void *pvItemToQueue, portBASE_TYPE xPosition ) PRIVILEGED_FUNCTION;
\r
213 * Copies an item out of a queue.
\r
215 static void prvCopyDataFromQueue( xQUEUE * const pxQueue, const void *pvBuffer ) PRIVILEGED_FUNCTION;
\r
217 #if ( configUSE_QUEUE_SETS == 1 )
\r
219 * Checks to see if a queue is a member of a queue set, and if so, notifies
\r
220 * the queue set that the queue contains data.
\r
222 static portBASE_TYPE prvNotifyQueueSetContainer( xQUEUE *pxQueue, portBASE_TYPE xCopyPosition ) PRIVILEGED_FUNCTION;
\r
225 /*-----------------------------------------------------------*/
\r
228 * Macro to mark a queue as locked. Locking a queue prevents an ISR from
\r
229 * accessing the queue event lists.
\r
231 #define prvLockQueue( pxQueue ) \
\r
232 taskENTER_CRITICAL(); \
\r
234 if( ( pxQueue )->xRxLock == queueUNLOCKED ) \
\r
236 ( pxQueue )->xRxLock = queueLOCKED_UNMODIFIED; \
\r
238 if( ( pxQueue )->xTxLock == queueUNLOCKED ) \
\r
240 ( pxQueue )->xTxLock = queueLOCKED_UNMODIFIED; \
\r
243 taskEXIT_CRITICAL()
\r
244 /*-----------------------------------------------------------*/
\r
246 portBASE_TYPE xQueueGenericReset( xQueueHandle xQueue, portBASE_TYPE xNewQueue )
\r
250 pxQueue = ( xQUEUE * ) xQueue;
\r
251 configASSERT( pxQueue );
\r
253 taskENTER_CRITICAL();
\r
255 pxQueue->pcTail = pxQueue->pcHead + ( pxQueue->uxLength * pxQueue->uxItemSize );
\r
256 pxQueue->uxMessagesWaiting = ( unsigned portBASE_TYPE ) 0U;
\r
257 pxQueue->pcWriteTo = pxQueue->pcHead;
\r
258 pxQueue->u.pcReadFrom = pxQueue->pcHead + ( ( pxQueue->uxLength - ( unsigned portBASE_TYPE ) 1U ) * pxQueue->uxItemSize );
\r
259 pxQueue->xRxLock = queueUNLOCKED;
\r
260 pxQueue->xTxLock = queueUNLOCKED;
\r
262 if( xNewQueue == pdFALSE )
\r
264 /* If there are tasks blocked waiting to read from the queue, then
\r
265 the tasks will remain blocked as after this function exits the queue
\r
266 will still be empty. If there are tasks blocked waiting to write to
\r
267 the queue, then one should be unblocked as after this function exits
\r
268 it will be possible to write to it. */
\r
269 if( listLIST_IS_EMPTY( &( pxQueue->xTasksWaitingToSend ) ) == pdFALSE )
\r
271 if( xTaskRemoveFromEventList( &( pxQueue->xTasksWaitingToSend ) ) == pdTRUE )
\r
273 portYIELD_WITHIN_API();
\r
279 /* Ensure the event queues start in the correct state. */
\r
280 vListInitialise( &( pxQueue->xTasksWaitingToSend ) );
\r
281 vListInitialise( &( pxQueue->xTasksWaitingToReceive ) );
\r
284 taskEXIT_CRITICAL();
\r
286 /* A value is returned for calling semantic consistency with previous
\r
290 /*-----------------------------------------------------------*/
\r
292 xQueueHandle xQueueGenericCreate( unsigned portBASE_TYPE uxQueueLength, unsigned portBASE_TYPE uxItemSize, unsigned char ucQueueType )
\r
294 xQUEUE *pxNewQueue;
\r
295 size_t xQueueSizeInBytes;
\r
296 xQueueHandle xReturn = NULL;
\r
298 /* Remove compiler warnings about unused parameters should
\r
299 configUSE_TRACE_FACILITY not be set to 1. */
\r
300 ( void ) ucQueueType;
\r
302 /* Allocate the new queue structure. */
\r
303 if( uxQueueLength > ( unsigned portBASE_TYPE ) 0 )
\r
305 pxNewQueue = ( xQUEUE * ) pvPortMalloc( sizeof( xQUEUE ) );
\r
306 if( pxNewQueue != NULL )
\r
308 /* Create the list of pointers to queue items. The queue is one byte
\r
309 longer than asked for to make wrap checking easier/faster. */
\r
310 xQueueSizeInBytes = ( size_t ) ( uxQueueLength * uxItemSize ) + ( size_t ) 1;
\r
312 pxNewQueue->pcHead = ( signed char * ) pvPortMalloc( xQueueSizeInBytes );
\r
313 if( pxNewQueue->pcHead != NULL )
\r
315 /* Initialise the queue members as described above where the
\r
316 queue type is defined. */
\r
317 pxNewQueue->uxLength = uxQueueLength;
\r
318 pxNewQueue->uxItemSize = uxItemSize;
\r
319 xQueueGenericReset( pxNewQueue, pdTRUE );
\r
321 #if ( configUSE_TRACE_FACILITY == 1 )
\r
323 pxNewQueue->ucQueueType = ucQueueType;
\r
325 #endif /* configUSE_TRACE_FACILITY */
\r
327 #if( configUSE_QUEUE_SETS == 1 )
\r
329 pxNewQueue->pxQueueSetContainer = NULL;
\r
331 #endif /* configUSE_QUEUE_SETS */
\r
333 traceQUEUE_CREATE( pxNewQueue );
\r
334 xReturn = pxNewQueue;
\r
338 traceQUEUE_CREATE_FAILED( ucQueueType );
\r
339 vPortFree( pxNewQueue );
\r
344 configASSERT( xReturn );
\r
348 /*-----------------------------------------------------------*/
\r
350 #if ( configUSE_MUTEXES == 1 )
\r
352 xQueueHandle xQueueCreateMutex( unsigned char ucQueueType )
\r
354 xQUEUE *pxNewQueue;
\r
356 /* Prevent compiler warnings about unused parameters if
\r
357 configUSE_TRACE_FACILITY does not equal 1. */
\r
358 ( void ) ucQueueType;
\r
360 /* Allocate the new queue structure. */
\r
361 pxNewQueue = ( xQUEUE * ) pvPortMalloc( sizeof( xQUEUE ) );
\r
362 if( pxNewQueue != NULL )
\r
364 /* Information required for priority inheritance. */
\r
365 pxNewQueue->pxMutexHolder = NULL;
\r
366 pxNewQueue->uxQueueType = queueQUEUE_IS_MUTEX;
\r
368 /* Queues used as a mutex no data is actually copied into or out
\r
370 pxNewQueue->pcWriteTo = NULL;
\r
371 pxNewQueue->u.pcReadFrom = NULL;
\r
373 /* Each mutex has a length of 1 (like a binary semaphore) and
\r
374 an item size of 0 as nothing is actually copied into or out
\r
376 pxNewQueue->uxMessagesWaiting = ( unsigned portBASE_TYPE ) 0U;
\r
377 pxNewQueue->uxLength = ( unsigned portBASE_TYPE ) 1U;
\r
378 pxNewQueue->uxItemSize = ( unsigned portBASE_TYPE ) 0U;
\r
379 pxNewQueue->xRxLock = queueUNLOCKED;
\r
380 pxNewQueue->xTxLock = queueUNLOCKED;
\r
382 #if ( configUSE_TRACE_FACILITY == 1 )
\r
384 pxNewQueue->ucQueueType = ucQueueType;
\r
388 #if ( configUSE_QUEUE_SETS == 1 )
\r
390 pxNewQueue->pxQueueSetContainer = NULL;
\r
394 /* Ensure the event queues start with the correct state. */
\r
395 vListInitialise( &( pxNewQueue->xTasksWaitingToSend ) );
\r
396 vListInitialise( &( pxNewQueue->xTasksWaitingToReceive ) );
\r
398 traceCREATE_MUTEX( pxNewQueue );
\r
400 /* Start with the semaphore in the expected state. */
\r
401 xQueueGenericSend( pxNewQueue, NULL, ( portTickType ) 0U, queueSEND_TO_BACK );
\r
405 traceCREATE_MUTEX_FAILED();
\r
408 configASSERT( pxNewQueue );
\r
412 #endif /* configUSE_MUTEXES */
\r
413 /*-----------------------------------------------------------*/
\r
415 #if ( ( configUSE_MUTEXES == 1 ) && ( INCLUDE_xSemaphoreGetMutexHolder == 1 ) )
\r
417 void* xQueueGetMutexHolder( xQueueHandle xSemaphore )
\r
421 /* This function is called by xSemaphoreGetMutexHolder(), and should not
\r
422 be called directly. Note: This is is a good way of determining if the
\r
423 calling task is the mutex holder, but not a good way of determining the
\r
424 identity of the mutex holder, as the holder may change between the
\r
425 following critical section exiting and the function returning. */
\r
426 taskENTER_CRITICAL();
\r
428 if( ( ( xQUEUE * ) xSemaphore )->uxQueueType == queueQUEUE_IS_MUTEX )
\r
430 pxReturn = ( void * ) ( ( xQUEUE * ) xSemaphore )->pxMutexHolder;
\r
437 taskEXIT_CRITICAL();
\r
443 /*-----------------------------------------------------------*/
\r
445 #if ( configUSE_RECURSIVE_MUTEXES == 1 )
\r
447 portBASE_TYPE xQueueGiveMutexRecursive( xQueueHandle xMutex )
\r
449 portBASE_TYPE xReturn;
\r
452 pxMutex = ( xQUEUE * ) xMutex;
\r
453 configASSERT( pxMutex );
\r
455 /* If this is the task that holds the mutex then pxMutexHolder will not
\r
456 change outside of this task. If this task does not hold the mutex then
\r
457 pxMutexHolder can never coincidentally equal the tasks handle, and as
\r
458 this is the only condition we are interested in it does not matter if
\r
459 pxMutexHolder is accessed simultaneously by another task. Therefore no
\r
460 mutual exclusion is required to test the pxMutexHolder variable. */
\r
461 if( pxMutex->pxMutexHolder == ( void * ) xTaskGetCurrentTaskHandle() )
\r
463 traceGIVE_MUTEX_RECURSIVE( pxMutex );
\r
465 /* uxRecursiveCallCount cannot be zero if pxMutexHolder is equal to
\r
466 the task handle, therefore no underflow check is required. Also,
\r
467 uxRecursiveCallCount is only modified by the mutex holder, and as
\r
468 there can only be one, no mutual exclusion is required to modify the
\r
469 uxRecursiveCallCount member. */
\r
470 ( pxMutex->u.uxRecursiveCallCount )--;
\r
472 /* Have we unwound the call count? */
\r
473 if( pxMutex->u.uxRecursiveCallCount == 0 )
\r
475 /* Return the mutex. This will automatically unblock any other
\r
476 task that might be waiting to access the mutex. */
\r
477 xQueueGenericSend( pxMutex, NULL, queueMUTEX_GIVE_BLOCK_TIME, queueSEND_TO_BACK );
\r
484 /* We cannot give the mutex because we are not the holder. */
\r
487 traceGIVE_MUTEX_RECURSIVE_FAILED( pxMutex );
\r
493 #endif /* configUSE_RECURSIVE_MUTEXES */
\r
494 /*-----------------------------------------------------------*/
\r
496 #if ( configUSE_RECURSIVE_MUTEXES == 1 )
\r
498 portBASE_TYPE xQueueTakeMutexRecursive( xQueueHandle xMutex, portTickType xBlockTime )
\r
500 portBASE_TYPE xReturn;
\r
503 pxMutex = ( xQUEUE * ) xMutex;
\r
504 configASSERT( pxMutex );
\r
506 /* Comments regarding mutual exclusion as per those within
\r
507 xQueueGiveMutexRecursive(). */
\r
509 traceTAKE_MUTEX_RECURSIVE( pxMutex );
\r
511 if( pxMutex->pxMutexHolder == ( void * ) xTaskGetCurrentTaskHandle() )
\r
513 ( pxMutex->u.uxRecursiveCallCount )++;
\r
518 xReturn = xQueueGenericReceive( pxMutex, NULL, xBlockTime, pdFALSE );
\r
520 /* pdPASS will only be returned if we successfully obtained the mutex,
\r
521 we may have blocked to reach here. */
\r
522 if( xReturn == pdPASS )
\r
524 ( pxMutex->u.uxRecursiveCallCount )++;
\r
528 traceTAKE_MUTEX_RECURSIVE_FAILED( pxMutex );
\r
535 #endif /* configUSE_RECURSIVE_MUTEXES */
\r
536 /*-----------------------------------------------------------*/
\r
538 #if ( configUSE_COUNTING_SEMAPHORES == 1 )
\r
540 xQueueHandle xQueueCreateCountingSemaphore( unsigned portBASE_TYPE uxCountValue, unsigned portBASE_TYPE uxInitialCount )
\r
542 xQueueHandle xHandle;
\r
544 xHandle = xQueueGenericCreate( ( unsigned portBASE_TYPE ) uxCountValue, queueSEMAPHORE_QUEUE_ITEM_LENGTH, queueQUEUE_TYPE_COUNTING_SEMAPHORE );
\r
546 if( xHandle != NULL )
\r
548 ( ( xQUEUE * ) xHandle )->uxMessagesWaiting = uxInitialCount;
\r
550 traceCREATE_COUNTING_SEMAPHORE();
\r
554 traceCREATE_COUNTING_SEMAPHORE_FAILED();
\r
557 configASSERT( xHandle );
\r
561 #endif /* configUSE_COUNTING_SEMAPHORES */
\r
562 /*-----------------------------------------------------------*/
\r
564 signed portBASE_TYPE xQueueGenericSend( xQueueHandle xQueue, const void * const pvItemToQueue, portTickType xTicksToWait, portBASE_TYPE xCopyPosition )
\r
566 signed portBASE_TYPE xEntryTimeSet = pdFALSE;
\r
567 xTimeOutType xTimeOut;
\r
570 pxQueue = ( xQUEUE * ) xQueue;
\r
571 configASSERT( pxQueue );
\r
572 configASSERT( !( ( pvItemToQueue == NULL ) && ( pxQueue->uxItemSize != ( unsigned portBASE_TYPE ) 0U ) ) );
\r
573 configASSERT( !( ( xCopyPosition == queueOVERWRITE ) && ( pxQueue->uxLength != 1 ) ) );
\r
575 /* This function relaxes the coding standard somewhat to allow return
\r
576 statements within the function itself. This is done in the interest
\r
577 of execution time efficiency. */
\r
580 taskENTER_CRITICAL();
\r
582 /* Is there room on the queue now? The running task must be
\r
583 the highest priority task wanting to access the queue. If
\r
584 the head item in the queue is to be overwritten then it does
\r
585 not matter if the queue is full. */
\r
586 if( ( pxQueue->uxMessagesWaiting < pxQueue->uxLength ) || ( xCopyPosition == queueOVERWRITE ) )
\r
588 traceQUEUE_SEND( pxQueue );
\r
589 prvCopyDataToQueue( pxQueue, pvItemToQueue, xCopyPosition );
\r
591 #if ( configUSE_QUEUE_SETS == 1 )
\r
593 if( pxQueue->pxQueueSetContainer != NULL )
\r
595 if( prvNotifyQueueSetContainer( pxQueue, xCopyPosition ) == pdTRUE )
\r
597 /* The queue is a member of a queue set, and posting
\r
598 to the queue set caused a higher priority task to
\r
599 unblock. A context switch is required. */
\r
600 portYIELD_WITHIN_API();
\r
605 /* If there was a task waiting for data to arrive on the
\r
606 queue then unblock it now. */
\r
607 if( listLIST_IS_EMPTY( &( pxQueue->xTasksWaitingToReceive ) ) == pdFALSE )
\r
609 if( xTaskRemoveFromEventList( &( pxQueue->xTasksWaitingToReceive ) ) == pdTRUE )
\r
611 /* The unblocked task has a priority higher than
\r
612 our own so yield immediately. Yes it is ok to
\r
613 do this from within the critical section - the
\r
614 kernel takes care of that. */
\r
615 portYIELD_WITHIN_API();
\r
620 #else /* configUSE_QUEUE_SETS */
\r
622 /* If there was a task waiting for data to arrive on the
\r
623 queue then unblock it now. */
\r
624 if( listLIST_IS_EMPTY( &( pxQueue->xTasksWaitingToReceive ) ) == pdFALSE )
\r
626 if( xTaskRemoveFromEventList( &( pxQueue->xTasksWaitingToReceive ) ) == pdTRUE )
\r
628 /* The unblocked task has a priority higher than
\r
629 our own so yield immediately. Yes it is ok to do
\r
630 this from within the critical section - the kernel
\r
631 takes care of that. */
\r
632 portYIELD_WITHIN_API();
\r
636 #endif /* configUSE_QUEUE_SETS */
\r
638 taskEXIT_CRITICAL();
\r
640 /* Return to the original privilege level before exiting the
\r
646 if( xTicksToWait == ( portTickType ) 0 )
\r
648 /* The queue was full and no block time is specified (or
\r
649 the block time has expired) so leave now. */
\r
650 taskEXIT_CRITICAL();
\r
652 /* Return to the original privilege level before exiting
\r
654 traceQUEUE_SEND_FAILED( pxQueue );
\r
655 return errQUEUE_FULL;
\r
657 else if( xEntryTimeSet == pdFALSE )
\r
659 /* The queue was full and a block time was specified so
\r
660 configure the timeout structure. */
\r
661 vTaskSetTimeOutState( &xTimeOut );
\r
662 xEntryTimeSet = pdTRUE;
\r
666 taskEXIT_CRITICAL();
\r
668 /* Interrupts and other tasks can send to and receive from the queue
\r
669 now the critical section has been exited. */
\r
672 prvLockQueue( pxQueue );
\r
674 /* Update the timeout state to see if it has expired yet. */
\r
675 if( xTaskCheckForTimeOut( &xTimeOut, &xTicksToWait ) == pdFALSE )
\r
677 if( prvIsQueueFull( pxQueue ) != pdFALSE )
\r
679 traceBLOCKING_ON_QUEUE_SEND( pxQueue );
\r
680 vTaskPlaceOnEventList( &( pxQueue->xTasksWaitingToSend ), xTicksToWait );
\r
682 /* Unlocking the queue means queue events can effect the
\r
683 event list. It is possible that interrupts occurring now
\r
684 remove this task from the event list again - but as the
\r
685 scheduler is suspended the task will go onto the pending
\r
686 ready last instead of the actual ready list. */
\r
687 prvUnlockQueue( pxQueue );
\r
689 /* Resuming the scheduler will move tasks from the pending
\r
690 ready list into the ready list - so it is feasible that this
\r
691 task is already in a ready list before it yields - in which
\r
692 case the yield will not cause a context switch unless there
\r
693 is also a higher priority task in the pending ready list. */
\r
694 if( xTaskResumeAll() == pdFALSE )
\r
696 portYIELD_WITHIN_API();
\r
702 prvUnlockQueue( pxQueue );
\r
703 ( void ) xTaskResumeAll();
\r
708 /* The timeout has expired. */
\r
709 prvUnlockQueue( pxQueue );
\r
710 ( void ) xTaskResumeAll();
\r
712 /* Return to the original privilege level before exiting the
\r
714 traceQUEUE_SEND_FAILED( pxQueue );
\r
715 return errQUEUE_FULL;
\r
719 /*-----------------------------------------------------------*/
\r
721 #if ( configUSE_ALTERNATIVE_API == 1 )
\r
723 signed portBASE_TYPE xQueueAltGenericSend( xQueueHandle xQueue, const void * const pvItemToQueue, portTickType xTicksToWait, portBASE_TYPE xCopyPosition )
\r
725 signed portBASE_TYPE xEntryTimeSet = pdFALSE;
\r
726 xTimeOutType xTimeOut;
\r
729 pxQueue = ( xQUEUE * ) xQueue;
\r
730 configASSERT( pxQueue );
\r
731 configASSERT( !( ( pvItemToQueue == NULL ) && ( pxQueue->uxItemSize != ( unsigned portBASE_TYPE ) 0U ) ) );
\r
735 taskENTER_CRITICAL();
\r
737 /* Is there room on the queue now? To be running we must be
\r
738 the highest priority task wanting to access the queue. */
\r
739 if( pxQueue->uxMessagesWaiting < pxQueue->uxLength )
\r
741 traceQUEUE_SEND( pxQueue );
\r
742 prvCopyDataToQueue( pxQueue, pvItemToQueue, xCopyPosition );
\r
744 /* If there was a task waiting for data to arrive on the
\r
745 queue then unblock it now. */
\r
746 if( listLIST_IS_EMPTY( &( pxQueue->xTasksWaitingToReceive ) ) == pdFALSE )
\r
748 if( xTaskRemoveFromEventList( &( pxQueue->xTasksWaitingToReceive ) ) == pdTRUE )
\r
750 /* The unblocked task has a priority higher than
\r
751 our own so yield immediately. */
\r
752 portYIELD_WITHIN_API();
\r
756 taskEXIT_CRITICAL();
\r
761 if( xTicksToWait == ( portTickType ) 0 )
\r
763 taskEXIT_CRITICAL();
\r
764 return errQUEUE_FULL;
\r
766 else if( xEntryTimeSet == pdFALSE )
\r
768 vTaskSetTimeOutState( &xTimeOut );
\r
769 xEntryTimeSet = pdTRUE;
\r
773 taskEXIT_CRITICAL();
\r
775 taskENTER_CRITICAL();
\r
777 if( xTaskCheckForTimeOut( &xTimeOut, &xTicksToWait ) == pdFALSE )
\r
779 if( prvIsQueueFull( pxQueue ) != pdFALSE )
\r
781 traceBLOCKING_ON_QUEUE_SEND( pxQueue );
\r
782 vTaskPlaceOnEventList( &( pxQueue->xTasksWaitingToSend ), xTicksToWait );
\r
783 portYIELD_WITHIN_API();
\r
788 taskEXIT_CRITICAL();
\r
789 traceQUEUE_SEND_FAILED( pxQueue );
\r
790 return errQUEUE_FULL;
\r
793 taskEXIT_CRITICAL();
\r
797 #endif /* configUSE_ALTERNATIVE_API */
\r
798 /*-----------------------------------------------------------*/
\r
800 #if ( configUSE_ALTERNATIVE_API == 1 )
\r
802 signed portBASE_TYPE xQueueAltGenericReceive( xQueueHandle xQueue, void * const pvBuffer, portTickType xTicksToWait, portBASE_TYPE xJustPeeking )
\r
804 signed portBASE_TYPE xEntryTimeSet = pdFALSE;
\r
805 xTimeOutType xTimeOut;
\r
806 signed char *pcOriginalReadPosition;
\r
809 pxQueue = ( xQUEUE * ) xQueue;
\r
810 configASSERT( pxQueue );
\r
811 configASSERT( !( ( pvBuffer == NULL ) && ( pxQueue->uxItemSize != ( unsigned portBASE_TYPE ) 0U ) ) );
\r
815 taskENTER_CRITICAL();
\r
817 if( pxQueue->uxMessagesWaiting > ( unsigned portBASE_TYPE ) 0 )
\r
819 /* Remember our read position in case we are just peeking. */
\r
820 pcOriginalReadPosition = pxQueue->u.pcReadFrom;
\r
822 prvCopyDataFromQueue( pxQueue, pvBuffer );
\r
824 if( xJustPeeking == pdFALSE )
\r
826 traceQUEUE_RECEIVE( pxQueue );
\r
828 /* We are actually removing data. */
\r
829 --( pxQueue->uxMessagesWaiting );
\r
831 #if ( configUSE_MUTEXES == 1 )
\r
833 if( pxQueue->uxQueueType == queueQUEUE_IS_MUTEX )
\r
835 /* Record the information required to implement
\r
836 priority inheritance should it become necessary. */
\r
837 pxQueue->pxMutexHolder = ( void * ) xTaskGetCurrentTaskHandle();
\r
842 if( listLIST_IS_EMPTY( &( pxQueue->xTasksWaitingToSend ) ) == pdFALSE )
\r
844 if( xTaskRemoveFromEventList( &( pxQueue->xTasksWaitingToSend ) ) == pdTRUE )
\r
846 portYIELD_WITHIN_API();
\r
852 traceQUEUE_PEEK( pxQueue );
\r
854 /* We are not removing the data, so reset our read
\r
856 pxQueue->u.pcReadFrom = pcOriginalReadPosition;
\r
858 /* The data is being left in the queue, so see if there are
\r
859 any other tasks waiting for the data. */
\r
860 if( listLIST_IS_EMPTY( &( pxQueue->xTasksWaitingToReceive ) ) == pdFALSE )
\r
862 /* Tasks that are removed from the event list will get added to
\r
863 the pending ready list as the scheduler is still suspended. */
\r
864 if( xTaskRemoveFromEventList( &( pxQueue->xTasksWaitingToReceive ) ) != pdFALSE )
\r
866 /* The task waiting has a higher priority than this task. */
\r
867 portYIELD_WITHIN_API();
\r
873 taskEXIT_CRITICAL();
\r
878 if( xTicksToWait == ( portTickType ) 0 )
\r
880 taskEXIT_CRITICAL();
\r
881 traceQUEUE_RECEIVE_FAILED( pxQueue );
\r
882 return errQUEUE_EMPTY;
\r
884 else if( xEntryTimeSet == pdFALSE )
\r
886 vTaskSetTimeOutState( &xTimeOut );
\r
887 xEntryTimeSet = pdTRUE;
\r
891 taskEXIT_CRITICAL();
\r
893 taskENTER_CRITICAL();
\r
895 if( xTaskCheckForTimeOut( &xTimeOut, &xTicksToWait ) == pdFALSE )
\r
897 if( prvIsQueueEmpty( pxQueue ) != pdFALSE )
\r
899 traceBLOCKING_ON_QUEUE_RECEIVE( pxQueue );
\r
901 #if ( configUSE_MUTEXES == 1 )
\r
903 if( pxQueue->uxQueueType == queueQUEUE_IS_MUTEX )
\r
905 portENTER_CRITICAL();
\r
907 vTaskPriorityInherit( ( void * ) pxQueue->pxMutexHolder );
\r
909 portEXIT_CRITICAL();
\r
914 vTaskPlaceOnEventList( &( pxQueue->xTasksWaitingToReceive ), xTicksToWait );
\r
915 portYIELD_WITHIN_API();
\r
920 taskEXIT_CRITICAL();
\r
921 traceQUEUE_RECEIVE_FAILED( pxQueue );
\r
922 return errQUEUE_EMPTY;
\r
925 taskEXIT_CRITICAL();
\r
930 #endif /* configUSE_ALTERNATIVE_API */
\r
931 /*-----------------------------------------------------------*/
\r
933 signed portBASE_TYPE xQueueGenericSendFromISR( xQueueHandle xQueue, const void * const pvItemToQueue, signed portBASE_TYPE *pxHigherPriorityTaskWoken, portBASE_TYPE xCopyPosition )
\r
935 signed portBASE_TYPE xReturn;
\r
936 unsigned portBASE_TYPE uxSavedInterruptStatus;
\r
939 pxQueue = ( xQUEUE * ) xQueue;
\r
940 configASSERT( pxQueue );
\r
941 configASSERT( !( ( pvItemToQueue == NULL ) && ( pxQueue->uxItemSize != ( unsigned portBASE_TYPE ) 0U ) ) );
\r
942 configASSERT( !( ( xCopyPosition == queueOVERWRITE ) && ( pxQueue->uxLength != 1 ) ) );
\r
943 portASSERT_IF_INTERRUPT_PRIORITY_INVALID();
\r
945 /* Similar to xQueueGenericSend, except we don't block if there is no room
\r
946 in the queue. Also we don't directly wake a task that was blocked on a
\r
947 queue read, instead we return a flag to say whether a context switch is
\r
948 required or not (i.e. has a task with a higher priority than us been woken
\r
950 uxSavedInterruptStatus = portSET_INTERRUPT_MASK_FROM_ISR();
\r
952 if( ( pxQueue->uxMessagesWaiting < pxQueue->uxLength ) || ( xCopyPosition == queueOVERWRITE ) )
\r
954 traceQUEUE_SEND_FROM_ISR( pxQueue );
\r
956 prvCopyDataToQueue( pxQueue, pvItemToQueue, xCopyPosition );
\r
958 /* If the queue is locked we do not alter the event list. This will
\r
959 be done when the queue is unlocked later. */
\r
960 if( pxQueue->xTxLock == queueUNLOCKED )
\r
962 #if ( configUSE_QUEUE_SETS == 1 )
\r
964 if( pxQueue->pxQueueSetContainer != NULL )
\r
966 if( prvNotifyQueueSetContainer( pxQueue, xCopyPosition ) == pdTRUE )
\r
968 /* The queue is a member of a queue set, and posting
\r
969 to the queue set caused a higher priority task to
\r
970 unblock. A context switch is required. */
\r
971 if( pxHigherPriorityTaskWoken != NULL )
\r
973 *pxHigherPriorityTaskWoken = pdTRUE;
\r
979 if( listLIST_IS_EMPTY( &( pxQueue->xTasksWaitingToReceive ) ) == pdFALSE )
\r
981 if( xTaskRemoveFromEventList( &( pxQueue->xTasksWaitingToReceive ) ) != pdFALSE )
\r
983 /* The task waiting has a higher priority so record that a
\r
984 context switch is required. */
\r
985 if( pxHigherPriorityTaskWoken != NULL )
\r
987 *pxHigherPriorityTaskWoken = pdTRUE;
\r
993 #else /* configUSE_QUEUE_SETS */
\r
995 if( listLIST_IS_EMPTY( &( pxQueue->xTasksWaitingToReceive ) ) == pdFALSE )
\r
997 if( xTaskRemoveFromEventList( &( pxQueue->xTasksWaitingToReceive ) ) != pdFALSE )
\r
999 /* The task waiting has a higher priority so record that a
\r
1000 context switch is required. */
\r
1001 if( pxHigherPriorityTaskWoken != NULL )
\r
1003 *pxHigherPriorityTaskWoken = pdTRUE;
\r
1008 #endif /* configUSE_QUEUE_SETS */
\r
1012 /* Increment the lock count so the task that unlocks the queue
\r
1013 knows that data was posted while it was locked. */
\r
1014 ++( pxQueue->xTxLock );
\r
1021 traceQUEUE_SEND_FROM_ISR_FAILED( pxQueue );
\r
1022 xReturn = errQUEUE_FULL;
\r
1025 portCLEAR_INTERRUPT_MASK_FROM_ISR( uxSavedInterruptStatus );
\r
1029 /*-----------------------------------------------------------*/
\r
1031 signed portBASE_TYPE xQueueGenericReceive( xQueueHandle xQueue, void * const pvBuffer, portTickType xTicksToWait, portBASE_TYPE xJustPeeking )
\r
1033 signed portBASE_TYPE xEntryTimeSet = pdFALSE;
\r
1034 xTimeOutType xTimeOut;
\r
1035 signed char *pcOriginalReadPosition;
\r
1038 pxQueue = ( xQUEUE * ) xQueue;
\r
1039 configASSERT( pxQueue );
\r
1040 configASSERT( !( ( pvBuffer == NULL ) && ( pxQueue->uxItemSize != ( unsigned portBASE_TYPE ) 0U ) ) );
\r
1042 /* This function relaxes the coding standard somewhat to allow return
\r
1043 statements within the function itself. This is done in the interest
\r
1044 of execution time efficiency. */
\r
1048 taskENTER_CRITICAL();
\r
1050 /* Is there data in the queue now? To be running we must be
\r
1051 the highest priority task wanting to access the queue. */
\r
1052 if( pxQueue->uxMessagesWaiting > ( unsigned portBASE_TYPE ) 0 )
\r
1054 /* Remember the read position in case the queue is only being
\r
1056 pcOriginalReadPosition = pxQueue->u.pcReadFrom;
\r
1058 prvCopyDataFromQueue( pxQueue, pvBuffer );
\r
1060 if( xJustPeeking == pdFALSE )
\r
1062 traceQUEUE_RECEIVE( pxQueue );
\r
1064 /* Actually removing data, not just peeking. */
\r
1065 --( pxQueue->uxMessagesWaiting );
\r
1067 #if ( configUSE_MUTEXES == 1 )
\r
1069 if( pxQueue->uxQueueType == queueQUEUE_IS_MUTEX )
\r
1071 /* Record the information required to implement
\r
1072 priority inheritance should it become necessary. */
\r
1073 pxQueue->pxMutexHolder = ( void * ) xTaskGetCurrentTaskHandle();
\r
1078 if( listLIST_IS_EMPTY( &( pxQueue->xTasksWaitingToSend ) ) == pdFALSE )
\r
1080 if( xTaskRemoveFromEventList( &( pxQueue->xTasksWaitingToSend ) ) == pdTRUE )
\r
1082 portYIELD_WITHIN_API();
\r
1088 traceQUEUE_PEEK( pxQueue );
\r
1090 /* The data is not being removed, so reset the read
\r
1092 pxQueue->u.pcReadFrom = pcOriginalReadPosition;
\r
1094 /* The data is being left in the queue, so see if there are
\r
1095 any other tasks waiting for the data. */
\r
1096 if( listLIST_IS_EMPTY( &( pxQueue->xTasksWaitingToReceive ) ) == pdFALSE )
\r
1098 /* Tasks that are removed from the event list will get added to
\r
1099 the pending ready list as the scheduler is still suspended. */
\r
1100 if( xTaskRemoveFromEventList( &( pxQueue->xTasksWaitingToReceive ) ) != pdFALSE )
\r
1102 /* The task waiting has a higher priority than this task. */
\r
1103 portYIELD_WITHIN_API();
\r
1108 taskEXIT_CRITICAL();
\r
1113 if( xTicksToWait == ( portTickType ) 0 )
\r
1115 /* The queue was empty and no block time is specified (or
\r
1116 the block time has expired) so leave now. */
\r
1117 taskEXIT_CRITICAL();
\r
1118 traceQUEUE_RECEIVE_FAILED( pxQueue );
\r
1119 return errQUEUE_EMPTY;
\r
1121 else if( xEntryTimeSet == pdFALSE )
\r
1123 /* The queue was empty and a block time was specified so
\r
1124 configure the timeout structure. */
\r
1125 vTaskSetTimeOutState( &xTimeOut );
\r
1126 xEntryTimeSet = pdTRUE;
\r
1130 taskEXIT_CRITICAL();
\r
1132 /* Interrupts and other tasks can send to and receive from the queue
\r
1133 now the critical section has been exited. */
\r
1135 vTaskSuspendAll();
\r
1136 prvLockQueue( pxQueue );
\r
1138 /* Update the timeout state to see if it has expired yet. */
\r
1139 if( xTaskCheckForTimeOut( &xTimeOut, &xTicksToWait ) == pdFALSE )
\r
1141 if( prvIsQueueEmpty( pxQueue ) != pdFALSE )
\r
1143 traceBLOCKING_ON_QUEUE_RECEIVE( pxQueue );
\r
1145 #if ( configUSE_MUTEXES == 1 )
\r
1147 if( pxQueue->uxQueueType == queueQUEUE_IS_MUTEX )
\r
1149 portENTER_CRITICAL();
\r
1151 vTaskPriorityInherit( ( void * ) pxQueue->pxMutexHolder );
\r
1153 portEXIT_CRITICAL();
\r
1158 vTaskPlaceOnEventList( &( pxQueue->xTasksWaitingToReceive ), xTicksToWait );
\r
1159 prvUnlockQueue( pxQueue );
\r
1160 if( xTaskResumeAll() == pdFALSE )
\r
1162 portYIELD_WITHIN_API();
\r
1168 prvUnlockQueue( pxQueue );
\r
1169 ( void ) xTaskResumeAll();
\r
1174 prvUnlockQueue( pxQueue );
\r
1175 ( void ) xTaskResumeAll();
\r
1176 traceQUEUE_RECEIVE_FAILED( pxQueue );
\r
1177 return errQUEUE_EMPTY;
\r
1181 /*-----------------------------------------------------------*/
\r
1183 signed portBASE_TYPE xQueueReceiveFromISR( xQueueHandle xQueue, void * const pvBuffer, signed portBASE_TYPE *pxHigherPriorityTaskWoken )
\r
1185 signed portBASE_TYPE xReturn;
\r
1186 unsigned portBASE_TYPE uxSavedInterruptStatus;
\r
1189 pxQueue = ( xQUEUE * ) xQueue;
\r
1190 configASSERT( pxQueue );
\r
1191 configASSERT( !( ( pvBuffer == NULL ) && ( pxQueue->uxItemSize != ( unsigned portBASE_TYPE ) 0U ) ) );
\r
1192 portASSERT_IF_INTERRUPT_PRIORITY_INVALID();
\r
1194 uxSavedInterruptStatus = portSET_INTERRUPT_MASK_FROM_ISR();
\r
1196 /* Cannot block in an ISR, so check there is data available. */
\r
1197 if( pxQueue->uxMessagesWaiting > ( unsigned portBASE_TYPE ) 0 )
\r
1199 traceQUEUE_RECEIVE_FROM_ISR( pxQueue );
\r
1201 prvCopyDataFromQueue( pxQueue, pvBuffer );
\r
1202 --( pxQueue->uxMessagesWaiting );
\r
1204 /* If the queue is locked the event list will not be modified.
\r
1205 Instead update the lock count so the task that unlocks the queue
\r
1206 will know that an ISR has removed data while the queue was
\r
1208 if( pxQueue->xRxLock == queueUNLOCKED )
\r
1210 if( listLIST_IS_EMPTY( &( pxQueue->xTasksWaitingToSend ) ) == pdFALSE )
\r
1212 if( xTaskRemoveFromEventList( &( pxQueue->xTasksWaitingToSend ) ) != pdFALSE )
\r
1214 /* The task waiting has a higher priority than us so
\r
1215 force a context switch. */
\r
1216 if( pxHigherPriorityTaskWoken != NULL )
\r
1218 *pxHigherPriorityTaskWoken = pdTRUE;
\r
1225 /* Increment the lock count so the task that unlocks the queue
\r
1226 knows that data was removed while it was locked. */
\r
1227 ++( pxQueue->xRxLock );
\r
1235 traceQUEUE_RECEIVE_FROM_ISR_FAILED( pxQueue );
\r
1238 portCLEAR_INTERRUPT_MASK_FROM_ISR( uxSavedInterruptStatus );
\r
1242 /*-----------------------------------------------------------*/
\r
1244 signed portBASE_TYPE xQueuePeekFromISR( xQueueHandle xQueue, void * const pvBuffer )
\r
1246 signed portBASE_TYPE xReturn;
\r
1247 unsigned portBASE_TYPE uxSavedInterruptStatus;
\r
1248 signed char *pcOriginalReadPosition;
\r
1251 pxQueue = ( xQUEUE * ) xQueue;
\r
1252 configASSERT( pxQueue );
\r
1253 configASSERT( !( ( pvBuffer == NULL ) && ( pxQueue->uxItemSize != ( unsigned portBASE_TYPE ) 0U ) ) );
\r
1254 portASSERT_IF_INTERRUPT_PRIORITY_INVALID();
\r
1256 uxSavedInterruptStatus = portSET_INTERRUPT_MASK_FROM_ISR();
\r
1258 /* Cannot block in an ISR, so check there is data available. */
\r
1259 if( pxQueue->uxMessagesWaiting > ( unsigned portBASE_TYPE ) 0 )
\r
1261 traceQUEUE_PEEK_FROM_ISR( pxQueue );
\r
1263 /* Remember the read position so it can be reset as nothing is
\r
1264 actually being removed from the queue. */
\r
1265 pcOriginalReadPosition = pxQueue->u.pcReadFrom;
\r
1266 prvCopyDataFromQueue( pxQueue, pvBuffer );
\r
1267 pxQueue->u.pcReadFrom = pcOriginalReadPosition;
\r
1274 traceQUEUE_PEEK_FROM_ISR_FAILED( pxQueue );
\r
1277 portCLEAR_INTERRUPT_MASK_FROM_ISR( uxSavedInterruptStatus );
\r
1281 /*-----------------------------------------------------------*/
\r
1283 unsigned portBASE_TYPE uxQueueMessagesWaiting( const xQueueHandle xQueue )
\r
1285 unsigned portBASE_TYPE uxReturn;
\r
1287 configASSERT( xQueue );
\r
1289 taskENTER_CRITICAL();
\r
1290 uxReturn = ( ( xQUEUE * ) xQueue )->uxMessagesWaiting;
\r
1291 taskEXIT_CRITICAL();
\r
1295 /*-----------------------------------------------------------*/
\r
1297 unsigned portBASE_TYPE uxQueueMessagesWaitingFromISR( const xQueueHandle xQueue )
\r
1299 unsigned portBASE_TYPE uxReturn;
\r
1301 configASSERT( xQueue );
\r
1303 uxReturn = ( ( xQUEUE * ) xQueue )->uxMessagesWaiting;
\r
1307 /*-----------------------------------------------------------*/
\r
1309 void vQueueDelete( xQueueHandle xQueue )
\r
1313 pxQueue = ( xQUEUE * ) xQueue;
\r
1314 configASSERT( pxQueue );
\r
1316 traceQUEUE_DELETE( pxQueue );
\r
1317 #if ( configQUEUE_REGISTRY_SIZE > 0 )
\r
1319 vQueueUnregisterQueue( pxQueue );
\r
1322 vPortFree( pxQueue->pcHead );
\r
1323 vPortFree( pxQueue );
\r
1325 /*-----------------------------------------------------------*/
\r
1327 #if ( configUSE_TRACE_FACILITY == 1 )
\r
1329 unsigned char ucQueueGetQueueNumber( xQueueHandle xQueue )
\r
1331 return ( ( xQUEUE * ) xQueue )->ucQueueNumber;
\r
1334 #endif /* configUSE_TRACE_FACILITY */
\r
1335 /*-----------------------------------------------------------*/
\r
1337 #if ( configUSE_TRACE_FACILITY == 1 )
\r
1339 void vQueueSetQueueNumber( xQueueHandle xQueue, unsigned char ucQueueNumber )
\r
1341 ( ( xQUEUE * ) xQueue )->ucQueueNumber = ucQueueNumber;
\r
1344 #endif /* configUSE_TRACE_FACILITY */
\r
1345 /*-----------------------------------------------------------*/
\r
1347 #if ( configUSE_TRACE_FACILITY == 1 )
\r
1349 unsigned char ucQueueGetQueueType( xQueueHandle xQueue )
\r
1351 return ( ( xQUEUE * ) xQueue )->ucQueueType;
\r
1354 #endif /* configUSE_TRACE_FACILITY */
\r
1355 /*-----------------------------------------------------------*/
\r
1357 static void prvCopyDataToQueue( xQUEUE *pxQueue, const void *pvItemToQueue, portBASE_TYPE xPosition )
\r
1359 if( pxQueue->uxItemSize == ( unsigned portBASE_TYPE ) 0 )
\r
1361 #if ( configUSE_MUTEXES == 1 )
\r
1363 if( pxQueue->uxQueueType == queueQUEUE_IS_MUTEX )
\r
1365 /* The mutex is no longer being held. */
\r
1366 vTaskPriorityDisinherit( ( void * ) pxQueue->pxMutexHolder );
\r
1367 pxQueue->pxMutexHolder = NULL;
\r
1370 #endif /* configUSE_MUTEXES */
\r
1372 else if( xPosition == queueSEND_TO_BACK )
\r
1374 memcpy( ( void * ) pxQueue->pcWriteTo, pvItemToQueue, ( size_t ) pxQueue->uxItemSize );
\r
1375 pxQueue->pcWriteTo += pxQueue->uxItemSize;
\r
1376 if( pxQueue->pcWriteTo >= pxQueue->pcTail )
\r
1378 pxQueue->pcWriteTo = pxQueue->pcHead;
\r
1383 memcpy( ( void * ) pxQueue->u.pcReadFrom, pvItemToQueue, ( size_t ) pxQueue->uxItemSize );
\r
1384 pxQueue->u.pcReadFrom -= pxQueue->uxItemSize;
\r
1385 if( pxQueue->u.pcReadFrom < pxQueue->pcHead )
\r
1387 pxQueue->u.pcReadFrom = ( pxQueue->pcTail - pxQueue->uxItemSize );
\r
1390 if( xPosition == queueOVERWRITE )
\r
1392 if( pxQueue->uxMessagesWaiting > 0 )
\r
1394 /* An item is not being added but overwritten, so subtract
\r
1395 one from the recorded number of items in the queue so when
\r
1396 one is added again below the number of recorded items remains
\r
1398 --( pxQueue->uxMessagesWaiting );
\r
1403 ++( pxQueue->uxMessagesWaiting );
\r
1405 /*-----------------------------------------------------------*/
\r
1407 static void prvCopyDataFromQueue( xQUEUE * const pxQueue, const void *pvBuffer )
\r
1409 if( pxQueue->uxQueueType != queueQUEUE_IS_MUTEX )
\r
1411 pxQueue->u.pcReadFrom += pxQueue->uxItemSize;
\r
1412 if( pxQueue->u.pcReadFrom >= pxQueue->pcTail )
\r
1414 pxQueue->u.pcReadFrom = pxQueue->pcHead;
\r
1416 memcpy( ( void * ) pvBuffer, ( void * ) pxQueue->u.pcReadFrom, ( size_t ) pxQueue->uxItemSize );
\r
1419 /*-----------------------------------------------------------*/
\r
1421 static void prvUnlockQueue( xQUEUE *pxQueue )
\r
1423 /* THIS FUNCTION MUST BE CALLED WITH THE SCHEDULER SUSPENDED. */
\r
1425 /* The lock counts contains the number of extra data items placed or
\r
1426 removed from the queue while the queue was locked. When a queue is
\r
1427 locked items can be added or removed, but the event lists cannot be
\r
1429 taskENTER_CRITICAL();
\r
1431 /* See if data was added to the queue while it was locked. */
\r
1432 while( pxQueue->xTxLock > queueLOCKED_UNMODIFIED )
\r
1434 /* Data was posted while the queue was locked. Are any tasks
\r
1435 blocked waiting for data to become available? */
\r
1436 #if ( configUSE_QUEUE_SETS == 1 )
\r
1438 if( pxQueue->pxQueueSetContainer != NULL )
\r
1440 if( prvNotifyQueueSetContainer( pxQueue, queueSEND_TO_BACK ) == pdTRUE )
\r
1442 /* The queue is a member of a queue set, and posting to
\r
1443 the queue set caused a higher priority task to unblock.
\r
1444 A context switch is required. */
\r
1445 vTaskMissedYield();
\r
1450 /* Tasks that are removed from the event list will get added to
\r
1451 the pending ready list as the scheduler is still suspended. */
\r
1452 if( listLIST_IS_EMPTY( &( pxQueue->xTasksWaitingToReceive ) ) == pdFALSE )
\r
1454 if( xTaskRemoveFromEventList( &( pxQueue->xTasksWaitingToReceive ) ) != pdFALSE )
\r
1456 /* The task waiting has a higher priority so record that a
\r
1457 context switch is required. */
\r
1458 vTaskMissedYield();
\r
1467 #else /* configUSE_QUEUE_SETS */
\r
1469 /* Tasks that are removed from the event list will get added to
\r
1470 the pending ready list as the scheduler is still suspended. */
\r
1471 if( listLIST_IS_EMPTY( &( pxQueue->xTasksWaitingToReceive ) ) == pdFALSE )
\r
1473 if( xTaskRemoveFromEventList( &( pxQueue->xTasksWaitingToReceive ) ) != pdFALSE )
\r
1475 /* The task waiting has a higher priority so record that a
\r
1476 context switch is required. */
\r
1477 vTaskMissedYield();
\r
1485 #endif /* configUSE_QUEUE_SETS */
\r
1487 --( pxQueue->xTxLock );
\r
1490 pxQueue->xTxLock = queueUNLOCKED;
\r
1492 taskEXIT_CRITICAL();
\r
1494 /* Do the same for the Rx lock. */
\r
1495 taskENTER_CRITICAL();
\r
1497 while( pxQueue->xRxLock > queueLOCKED_UNMODIFIED )
\r
1499 if( listLIST_IS_EMPTY( &( pxQueue->xTasksWaitingToSend ) ) == pdFALSE )
\r
1501 if( xTaskRemoveFromEventList( &( pxQueue->xTasksWaitingToSend ) ) != pdFALSE )
\r
1503 vTaskMissedYield();
\r
1506 --( pxQueue->xRxLock );
\r
1514 pxQueue->xRxLock = queueUNLOCKED;
\r
1516 taskEXIT_CRITICAL();
\r
1518 /*-----------------------------------------------------------*/
\r
1520 static signed portBASE_TYPE prvIsQueueEmpty( const xQUEUE *pxQueue )
\r
1522 signed portBASE_TYPE xReturn;
\r
1524 taskENTER_CRITICAL();
\r
1526 if( pxQueue->uxMessagesWaiting == 0 )
\r
1532 xReturn = pdFALSE;
\r
1535 taskEXIT_CRITICAL();
\r
1539 /*-----------------------------------------------------------*/
\r
1541 signed portBASE_TYPE xQueueIsQueueEmptyFromISR( const xQueueHandle xQueue )
\r
1543 signed portBASE_TYPE xReturn;
\r
1545 configASSERT( xQueue );
\r
1546 if( ( ( xQUEUE * ) xQueue )->uxMessagesWaiting == 0 )
\r
1552 xReturn = pdFALSE;
\r
1557 /*-----------------------------------------------------------*/
\r
1559 static signed portBASE_TYPE prvIsQueueFull( const xQUEUE *pxQueue )
\r
1561 signed portBASE_TYPE xReturn;
\r
1563 taskENTER_CRITICAL();
\r
1565 if( pxQueue->uxMessagesWaiting == pxQueue->uxLength )
\r
1571 xReturn = pdFALSE;
\r
1574 taskEXIT_CRITICAL();
\r
1578 /*-----------------------------------------------------------*/
\r
1580 signed portBASE_TYPE xQueueIsQueueFullFromISR( const xQueueHandle xQueue )
\r
1582 signed portBASE_TYPE xReturn;
\r
1584 configASSERT( xQueue );
\r
1585 if( ( ( xQUEUE * ) xQueue )->uxMessagesWaiting == ( ( xQUEUE * ) xQueue )->uxLength )
\r
1591 xReturn = pdFALSE;
\r
1596 /*-----------------------------------------------------------*/
\r
1598 #if ( configUSE_CO_ROUTINES == 1 )
\r
1600 signed portBASE_TYPE xQueueCRSend( xQueueHandle xQueue, const void *pvItemToQueue, portTickType xTicksToWait )
\r
1602 signed portBASE_TYPE xReturn;
\r
1605 pxQueue = ( xQUEUE * ) xQueue;
\r
1607 /* If the queue is already full we may have to block. A critical section
\r
1608 is required to prevent an interrupt removing something from the queue
\r
1609 between the check to see if the queue is full and blocking on the queue. */
\r
1610 portDISABLE_INTERRUPTS();
\r
1612 if( prvIsQueueFull( pxQueue ) != pdFALSE )
\r
1614 /* The queue is full - do we want to block or just leave without
\r
1616 if( xTicksToWait > ( portTickType ) 0 )
\r
1618 /* As this is called from a coroutine we cannot block directly, but
\r
1619 return indicating that we need to block. */
\r
1620 vCoRoutineAddToDelayedList( xTicksToWait, &( pxQueue->xTasksWaitingToSend ) );
\r
1621 portENABLE_INTERRUPTS();
\r
1622 return errQUEUE_BLOCKED;
\r
1626 portENABLE_INTERRUPTS();
\r
1627 return errQUEUE_FULL;
\r
1631 portENABLE_INTERRUPTS();
\r
1633 portDISABLE_INTERRUPTS();
\r
1635 if( pxQueue->uxMessagesWaiting < pxQueue->uxLength )
\r
1637 /* There is room in the queue, copy the data into the queue. */
\r
1638 prvCopyDataToQueue( pxQueue, pvItemToQueue, queueSEND_TO_BACK );
\r
1641 /* Were any co-routines waiting for data to become available? */
\r
1642 if( listLIST_IS_EMPTY( &( pxQueue->xTasksWaitingToReceive ) ) == pdFALSE )
\r
1644 /* In this instance the co-routine could be placed directly
\r
1645 into the ready list as we are within a critical section.
\r
1646 Instead the same pending ready list mechanism is used as if
\r
1647 the event were caused from within an interrupt. */
\r
1648 if( xCoRoutineRemoveFromEventList( &( pxQueue->xTasksWaitingToReceive ) ) != pdFALSE )
\r
1650 /* The co-routine waiting has a higher priority so record
\r
1651 that a yield might be appropriate. */
\r
1652 xReturn = errQUEUE_YIELD;
\r
1658 xReturn = errQUEUE_FULL;
\r
1661 portENABLE_INTERRUPTS();
\r
1666 #endif /* configUSE_CO_ROUTINES */
\r
1667 /*-----------------------------------------------------------*/
\r
1669 #if ( configUSE_CO_ROUTINES == 1 )
\r
1671 signed portBASE_TYPE xQueueCRReceive( xQueueHandle xQueue, void *pvBuffer, portTickType xTicksToWait )
\r
1673 signed portBASE_TYPE xReturn;
\r
1676 pxQueue = ( xQUEUE * ) xQueue;
\r
1678 /* If the queue is already empty we may have to block. A critical section
\r
1679 is required to prevent an interrupt adding something to the queue
\r
1680 between the check to see if the queue is empty and blocking on the queue. */
\r
1681 portDISABLE_INTERRUPTS();
\r
1683 if( pxQueue->uxMessagesWaiting == ( unsigned portBASE_TYPE ) 0 )
\r
1685 /* There are no messages in the queue, do we want to block or just
\r
1686 leave with nothing? */
\r
1687 if( xTicksToWait > ( portTickType ) 0 )
\r
1689 /* As this is a co-routine we cannot block directly, but return
\r
1690 indicating that we need to block. */
\r
1691 vCoRoutineAddToDelayedList( xTicksToWait, &( pxQueue->xTasksWaitingToReceive ) );
\r
1692 portENABLE_INTERRUPTS();
\r
1693 return errQUEUE_BLOCKED;
\r
1697 portENABLE_INTERRUPTS();
\r
1698 return errQUEUE_FULL;
\r
1702 portENABLE_INTERRUPTS();
\r
1704 portDISABLE_INTERRUPTS();
\r
1706 if( pxQueue->uxMessagesWaiting > ( unsigned portBASE_TYPE ) 0 )
\r
1708 /* Data is available from the queue. */
\r
1709 pxQueue->u.pcReadFrom += pxQueue->uxItemSize;
\r
1710 if( pxQueue->u.pcReadFrom >= pxQueue->pcTail )
\r
1712 pxQueue->u.pcReadFrom = pxQueue->pcHead;
\r
1714 --( pxQueue->uxMessagesWaiting );
\r
1715 memcpy( ( void * ) pvBuffer, ( void * ) pxQueue->u.pcReadFrom, ( unsigned ) pxQueue->uxItemSize );
\r
1719 /* Were any co-routines waiting for space to become available? */
\r
1720 if( listLIST_IS_EMPTY( &( pxQueue->xTasksWaitingToSend ) ) == pdFALSE )
\r
1722 /* In this instance the co-routine could be placed directly
\r
1723 into the ready list as we are within a critical section.
\r
1724 Instead the same pending ready list mechanism is used as if
\r
1725 the event were caused from within an interrupt. */
\r
1726 if( xCoRoutineRemoveFromEventList( &( pxQueue->xTasksWaitingToSend ) ) != pdFALSE )
\r
1728 xReturn = errQUEUE_YIELD;
\r
1737 portENABLE_INTERRUPTS();
\r
1742 #endif /* configUSE_CO_ROUTINES */
\r
1743 /*-----------------------------------------------------------*/
\r
1745 #if ( configUSE_CO_ROUTINES == 1 )
\r
1747 signed portBASE_TYPE xQueueCRSendFromISR( xQueueHandle xQueue, const void *pvItemToQueue, signed portBASE_TYPE xCoRoutinePreviouslyWoken )
\r
1751 pxQueue = ( xQUEUE * ) xQueue;
\r
1753 /* Cannot block within an ISR so if there is no space on the queue then
\r
1754 exit without doing anything. */
\r
1755 if( pxQueue->uxMessagesWaiting < pxQueue->uxLength )
\r
1757 prvCopyDataToQueue( pxQueue, pvItemToQueue, queueSEND_TO_BACK );
\r
1759 /* We only want to wake one co-routine per ISR, so check that a
\r
1760 co-routine has not already been woken. */
\r
1761 if( xCoRoutinePreviouslyWoken == pdFALSE )
\r
1763 if( listLIST_IS_EMPTY( &( pxQueue->xTasksWaitingToReceive ) ) == pdFALSE )
\r
1765 if( xCoRoutineRemoveFromEventList( &( pxQueue->xTasksWaitingToReceive ) ) != pdFALSE )
\r
1773 return xCoRoutinePreviouslyWoken;
\r
1776 #endif /* configUSE_CO_ROUTINES */
\r
1777 /*-----------------------------------------------------------*/
\r
1779 #if ( configUSE_CO_ROUTINES == 1 )
\r
1781 signed portBASE_TYPE xQueueCRReceiveFromISR( xQueueHandle xQueue, void *pvBuffer, signed portBASE_TYPE *pxCoRoutineWoken )
\r
1783 signed portBASE_TYPE xReturn;
\r
1786 pxQueue = ( xQUEUE * ) xQueue;
\r
1788 /* We cannot block from an ISR, so check there is data available. If
\r
1789 not then just leave without doing anything. */
\r
1790 if( pxQueue->uxMessagesWaiting > ( unsigned portBASE_TYPE ) 0 )
\r
1792 /* Copy the data from the queue. */
\r
1793 pxQueue->u.pcReadFrom += pxQueue->uxItemSize;
\r
1794 if( pxQueue->u.pcReadFrom >= pxQueue->pcTail )
\r
1796 pxQueue->u.pcReadFrom = pxQueue->pcHead;
\r
1798 --( pxQueue->uxMessagesWaiting );
\r
1799 memcpy( ( void * ) pvBuffer, ( void * ) pxQueue->u.pcReadFrom, ( unsigned ) pxQueue->uxItemSize );
\r
1801 if( ( *pxCoRoutineWoken ) == pdFALSE )
\r
1803 if( listLIST_IS_EMPTY( &( pxQueue->xTasksWaitingToSend ) ) == pdFALSE )
\r
1805 if( xCoRoutineRemoveFromEventList( &( pxQueue->xTasksWaitingToSend ) ) != pdFALSE )
\r
1807 *pxCoRoutineWoken = pdTRUE;
\r
1822 #endif /* configUSE_CO_ROUTINES */
\r
1823 /*-----------------------------------------------------------*/
\r
1825 #if ( configQUEUE_REGISTRY_SIZE > 0 )
\r
1827 void vQueueAddToRegistry( xQueueHandle xQueue, signed char *pcQueueName )
\r
1829 unsigned portBASE_TYPE ux;
\r
1831 /* See if there is an empty space in the registry. A NULL name denotes
\r
1833 for( ux = ( unsigned portBASE_TYPE ) 0U; ux < ( unsigned portBASE_TYPE ) configQUEUE_REGISTRY_SIZE; ux++ )
\r
1835 if( xQueueRegistry[ ux ].pcQueueName == NULL )
\r
1837 /* Store the information on this queue. */
\r
1838 xQueueRegistry[ ux ].pcQueueName = pcQueueName;
\r
1839 xQueueRegistry[ ux ].xHandle = xQueue;
\r
1845 #endif /* configQUEUE_REGISTRY_SIZE */
\r
1846 /*-----------------------------------------------------------*/
\r
1848 #if ( configQUEUE_REGISTRY_SIZE > 0 )
\r
1850 void vQueueUnregisterQueue( xQueueHandle xQueue )
\r
1852 unsigned portBASE_TYPE ux;
\r
1854 /* See if the handle of the queue being unregistered in actually in the
\r
1856 for( ux = ( unsigned portBASE_TYPE ) 0U; ux < ( unsigned portBASE_TYPE ) configQUEUE_REGISTRY_SIZE; ux++ )
\r
1858 if( xQueueRegistry[ ux ].xHandle == xQueue )
\r
1860 /* Set the name to NULL to show that this slot if free again. */
\r
1861 xQueueRegistry[ ux ].pcQueueName = NULL;
\r
1868 #endif /* configQUEUE_REGISTRY_SIZE */
\r
1869 /*-----------------------------------------------------------*/
\r
1871 #if ( configUSE_TIMERS == 1 )
\r
1873 void vQueueWaitForMessageRestricted( xQueueHandle xQueue, portTickType xTicksToWait )
\r
1877 pxQueue = ( xQUEUE * ) xQueue;
\r
1879 /* This function should not be called by application code hence the
\r
1880 'Restricted' in its name. It is not part of the public API. It is
\r
1881 designed for use by kernel code, and has special calling requirements.
\r
1882 It can result in vListInsert() being called on a list that can only
\r
1883 possibly ever have one item in it, so the list will be fast, but even
\r
1884 so it should be called with the scheduler locked and not from a critical
\r
1887 /* Only do anything if there are no messages in the queue. This function
\r
1888 will not actually cause the task to block, just place it on a blocked
\r
1889 list. It will not block until the scheduler is unlocked - at which
\r
1890 time a yield will be performed. If an item is added to the queue while
\r
1891 the queue is locked, and the calling task blocks on the queue, then the
\r
1892 calling task will be immediately unblocked when the queue is unlocked. */
\r
1893 prvLockQueue( pxQueue );
\r
1894 if( pxQueue->uxMessagesWaiting == ( unsigned portBASE_TYPE ) 0U )
\r
1896 /* There is nothing in the queue, block for the specified period. */
\r
1897 vTaskPlaceOnEventListRestricted( &( pxQueue->xTasksWaitingToReceive ), xTicksToWait );
\r
1899 prvUnlockQueue( pxQueue );
\r
1902 #endif /* configUSE_TIMERS */
\r
1903 /*-----------------------------------------------------------*/
\r
1905 #if ( configUSE_QUEUE_SETS == 1 )
\r
1907 xQueueSetHandle xQueueCreateSet( unsigned portBASE_TYPE uxEventQueueLength )
\r
1909 xQueueSetHandle pxQueue;
\r
1911 pxQueue = xQueueGenericCreate( uxEventQueueLength, sizeof( xQUEUE * ), queueQUEUE_TYPE_SET );
\r
1916 #endif /* configUSE_QUEUE_SETS */
\r
1917 /*-----------------------------------------------------------*/
\r
1919 #if ( configUSE_QUEUE_SETS == 1 )
\r
1921 portBASE_TYPE xQueueAddToSet( xQueueSetMemberHandle xQueueOrSemaphore, xQueueSetHandle xQueueSet )
\r
1923 portBASE_TYPE xReturn;
\r
1925 if( ( ( xQUEUE * ) xQueueOrSemaphore )->pxQueueSetContainer != NULL )
\r
1927 /* Cannot add a queue/semaphore to more than one queue set. */
\r
1930 else if( ( ( xQUEUE * ) xQueueOrSemaphore )->uxMessagesWaiting != 0 )
\r
1932 /* Cannot add a queue/semaphore to a queue set if there are already
\r
1933 items in the queue/semaphore. */
\r
1938 taskENTER_CRITICAL();
\r
1940 ( ( xQUEUE * ) xQueueOrSemaphore )->pxQueueSetContainer = xQueueSet;
\r
1942 taskEXIT_CRITICAL();
\r
1949 #endif /* configUSE_QUEUE_SETS */
\r
1950 /*-----------------------------------------------------------*/
\r
1952 #if ( configUSE_QUEUE_SETS == 1 )
\r
1954 portBASE_TYPE xQueueRemoveFromSet( xQueueSetMemberHandle xQueueOrSemaphore, xQueueSetHandle xQueueSet )
\r
1956 portBASE_TYPE xReturn;
\r
1957 xQUEUE *pxQueueOrSemaphore;
\r
1959 pxQueueOrSemaphore = ( xQUEUE * ) xQueueOrSemaphore;
\r
1961 if( pxQueueOrSemaphore->pxQueueSetContainer != xQueueSet )
\r
1963 /* The queue was not a member of the set. */
\r
1966 else if( pxQueueOrSemaphore->uxMessagesWaiting != 0 )
\r
1968 /* It is dangerous to remove a queue from a set when the queue is
\r
1969 not empty because the queue set will still hold pending events for
\r
1975 taskENTER_CRITICAL();
\r
1977 /* The queue is no longer contained in the set. */
\r
1978 pxQueueOrSemaphore->pxQueueSetContainer = NULL;
\r
1980 taskEXIT_CRITICAL();
\r
1987 #endif /* configUSE_QUEUE_SETS */
\r
1988 /*-----------------------------------------------------------*/
\r
1990 #if ( configUSE_QUEUE_SETS == 1 )
\r
1992 xQueueSetMemberHandle xQueueSelectFromSet( xQueueSetHandle xQueueSet, portTickType xBlockTimeTicks )
\r
1994 xQueueSetMemberHandle xReturn = NULL;
\r
1996 xQueueGenericReceive( ( xQueueHandle ) xQueueSet, &xReturn, xBlockTimeTicks, pdFALSE );
\r
2000 #endif /* configUSE_QUEUE_SETS */
\r
2001 /*-----------------------------------------------------------*/
\r
2003 #if ( configUSE_QUEUE_SETS == 1 )
\r
2005 xQueueSetMemberHandle xQueueSelectFromSetFromISR( xQueueSetHandle xQueueSet )
\r
2007 xQueueSetMemberHandle xReturn = NULL;
\r
2009 xQueueReceiveFromISR( ( xQueueHandle ) xQueueSet, &xReturn, NULL );
\r
2013 #endif /* configUSE_QUEUE_SETS */
\r
2014 /*-----------------------------------------------------------*/
\r
2016 #if ( configUSE_QUEUE_SETS == 1 )
\r
2018 static portBASE_TYPE prvNotifyQueueSetContainer( xQUEUE *pxQueue, portBASE_TYPE xCopyPosition )
\r
2020 xQUEUE *pxQueueSetContainer = pxQueue->pxQueueSetContainer;
\r
2021 portBASE_TYPE xReturn = pdFALSE;
\r
2023 configASSERT( pxQueueSetContainer );
\r
2024 configASSERT( pxQueueSetContainer->uxMessagesWaiting < pxQueueSetContainer->uxLength );
\r
2026 if( pxQueueSetContainer->uxMessagesWaiting < pxQueueSetContainer->uxLength )
\r
2028 traceQUEUE_SEND( pxQueueSetContainer );
\r
2029 /* The data copies is the handle of the queue that contains data. */
\r
2030 prvCopyDataToQueue( pxQueueSetContainer, &pxQueue, xCopyPosition );
\r
2031 if( listLIST_IS_EMPTY( &( pxQueueSetContainer->xTasksWaitingToReceive ) ) == pdFALSE )
\r
2033 if( xTaskRemoveFromEventList( &( pxQueueSetContainer->xTasksWaitingToReceive ) ) != pdFALSE )
\r
2035 /* The task waiting has a higher priority */
\r
2044 #endif /* configUSE_QUEUE_SETS */
\r