2 * FreeRTOS Kernel <DEVELOPMENT BRANCH>
3 * Copyright (C) 2021 Amazon.com, Inc. or its affiliates. All Rights Reserved.
5 * SPDX-License-Identifier: MIT
7 * Permission is hereby granted, free of charge, to any person obtaining a copy of
8 * this software and associated documentation files (the "Software"), to deal in
9 * the Software without restriction, including without limitation the rights to
10 * use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies of
11 * the Software, and to permit persons to whom the Software is furnished to do so,
12 * subject to the following conditions:
14 * The above copyright notice and this permission notice shall be included in all
15 * copies or substantial portions of the Software.
17 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
18 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS
19 * FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR
20 * COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER
21 * IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
22 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
24 * https://www.FreeRTOS.org
25 * https://github.com/FreeRTOS
29 /* Standard includes. */
32 /* Defining MPU_WRAPPERS_INCLUDED_FROM_API_FILE prevents task.h from redefining
33 * all the API functions to use the MPU wrappers. That should only be done when
34 * task.h is included from an application file. */
35 #define MPU_WRAPPERS_INCLUDED_FROM_API_FILE
37 /* FreeRTOS includes. */
40 #include "stream_buffer.h"
42 #if ( configUSE_TASK_NOTIFICATIONS != 1 )
43 #error configUSE_TASK_NOTIFICATIONS must be set to 1 to build stream_buffer.c
46 #if ( INCLUDE_xTaskGetCurrentTaskHandle != 1 )
47 #error INCLUDE_xTaskGetCurrentTaskHandle must be set to 1 to build stream_buffer.c
50 /* Lint e961, e9021 and e750 are suppressed as a MISRA exception justified
51 * because the MPU ports require MPU_WRAPPERS_INCLUDED_FROM_API_FILE to be defined
52 * for the header files above, but not in this file, in order to generate the
53 * correct privileged Vs unprivileged linkage and placement. */
54 #undef MPU_WRAPPERS_INCLUDED_FROM_API_FILE /*lint !e961 !e750 !e9021. */
56 /* If the user has not provided application specific Rx notification macros,
57 * or #defined the notification macros away, then provide default implementations
58 * that uses task notifications. */
59 /*lint -save -e9026 Function like macros allowed and needed here so they can be overridden. */
60 #ifndef sbRECEIVE_COMPLETED
61 #define sbRECEIVE_COMPLETED( pxStreamBuffer ) \
64 if( ( pxStreamBuffer )->xTaskWaitingToSend != NULL ) \
66 ( void ) xTaskNotify( ( pxStreamBuffer )->xTaskWaitingToSend, \
69 ( pxStreamBuffer )->xTaskWaitingToSend = NULL; \
72 ( void ) xTaskResumeAll()
73 #endif /* sbRECEIVE_COMPLETED */
75 /* If user has provided a per-instance receive complete callback, then
76 * invoke the callback else use the receive complete macro which is provided by default for all instances.
78 #if ( configUSE_SB_COMPLETED_CALLBACK == 1 )
79 #define prvRECEIVE_COMPLETED( pxStreamBuffer ) \
81 if( ( pxStreamBuffer )->pxReceiveCompletedCallback != NULL ) \
83 ( pxStreamBuffer )->pxReceiveCompletedCallback( ( pxStreamBuffer ), pdFALSE, NULL ); \
87 sbRECEIVE_COMPLETED( ( pxStreamBuffer ) ); \
90 #else /* if ( configUSE_SB_COMPLETED_CALLBACK == 1 ) */
91 #define prvRECEIVE_COMPLETED( pxStreamBuffer ) sbRECEIVE_COMPLETED( ( pxStreamBuffer ) )
92 #endif /* if ( configUSE_SB_COMPLETED_CALLBACK == 1 ) */
94 #ifndef sbRECEIVE_COMPLETED_FROM_ISR
95 #define sbRECEIVE_COMPLETED_FROM_ISR( pxStreamBuffer, \
96 pxHigherPriorityTaskWoken ) \
98 UBaseType_t uxSavedInterruptStatus; \
100 uxSavedInterruptStatus = taskENTER_CRITICAL_FROM_ISR(); \
102 if( ( pxStreamBuffer )->xTaskWaitingToSend != NULL ) \
104 ( void ) xTaskNotifyFromISR( ( pxStreamBuffer )->xTaskWaitingToSend, \
107 ( pxHigherPriorityTaskWoken ) ); \
108 ( pxStreamBuffer )->xTaskWaitingToSend = NULL; \
111 taskEXIT_CRITICAL_FROM_ISR( uxSavedInterruptStatus ); \
113 #endif /* sbRECEIVE_COMPLETED_FROM_ISR */
115 #if ( configUSE_SB_COMPLETED_CALLBACK == 1 )
116 #define prvRECEIVE_COMPLETED_FROM_ISR( pxStreamBuffer, \
117 pxHigherPriorityTaskWoken ) \
119 if( ( pxStreamBuffer )->pxReceiveCompletedCallback != NULL ) \
121 ( pxStreamBuffer )->pxReceiveCompletedCallback( ( pxStreamBuffer ), pdTRUE, ( pxHigherPriorityTaskWoken ) ); \
125 sbRECEIVE_COMPLETED_FROM_ISR( ( pxStreamBuffer ), ( pxHigherPriorityTaskWoken ) ); \
128 #else /* if ( configUSE_SB_COMPLETED_CALLBACK == 1 ) */
129 #define prvRECEIVE_COMPLETED_FROM_ISR( pxStreamBuffer, pxHigherPriorityTaskWoken ) \
130 sbRECEIVE_COMPLETED_FROM_ISR( ( pxStreamBuffer ), ( pxHigherPriorityTaskWoken ) )
131 #endif /* if ( configUSE_SB_COMPLETED_CALLBACK == 1 ) */
133 /* If the user has not provided an application specific Tx notification macro,
134 * or #defined the notification macro away, then provide a default
135 * implementation that uses task notifications.
137 #ifndef sbSEND_COMPLETED
138 #define sbSEND_COMPLETED( pxStreamBuffer ) \
141 if( ( pxStreamBuffer )->xTaskWaitingToReceive != NULL ) \
143 ( void ) xTaskNotify( ( pxStreamBuffer )->xTaskWaitingToReceive, \
146 ( pxStreamBuffer )->xTaskWaitingToReceive = NULL; \
149 ( void ) xTaskResumeAll()
150 #endif /* sbSEND_COMPLETED */
152 /* If user has provided a per-instance send completed callback, then
153 * invoke the callback else use the send complete macro which is provided by default for all instances.
155 #if ( configUSE_SB_COMPLETED_CALLBACK == 1 )
156 #define prvSEND_COMPLETED( pxStreamBuffer ) \
158 if( ( pxStreamBuffer )->pxSendCompletedCallback != NULL ) \
160 ( pxStreamBuffer )->pxSendCompletedCallback( ( pxStreamBuffer ), pdFALSE, NULL ); \
164 sbSEND_COMPLETED( ( pxStreamBuffer ) ); \
167 #else /* if ( configUSE_SB_COMPLETED_CALLBACK == 1 ) */
168 #define prvSEND_COMPLETED( pxStreamBuffer ) sbSEND_COMPLETED( ( pxStreamBuffer ) )
169 #endif /* if ( configUSE_SB_COMPLETED_CALLBACK == 1 ) */
172 #ifndef sbSEND_COMPLETE_FROM_ISR
173 #define sbSEND_COMPLETE_FROM_ISR( pxStreamBuffer, pxHigherPriorityTaskWoken ) \
175 UBaseType_t uxSavedInterruptStatus; \
177 uxSavedInterruptStatus = taskENTER_CRITICAL_FROM_ISR(); \
179 if( ( pxStreamBuffer )->xTaskWaitingToReceive != NULL ) \
181 ( void ) xTaskNotifyFromISR( ( pxStreamBuffer )->xTaskWaitingToReceive, \
184 ( pxHigherPriorityTaskWoken ) ); \
185 ( pxStreamBuffer )->xTaskWaitingToReceive = NULL; \
188 taskEXIT_CRITICAL_FROM_ISR( uxSavedInterruptStatus ); \
190 #endif /* sbSEND_COMPLETE_FROM_ISR */
193 #if ( configUSE_SB_COMPLETED_CALLBACK == 1 )
194 #define prvSEND_COMPLETE_FROM_ISR( pxStreamBuffer, pxHigherPriorityTaskWoken ) \
196 if( ( pxStreamBuffer )->pxSendCompletedCallback != NULL ) \
198 ( pxStreamBuffer )->pxSendCompletedCallback( ( pxStreamBuffer ), pdTRUE, ( pxHigherPriorityTaskWoken ) ); \
202 sbSEND_COMPLETE_FROM_ISR( ( pxStreamBuffer ), ( pxHigherPriorityTaskWoken ) ); \
205 #else /* if ( configUSE_SB_COMPLETED_CALLBACK == 1 ) */
206 #define prvSEND_COMPLETE_FROM_ISR( pxStreamBuffer, pxHigherPriorityTaskWoken ) \
207 sbSEND_COMPLETE_FROM_ISR( ( pxStreamBuffer ), ( pxHigherPriorityTaskWoken ) )
208 #endif /* if ( configUSE_SB_COMPLETED_CALLBACK == 1 ) */
210 /*lint -restore (9026) */
212 /* The number of bytes used to hold the length of a message in the buffer. */
213 #define sbBYTES_TO_STORE_MESSAGE_LENGTH ( sizeof( configMESSAGE_BUFFER_LENGTH_TYPE ) )
215 /* Bits stored in the ucFlags field of the stream buffer. */
216 #define sbFLAGS_IS_MESSAGE_BUFFER ( ( uint8_t ) 1 ) /* Set if the stream buffer was created as a message buffer, in which case it holds discrete messages rather than a stream. */
217 #define sbFLAGS_IS_STATICALLY_ALLOCATED ( ( uint8_t ) 2 ) /* Set if the stream buffer was created using statically allocated memory. */
219 /*-----------------------------------------------------------*/
221 /* Structure that hold state information on the buffer. */
222 typedef struct StreamBufferDef_t /*lint !e9058 Style convention uses tag. */
224 volatile size_t xTail; /* Index to the next item to read within the buffer. */
225 volatile size_t xHead; /* Index to the next item to write within the buffer. */
226 size_t xLength; /* The length of the buffer pointed to by pucBuffer. */
227 size_t xTriggerLevelBytes; /* The number of bytes that must be in the stream buffer before a task that is waiting for data is unblocked. */
228 volatile TaskHandle_t xTaskWaitingToReceive; /* Holds the handle of a task waiting for data, or NULL if no tasks are waiting. */
229 volatile TaskHandle_t xTaskWaitingToSend; /* Holds the handle of a task waiting to send data to a message buffer that is full. */
230 uint8_t * pucBuffer; /* Points to the buffer itself - that is - the RAM that stores the data passed through the buffer. */
233 #if ( configUSE_TRACE_FACILITY == 1 )
234 UBaseType_t uxStreamBufferNumber; /* Used for tracing purposes. */
237 #if ( configUSE_SB_COMPLETED_CALLBACK == 1 )
238 StreamBufferCallbackFunction_t pxSendCompletedCallback; /* Optional callback called on send complete. sbSEND_COMPLETED is called if this is NULL. */
239 StreamBufferCallbackFunction_t pxReceiveCompletedCallback; /* Optional callback called on receive complete. sbRECEIVE_COMPLETED is called if this is NULL. */
244 * The number of bytes available to be read from the buffer.
246 static size_t prvBytesInBuffer( const StreamBuffer_t * const pxStreamBuffer ) PRIVILEGED_FUNCTION;
249 * Add xCount bytes from pucData into the pxStreamBuffer's data storage area.
250 * This function does not update the buffer's xHead pointer, so multiple writes
251 * may be chained together "atomically". This is useful for Message Buffers where
252 * the length and data bytes are written in two separate chunks, and we don't want
253 * the reader to see the buffer as having grown until after all data is copied over.
254 * This function takes a custom xHead value to indicate where to write to (necessary
255 * for chaining) and returns the the resulting xHead position.
256 * To mark the write as complete, manually set the buffer's xHead field with the
257 * returned xHead from this function.
259 static size_t prvWriteBytesToBuffer( StreamBuffer_t * const pxStreamBuffer,
260 const uint8_t * pucData,
262 size_t xHead ) PRIVILEGED_FUNCTION;
265 * If the stream buffer is being used as a message buffer, then reads an entire
266 * message out of the buffer. If the stream buffer is being used as a stream
267 * buffer then read as many bytes as possible from the buffer.
268 * prvReadBytesFromBuffer() is called to actually extract the bytes from the
269 * buffer's data storage area.
271 static size_t prvReadMessageFromBuffer( StreamBuffer_t * pxStreamBuffer,
273 size_t xBufferLengthBytes,
274 size_t xBytesAvailable ) PRIVILEGED_FUNCTION;
277 * If the stream buffer is being used as a message buffer, then writes an entire
278 * message to the buffer. If the stream buffer is being used as a stream
279 * buffer then write as many bytes as possible to the buffer.
280 * prvWriteBytestoBuffer() is called to actually send the bytes to the buffer's
283 static size_t prvWriteMessageToBuffer( StreamBuffer_t * const pxStreamBuffer,
284 const void * pvTxData,
285 size_t xDataLengthBytes,
287 size_t xRequiredSpace ) PRIVILEGED_FUNCTION;
290 * Copies xCount bytes from the pxStreamBuffer's data storage area to pucData.
291 * This function does not update the buffer's xTail pointer, so multiple reads
292 * may be chained together "atomically". This is useful for Message Buffers where
293 * the length and data bytes are read in two separate chunks, and we don't want
294 * the writer to see the buffer as having more free space until after all data is
295 * copied over, especially if we have to abort the read due to insufficient receiving space.
296 * This function takes a custom xTail value to indicate where to read from (necessary
297 * for chaining) and returns the the resulting xTail position.
298 * To mark the read as complete, manually set the buffer's xTail field with the
299 * returned xTail from this function.
301 static size_t prvReadBytesFromBuffer( StreamBuffer_t * pxStreamBuffer,
304 size_t xTail ) PRIVILEGED_FUNCTION;
307 * Called by both pxStreamBufferCreate() and pxStreamBufferCreateStatic() to
308 * initialise the members of the newly created stream buffer structure.
310 static void prvInitialiseNewStreamBuffer( StreamBuffer_t * const pxStreamBuffer,
311 uint8_t * const pucBuffer,
312 size_t xBufferSizeBytes,
313 size_t xTriggerLevelBytes,
315 StreamBufferCallbackFunction_t pxSendCompletedCallback,
316 StreamBufferCallbackFunction_t pxReceiveCompletedCallback ) PRIVILEGED_FUNCTION;
318 /*-----------------------------------------------------------*/
319 #if ( configSUPPORT_DYNAMIC_ALLOCATION == 1 )
320 StreamBufferHandle_t xStreamBufferGenericCreate( size_t xBufferSizeBytes,
321 size_t xTriggerLevelBytes,
322 BaseType_t xIsMessageBuffer,
323 StreamBufferCallbackFunction_t pxSendCompletedCallback,
324 StreamBufferCallbackFunction_t pxReceiveCompletedCallback )
326 void * pvAllocatedMemory;
329 traceENTER_xStreamBufferGenericCreate( xBufferSizeBytes, xTriggerLevelBytes, xIsMessageBuffer, pxSendCompletedCallback, pxReceiveCompletedCallback );
331 /* In case the stream buffer is going to be used as a message buffer
332 * (that is, it will hold discrete messages with a little meta data that
333 * says how big the next message is) check the buffer will be large enough
334 * to hold at least one message. */
335 if( xIsMessageBuffer == pdTRUE )
337 /* Is a message buffer but not statically allocated. */
338 ucFlags = sbFLAGS_IS_MESSAGE_BUFFER;
339 configASSERT( xBufferSizeBytes > sbBYTES_TO_STORE_MESSAGE_LENGTH );
343 /* Not a message buffer and not statically allocated. */
345 configASSERT( xBufferSizeBytes > 0 );
348 configASSERT( xTriggerLevelBytes <= xBufferSizeBytes );
350 /* A trigger level of 0 would cause a waiting task to unblock even when
351 * the buffer was empty. */
352 if( xTriggerLevelBytes == ( size_t ) 0 )
354 xTriggerLevelBytes = ( size_t ) 1;
357 /* A stream buffer requires a StreamBuffer_t structure and a buffer.
358 * Both are allocated in a single call to pvPortMalloc(). The
359 * StreamBuffer_t structure is placed at the start of the allocated memory
360 * and the buffer follows immediately after. The requested size is
361 * incremented so the free space is returned as the user would expect -
362 * this is a quirk of the implementation that means otherwise the free
363 * space would be reported as one byte smaller than would be logically
365 if( xBufferSizeBytes < ( xBufferSizeBytes + 1U + sizeof( StreamBuffer_t ) ) )
368 pvAllocatedMemory = pvPortMalloc( xBufferSizeBytes + sizeof( StreamBuffer_t ) );
372 pvAllocatedMemory = NULL;
375 if( pvAllocatedMemory != NULL )
377 /* MISRA Ref 11.5.1 [Malloc memory assignment] */
378 /* More details at: https://github.com/FreeRTOS/FreeRTOS-Kernel/blob/main/MISRA.md#rule-115 */
379 /* coverity[misra_c_2012_rule_11_5_violation] */
380 prvInitialiseNewStreamBuffer( ( StreamBuffer_t * ) pvAllocatedMemory, /* Structure at the start of the allocated memory. */
381 /* MISRA Ref 11.5.1 [Malloc memory assignment] */
382 /* More details at: https://github.com/FreeRTOS/FreeRTOS-Kernel/blob/main/MISRA.md#rule-115 */
383 /* coverity[misra_c_2012_rule_11_5_violation] */
384 ( ( uint8_t * ) pvAllocatedMemory ) + sizeof( StreamBuffer_t ), /* Storage area follows. */
388 pxSendCompletedCallback,
389 pxReceiveCompletedCallback );
391 traceSTREAM_BUFFER_CREATE( ( ( StreamBuffer_t * ) pvAllocatedMemory ), xIsMessageBuffer );
395 traceSTREAM_BUFFER_CREATE_FAILED( xIsMessageBuffer );
398 traceRETURN_xStreamBufferGenericCreate( pvAllocatedMemory );
400 /* MISRA Ref 11.5.1 [Malloc memory assignment] */
401 /* More details at: https://github.com/FreeRTOS/FreeRTOS-Kernel/blob/main/MISRA.md#rule-115 */
402 /* coverity[misra_c_2012_rule_11_5_violation] */
403 return ( StreamBufferHandle_t ) pvAllocatedMemory;
405 #endif /* configSUPPORT_DYNAMIC_ALLOCATION */
406 /*-----------------------------------------------------------*/
408 #if ( configSUPPORT_STATIC_ALLOCATION == 1 )
410 StreamBufferHandle_t xStreamBufferGenericCreateStatic( size_t xBufferSizeBytes,
411 size_t xTriggerLevelBytes,
412 BaseType_t xIsMessageBuffer,
413 uint8_t * const pucStreamBufferStorageArea,
414 StaticStreamBuffer_t * const pxStaticStreamBuffer,
415 StreamBufferCallbackFunction_t pxSendCompletedCallback,
416 StreamBufferCallbackFunction_t pxReceiveCompletedCallback )
418 /* MISRA Ref 11.3.1 [Misaligned access] */
419 /* More details at: https://github.com/FreeRTOS/FreeRTOS-Kernel/blob/main/MISRA.md#rule-113 */
420 /* coverity[misra_c_2012_rule_11_3_violation] */
421 StreamBuffer_t * const pxStreamBuffer = ( StreamBuffer_t * ) pxStaticStreamBuffer;
422 StreamBufferHandle_t xReturn;
425 traceENTER_xStreamBufferGenericCreateStatic( xBufferSizeBytes, xTriggerLevelBytes, xIsMessageBuffer, pucStreamBufferStorageArea, pxStaticStreamBuffer, pxSendCompletedCallback, pxReceiveCompletedCallback );
427 configASSERT( pucStreamBufferStorageArea );
428 configASSERT( pxStaticStreamBuffer );
429 configASSERT( xTriggerLevelBytes <= xBufferSizeBytes );
431 /* A trigger level of 0 would cause a waiting task to unblock even when
432 * the buffer was empty. */
433 if( xTriggerLevelBytes == ( size_t ) 0 )
435 xTriggerLevelBytes = ( size_t ) 1;
438 /* In case the stream buffer is going to be used as a message buffer
439 * (that is, it will hold discrete messages with a little meta data that
440 * says how big the next message is) check the buffer will be large enough
441 * to hold at least one message. */
443 if( xIsMessageBuffer != pdFALSE )
445 /* Statically allocated message buffer. */
446 ucFlags = sbFLAGS_IS_MESSAGE_BUFFER | sbFLAGS_IS_STATICALLY_ALLOCATED;
447 configASSERT( xBufferSizeBytes > sbBYTES_TO_STORE_MESSAGE_LENGTH );
451 /* Statically allocated stream buffer. */
452 ucFlags = sbFLAGS_IS_STATICALLY_ALLOCATED;
455 #if ( configASSERT_DEFINED == 1 )
457 /* Sanity check that the size of the structure used to declare a
458 * variable of type StaticStreamBuffer_t equals the size of the real
459 * message buffer structure. */
460 volatile size_t xSize = sizeof( StaticStreamBuffer_t );
461 configASSERT( xSize == sizeof( StreamBuffer_t ) );
462 } /*lint !e529 xSize is referenced is configASSERT() is defined. */
463 #endif /* configASSERT_DEFINED */
465 if( ( pucStreamBufferStorageArea != NULL ) && ( pxStaticStreamBuffer != NULL ) )
467 prvInitialiseNewStreamBuffer( pxStreamBuffer,
468 pucStreamBufferStorageArea,
472 pxSendCompletedCallback,
473 pxReceiveCompletedCallback );
475 /* Remember this was statically allocated in case it is ever deleted
477 pxStreamBuffer->ucFlags |= sbFLAGS_IS_STATICALLY_ALLOCATED;
479 traceSTREAM_BUFFER_CREATE( pxStreamBuffer, xIsMessageBuffer );
481 /* MISRA Ref 11.3.1 [Misaligned access] */
482 /* More details at: https://github.com/FreeRTOS/FreeRTOS-Kernel/blob/main/MISRA.md#rule-113 */
483 /* coverity[misra_c_2012_rule_11_3_violation] */
484 xReturn = ( StreamBufferHandle_t ) pxStaticStreamBuffer;
489 traceSTREAM_BUFFER_CREATE_STATIC_FAILED( xReturn, xIsMessageBuffer );
492 traceRETURN_xStreamBufferGenericCreateStatic( xReturn );
496 #endif /* ( configSUPPORT_STATIC_ALLOCATION == 1 ) */
497 /*-----------------------------------------------------------*/
499 #if ( configSUPPORT_STATIC_ALLOCATION == 1 )
500 BaseType_t xStreamBufferGetStaticBuffers( StreamBufferHandle_t xStreamBuffer,
501 uint8_t ** ppucStreamBufferStorageArea,
502 StaticStreamBuffer_t ** ppxStaticStreamBuffer )
505 StreamBuffer_t * const pxStreamBuffer = xStreamBuffer;
507 traceENTER_xStreamBufferGetStaticBuffers( xStreamBuffer, ppucStreamBufferStorageArea, ppxStaticStreamBuffer );
509 configASSERT( pxStreamBuffer );
510 configASSERT( ppucStreamBufferStorageArea );
511 configASSERT( ppxStaticStreamBuffer );
513 if( ( pxStreamBuffer->ucFlags & sbFLAGS_IS_STATICALLY_ALLOCATED ) != ( uint8_t ) 0 )
515 *ppucStreamBufferStorageArea = pxStreamBuffer->pucBuffer;
516 /* MISRA Ref 11.3.1 [Misaligned access] */
517 /* More details at: https://github.com/FreeRTOS/FreeRTOS-Kernel/blob/main/MISRA.md#rule-113 */
518 /* coverity[misra_c_2012_rule_11_3_violation] */
519 *ppxStaticStreamBuffer = ( StaticStreamBuffer_t * ) pxStreamBuffer;
527 traceRETURN_xStreamBufferGetStaticBuffers( xReturn );
531 #endif /* configSUPPORT_STATIC_ALLOCATION */
532 /*-----------------------------------------------------------*/
534 void vStreamBufferDelete( StreamBufferHandle_t xStreamBuffer )
536 StreamBuffer_t * pxStreamBuffer = xStreamBuffer;
538 traceENTER_vStreamBufferDelete( xStreamBuffer );
540 configASSERT( pxStreamBuffer );
542 traceSTREAM_BUFFER_DELETE( xStreamBuffer );
544 if( ( pxStreamBuffer->ucFlags & sbFLAGS_IS_STATICALLY_ALLOCATED ) == ( uint8_t ) pdFALSE )
546 #if ( configSUPPORT_DYNAMIC_ALLOCATION == 1 )
548 /* Both the structure and the buffer were allocated using a single call
549 * to pvPortMalloc(), hence only one call to vPortFree() is required. */
550 vPortFree( ( void * ) pxStreamBuffer ); /*lint !e9087 Standard free() semantics require void *, plus pxStreamBuffer was allocated by pvPortMalloc(). */
554 /* Should not be possible to get here, ucFlags must be corrupt.
555 * Force an assert. */
556 configASSERT( xStreamBuffer == ( StreamBufferHandle_t ) ~0 );
562 /* The structure and buffer were not allocated dynamically and cannot be
563 * freed - just scrub the structure so future use will assert. */
564 ( void ) memset( pxStreamBuffer, 0x00, sizeof( StreamBuffer_t ) );
567 traceRETURN_vStreamBufferDelete();
569 /*-----------------------------------------------------------*/
571 BaseType_t xStreamBufferReset( StreamBufferHandle_t xStreamBuffer )
573 StreamBuffer_t * const pxStreamBuffer = xStreamBuffer;
574 BaseType_t xReturn = pdFAIL;
575 StreamBufferCallbackFunction_t pxSendCallback = NULL, pxReceiveCallback = NULL;
577 #if ( configUSE_TRACE_FACILITY == 1 )
578 UBaseType_t uxStreamBufferNumber;
581 traceENTER_xStreamBufferReset( xStreamBuffer );
583 configASSERT( pxStreamBuffer );
585 #if ( configUSE_TRACE_FACILITY == 1 )
587 /* Store the stream buffer number so it can be restored after the
589 uxStreamBufferNumber = pxStreamBuffer->uxStreamBufferNumber;
593 /* Can only reset a message buffer if there are no tasks blocked on it. */
594 taskENTER_CRITICAL();
596 if( ( pxStreamBuffer->xTaskWaitingToReceive == NULL ) && ( pxStreamBuffer->xTaskWaitingToSend == NULL ) )
598 #if ( configUSE_SB_COMPLETED_CALLBACK == 1 )
600 pxSendCallback = pxStreamBuffer->pxSendCompletedCallback;
601 pxReceiveCallback = pxStreamBuffer->pxReceiveCompletedCallback;
605 prvInitialiseNewStreamBuffer( pxStreamBuffer,
606 pxStreamBuffer->pucBuffer,
607 pxStreamBuffer->xLength,
608 pxStreamBuffer->xTriggerLevelBytes,
609 pxStreamBuffer->ucFlags,
613 #if ( configUSE_TRACE_FACILITY == 1 )
615 pxStreamBuffer->uxStreamBufferNumber = uxStreamBufferNumber;
619 traceSTREAM_BUFFER_RESET( xStreamBuffer );
626 traceRETURN_xStreamBufferReset( xReturn );
630 /*-----------------------------------------------------------*/
632 BaseType_t xStreamBufferSetTriggerLevel( StreamBufferHandle_t xStreamBuffer,
633 size_t xTriggerLevel )
635 StreamBuffer_t * const pxStreamBuffer = xStreamBuffer;
638 traceENTER_xStreamBufferSetTriggerLevel( xStreamBuffer, xTriggerLevel );
640 configASSERT( pxStreamBuffer );
642 /* It is not valid for the trigger level to be 0. */
643 if( xTriggerLevel == ( size_t ) 0 )
645 xTriggerLevel = ( size_t ) 1;
648 /* The trigger level is the number of bytes that must be in the stream
649 * buffer before a task that is waiting for data is unblocked. */
650 if( xTriggerLevel < pxStreamBuffer->xLength )
652 pxStreamBuffer->xTriggerLevelBytes = xTriggerLevel;
660 traceRETURN_xStreamBufferSetTriggerLevel( xReturn );
664 /*-----------------------------------------------------------*/
666 size_t xStreamBufferSpacesAvailable( StreamBufferHandle_t xStreamBuffer )
668 const StreamBuffer_t * const pxStreamBuffer = xStreamBuffer;
670 size_t xOriginalTail;
672 traceENTER_xStreamBufferSpacesAvailable( xStreamBuffer );
674 configASSERT( pxStreamBuffer );
676 /* The code below reads xTail and then xHead. This is safe if the stream
677 * buffer is updated once between the two reads - but not if the stream buffer
678 * is updated more than once between the two reads - hence the loop. */
681 xOriginalTail = pxStreamBuffer->xTail;
682 xSpace = pxStreamBuffer->xLength + pxStreamBuffer->xTail;
683 xSpace -= pxStreamBuffer->xHead;
684 } while( xOriginalTail != pxStreamBuffer->xTail );
686 xSpace -= ( size_t ) 1;
688 if( xSpace >= pxStreamBuffer->xLength )
690 xSpace -= pxStreamBuffer->xLength;
694 mtCOVERAGE_TEST_MARKER();
697 traceRETURN_xStreamBufferSpacesAvailable( xSpace );
701 /*-----------------------------------------------------------*/
703 size_t xStreamBufferBytesAvailable( StreamBufferHandle_t xStreamBuffer )
705 const StreamBuffer_t * const pxStreamBuffer = xStreamBuffer;
708 traceENTER_xStreamBufferBytesAvailable( xStreamBuffer );
710 configASSERT( pxStreamBuffer );
712 xReturn = prvBytesInBuffer( pxStreamBuffer );
714 traceRETURN_xStreamBufferBytesAvailable( xReturn );
718 /*-----------------------------------------------------------*/
720 size_t xStreamBufferSend( StreamBufferHandle_t xStreamBuffer,
721 const void * pvTxData,
722 size_t xDataLengthBytes,
723 TickType_t xTicksToWait )
725 StreamBuffer_t * const pxStreamBuffer = xStreamBuffer;
726 size_t xReturn, xSpace = 0;
727 size_t xRequiredSpace = xDataLengthBytes;
729 size_t xMaxReportedSpace = 0;
731 traceENTER_xStreamBufferSend( xStreamBuffer, pvTxData, xDataLengthBytes, xTicksToWait );
733 configASSERT( pvTxData );
734 configASSERT( pxStreamBuffer );
736 /* The maximum amount of space a stream buffer will ever report is its length
738 xMaxReportedSpace = pxStreamBuffer->xLength - ( size_t ) 1;
740 /* This send function is used to write to both message buffers and stream
741 * buffers. If this is a message buffer then the space needed must be
742 * increased by the amount of bytes needed to store the length of the
744 if( ( pxStreamBuffer->ucFlags & sbFLAGS_IS_MESSAGE_BUFFER ) != ( uint8_t ) 0 )
746 xRequiredSpace += sbBYTES_TO_STORE_MESSAGE_LENGTH;
749 configASSERT( xRequiredSpace > xDataLengthBytes );
751 /* If this is a message buffer then it must be possible to write the
753 if( xRequiredSpace > xMaxReportedSpace )
755 /* The message would not fit even if the entire buffer was empty,
756 * so don't wait for space. */
757 xTicksToWait = ( TickType_t ) 0;
761 mtCOVERAGE_TEST_MARKER();
766 /* If this is a stream buffer then it is acceptable to write only part
767 * of the message to the buffer. Cap the length to the total length of
769 if( xRequiredSpace > xMaxReportedSpace )
771 xRequiredSpace = xMaxReportedSpace;
775 mtCOVERAGE_TEST_MARKER();
779 if( xTicksToWait != ( TickType_t ) 0 )
781 vTaskSetTimeOutState( &xTimeOut );
785 /* Wait until the required number of bytes are free in the message
787 taskENTER_CRITICAL();
789 xSpace = xStreamBufferSpacesAvailable( pxStreamBuffer );
791 if( xSpace < xRequiredSpace )
793 /* Clear notification state as going to wait for space. */
794 ( void ) xTaskNotifyStateClear( NULL );
796 /* Should only be one writer. */
797 configASSERT( pxStreamBuffer->xTaskWaitingToSend == NULL );
798 pxStreamBuffer->xTaskWaitingToSend = xTaskGetCurrentTaskHandle();
808 traceBLOCKING_ON_STREAM_BUFFER_SEND( xStreamBuffer );
809 ( void ) xTaskNotifyWait( ( uint32_t ) 0, ( uint32_t ) 0, NULL, xTicksToWait );
810 pxStreamBuffer->xTaskWaitingToSend = NULL;
811 } while( xTaskCheckForTimeOut( &xTimeOut, &xTicksToWait ) == pdFALSE );
815 mtCOVERAGE_TEST_MARKER();
818 if( xSpace == ( size_t ) 0 )
820 xSpace = xStreamBufferSpacesAvailable( pxStreamBuffer );
824 mtCOVERAGE_TEST_MARKER();
827 xReturn = prvWriteMessageToBuffer( pxStreamBuffer, pvTxData, xDataLengthBytes, xSpace, xRequiredSpace );
829 if( xReturn > ( size_t ) 0 )
831 traceSTREAM_BUFFER_SEND( xStreamBuffer, xReturn );
833 /* Was a task waiting for the data? */
834 if( prvBytesInBuffer( pxStreamBuffer ) >= pxStreamBuffer->xTriggerLevelBytes )
836 prvSEND_COMPLETED( pxStreamBuffer );
840 mtCOVERAGE_TEST_MARKER();
845 mtCOVERAGE_TEST_MARKER();
846 traceSTREAM_BUFFER_SEND_FAILED( xStreamBuffer );
849 traceRETURN_xStreamBufferSend( xReturn );
853 /*-----------------------------------------------------------*/
855 size_t xStreamBufferSendFromISR( StreamBufferHandle_t xStreamBuffer,
856 const void * pvTxData,
857 size_t xDataLengthBytes,
858 BaseType_t * const pxHigherPriorityTaskWoken )
860 StreamBuffer_t * const pxStreamBuffer = xStreamBuffer;
861 size_t xReturn, xSpace;
862 size_t xRequiredSpace = xDataLengthBytes;
864 traceENTER_xStreamBufferSendFromISR( xStreamBuffer, pvTxData, xDataLengthBytes, pxHigherPriorityTaskWoken );
866 configASSERT( pvTxData );
867 configASSERT( pxStreamBuffer );
869 /* This send function is used to write to both message buffers and stream
870 * buffers. If this is a message buffer then the space needed must be
871 * increased by the amount of bytes needed to store the length of the
873 if( ( pxStreamBuffer->ucFlags & sbFLAGS_IS_MESSAGE_BUFFER ) != ( uint8_t ) 0 )
875 xRequiredSpace += sbBYTES_TO_STORE_MESSAGE_LENGTH;
879 mtCOVERAGE_TEST_MARKER();
882 xSpace = xStreamBufferSpacesAvailable( pxStreamBuffer );
883 xReturn = prvWriteMessageToBuffer( pxStreamBuffer, pvTxData, xDataLengthBytes, xSpace, xRequiredSpace );
885 if( xReturn > ( size_t ) 0 )
887 /* Was a task waiting for the data? */
888 if( prvBytesInBuffer( pxStreamBuffer ) >= pxStreamBuffer->xTriggerLevelBytes )
890 prvSEND_COMPLETE_FROM_ISR( pxStreamBuffer, pxHigherPriorityTaskWoken );
894 mtCOVERAGE_TEST_MARKER();
899 mtCOVERAGE_TEST_MARKER();
902 traceSTREAM_BUFFER_SEND_FROM_ISR( xStreamBuffer, xReturn );
903 traceRETURN_xStreamBufferSendFromISR( xReturn );
907 /*-----------------------------------------------------------*/
909 static size_t prvWriteMessageToBuffer( StreamBuffer_t * const pxStreamBuffer,
910 const void * pvTxData,
911 size_t xDataLengthBytes,
913 size_t xRequiredSpace )
915 size_t xNextHead = pxStreamBuffer->xHead;
916 configMESSAGE_BUFFER_LENGTH_TYPE xMessageLength;
918 if( ( pxStreamBuffer->ucFlags & sbFLAGS_IS_MESSAGE_BUFFER ) != ( uint8_t ) 0 )
920 /* This is a message buffer, as opposed to a stream buffer. */
922 /* Convert xDataLengthBytes to the message length type. */
923 xMessageLength = ( configMESSAGE_BUFFER_LENGTH_TYPE ) xDataLengthBytes;
925 /* Ensure the data length given fits within configMESSAGE_BUFFER_LENGTH_TYPE. */
926 configASSERT( ( size_t ) xMessageLength == xDataLengthBytes );
928 if( xSpace >= xRequiredSpace )
930 /* There is enough space to write both the message length and the message
931 * itself into the buffer. Start by writing the length of the data, the data
932 * itself will be written later in this function. */
933 xNextHead = prvWriteBytesToBuffer( pxStreamBuffer, ( const uint8_t * ) &( xMessageLength ), sbBYTES_TO_STORE_MESSAGE_LENGTH, xNextHead );
937 /* Not enough space, so do not write data to the buffer. */
938 xDataLengthBytes = 0;
943 /* This is a stream buffer, as opposed to a message buffer, so writing a
944 * stream of bytes rather than discrete messages. Plan to write as many
945 * bytes as possible. */
946 xDataLengthBytes = configMIN( xDataLengthBytes, xSpace );
949 if( xDataLengthBytes != ( size_t ) 0 )
951 /* Write the data to the buffer. */
952 /* MISRA Ref 11.5.5 [Void pointer assignment] */
953 /* More details at: https://github.com/FreeRTOS/FreeRTOS-Kernel/blob/main/MISRA.md#rule-115 */
954 /* coverity[misra_c_2012_rule_11_5_violation] */
955 pxStreamBuffer->xHead = prvWriteBytesToBuffer( pxStreamBuffer, ( const uint8_t * ) pvTxData, xDataLengthBytes, xNextHead );
958 return xDataLengthBytes;
960 /*-----------------------------------------------------------*/
962 size_t xStreamBufferReceive( StreamBufferHandle_t xStreamBuffer,
964 size_t xBufferLengthBytes,
965 TickType_t xTicksToWait )
967 StreamBuffer_t * const pxStreamBuffer = xStreamBuffer;
968 size_t xReceivedLength = 0, xBytesAvailable, xBytesToStoreMessageLength;
970 traceENTER_xStreamBufferReceive( xStreamBuffer, pvRxData, xBufferLengthBytes, xTicksToWait );
972 configASSERT( pvRxData );
973 configASSERT( pxStreamBuffer );
975 /* This receive function is used by both message buffers, which store
976 * discrete messages, and stream buffers, which store a continuous stream of
977 * bytes. Discrete messages include an additional
978 * sbBYTES_TO_STORE_MESSAGE_LENGTH bytes that hold the length of the
980 if( ( pxStreamBuffer->ucFlags & sbFLAGS_IS_MESSAGE_BUFFER ) != ( uint8_t ) 0 )
982 xBytesToStoreMessageLength = sbBYTES_TO_STORE_MESSAGE_LENGTH;
986 xBytesToStoreMessageLength = 0;
989 if( xTicksToWait != ( TickType_t ) 0 )
991 /* Checking if there is data and clearing the notification state must be
992 * performed atomically. */
993 taskENTER_CRITICAL();
995 xBytesAvailable = prvBytesInBuffer( pxStreamBuffer );
997 /* If this function was invoked by a message buffer read then
998 * xBytesToStoreMessageLength holds the number of bytes used to hold
999 * the length of the next discrete message. If this function was
1000 * invoked by a stream buffer read then xBytesToStoreMessageLength will
1002 if( xBytesAvailable <= xBytesToStoreMessageLength )
1004 /* Clear notification state as going to wait for data. */
1005 ( void ) xTaskNotifyStateClear( NULL );
1007 /* Should only be one reader. */
1008 configASSERT( pxStreamBuffer->xTaskWaitingToReceive == NULL );
1009 pxStreamBuffer->xTaskWaitingToReceive = xTaskGetCurrentTaskHandle();
1013 mtCOVERAGE_TEST_MARKER();
1016 taskEXIT_CRITICAL();
1018 if( xBytesAvailable <= xBytesToStoreMessageLength )
1020 /* Wait for data to be available. */
1021 traceBLOCKING_ON_STREAM_BUFFER_RECEIVE( xStreamBuffer );
1022 ( void ) xTaskNotifyWait( ( uint32_t ) 0, ( uint32_t ) 0, NULL, xTicksToWait );
1023 pxStreamBuffer->xTaskWaitingToReceive = NULL;
1025 /* Recheck the data available after blocking. */
1026 xBytesAvailable = prvBytesInBuffer( pxStreamBuffer );
1030 mtCOVERAGE_TEST_MARKER();
1035 xBytesAvailable = prvBytesInBuffer( pxStreamBuffer );
1038 /* Whether receiving a discrete message (where xBytesToStoreMessageLength
1039 * holds the number of bytes used to store the message length) or a stream of
1040 * bytes (where xBytesToStoreMessageLength is zero), the number of bytes
1041 * available must be greater than xBytesToStoreMessageLength to be able to
1042 * read bytes from the buffer. */
1043 if( xBytesAvailable > xBytesToStoreMessageLength )
1045 xReceivedLength = prvReadMessageFromBuffer( pxStreamBuffer, pvRxData, xBufferLengthBytes, xBytesAvailable );
1047 /* Was a task waiting for space in the buffer? */
1048 if( xReceivedLength != ( size_t ) 0 )
1050 traceSTREAM_BUFFER_RECEIVE( xStreamBuffer, xReceivedLength );
1051 prvRECEIVE_COMPLETED( xStreamBuffer );
1055 mtCOVERAGE_TEST_MARKER();
1060 traceSTREAM_BUFFER_RECEIVE_FAILED( xStreamBuffer );
1061 mtCOVERAGE_TEST_MARKER();
1064 traceRETURN_xStreamBufferReceive( xReceivedLength );
1066 return xReceivedLength;
1068 /*-----------------------------------------------------------*/
1070 size_t xStreamBufferNextMessageLengthBytes( StreamBufferHandle_t xStreamBuffer )
1072 StreamBuffer_t * const pxStreamBuffer = xStreamBuffer;
1073 size_t xReturn, xBytesAvailable;
1074 configMESSAGE_BUFFER_LENGTH_TYPE xTempReturn;
1076 traceENTER_xStreamBufferNextMessageLengthBytes( xStreamBuffer );
1078 configASSERT( pxStreamBuffer );
1080 /* Ensure the stream buffer is being used as a message buffer. */
1081 if( ( pxStreamBuffer->ucFlags & sbFLAGS_IS_MESSAGE_BUFFER ) != ( uint8_t ) 0 )
1083 xBytesAvailable = prvBytesInBuffer( pxStreamBuffer );
1085 if( xBytesAvailable > sbBYTES_TO_STORE_MESSAGE_LENGTH )
1087 /* The number of bytes available is greater than the number of bytes
1088 * required to hold the length of the next message, so another message
1090 ( void ) prvReadBytesFromBuffer( pxStreamBuffer, ( uint8_t * ) &xTempReturn, sbBYTES_TO_STORE_MESSAGE_LENGTH, pxStreamBuffer->xTail );
1091 xReturn = ( size_t ) xTempReturn;
1095 /* The minimum amount of bytes in a message buffer is
1096 * ( sbBYTES_TO_STORE_MESSAGE_LENGTH + 1 ), so if xBytesAvailable is
1097 * less than sbBYTES_TO_STORE_MESSAGE_LENGTH the only other valid
1099 configASSERT( xBytesAvailable == 0 );
1108 traceRETURN_xStreamBufferNextMessageLengthBytes( xReturn );
1112 /*-----------------------------------------------------------*/
1114 size_t xStreamBufferReceiveFromISR( StreamBufferHandle_t xStreamBuffer,
1116 size_t xBufferLengthBytes,
1117 BaseType_t * const pxHigherPriorityTaskWoken )
1119 StreamBuffer_t * const pxStreamBuffer = xStreamBuffer;
1120 size_t xReceivedLength = 0, xBytesAvailable, xBytesToStoreMessageLength;
1122 traceENTER_xStreamBufferReceiveFromISR( xStreamBuffer, pvRxData, xBufferLengthBytes, pxHigherPriorityTaskWoken );
1124 configASSERT( pvRxData );
1125 configASSERT( pxStreamBuffer );
1127 /* This receive function is used by both message buffers, which store
1128 * discrete messages, and stream buffers, which store a continuous stream of
1129 * bytes. Discrete messages include an additional
1130 * sbBYTES_TO_STORE_MESSAGE_LENGTH bytes that hold the length of the
1132 if( ( pxStreamBuffer->ucFlags & sbFLAGS_IS_MESSAGE_BUFFER ) != ( uint8_t ) 0 )
1134 xBytesToStoreMessageLength = sbBYTES_TO_STORE_MESSAGE_LENGTH;
1138 xBytesToStoreMessageLength = 0;
1141 xBytesAvailable = prvBytesInBuffer( pxStreamBuffer );
1143 /* Whether receiving a discrete message (where xBytesToStoreMessageLength
1144 * holds the number of bytes used to store the message length) or a stream of
1145 * bytes (where xBytesToStoreMessageLength is zero), the number of bytes
1146 * available must be greater than xBytesToStoreMessageLength to be able to
1147 * read bytes from the buffer. */
1148 if( xBytesAvailable > xBytesToStoreMessageLength )
1150 xReceivedLength = prvReadMessageFromBuffer( pxStreamBuffer, pvRxData, xBufferLengthBytes, xBytesAvailable );
1152 /* Was a task waiting for space in the buffer? */
1153 if( xReceivedLength != ( size_t ) 0 )
1155 prvRECEIVE_COMPLETED_FROM_ISR( pxStreamBuffer, pxHigherPriorityTaskWoken );
1159 mtCOVERAGE_TEST_MARKER();
1164 mtCOVERAGE_TEST_MARKER();
1167 traceSTREAM_BUFFER_RECEIVE_FROM_ISR( xStreamBuffer, xReceivedLength );
1168 traceRETURN_xStreamBufferReceiveFromISR( xReceivedLength );
1170 return xReceivedLength;
1172 /*-----------------------------------------------------------*/
1174 static size_t prvReadMessageFromBuffer( StreamBuffer_t * pxStreamBuffer,
1176 size_t xBufferLengthBytes,
1177 size_t xBytesAvailable )
1179 size_t xCount, xNextMessageLength;
1180 configMESSAGE_BUFFER_LENGTH_TYPE xTempNextMessageLength;
1181 size_t xNextTail = pxStreamBuffer->xTail;
1183 if( ( pxStreamBuffer->ucFlags & sbFLAGS_IS_MESSAGE_BUFFER ) != ( uint8_t ) 0 )
1185 /* A discrete message is being received. First receive the length
1186 * of the message. */
1187 xNextTail = prvReadBytesFromBuffer( pxStreamBuffer, ( uint8_t * ) &xTempNextMessageLength, sbBYTES_TO_STORE_MESSAGE_LENGTH, xNextTail );
1188 xNextMessageLength = ( size_t ) xTempNextMessageLength;
1190 /* Reduce the number of bytes available by the number of bytes just
1192 xBytesAvailable -= sbBYTES_TO_STORE_MESSAGE_LENGTH;
1194 /* Check there is enough space in the buffer provided by the
1196 if( xNextMessageLength > xBufferLengthBytes )
1198 /* The user has provided insufficient space to read the message. */
1199 xNextMessageLength = 0;
1203 mtCOVERAGE_TEST_MARKER();
1208 /* A stream of bytes is being received (as opposed to a discrete
1209 * message), so read as many bytes as possible. */
1210 xNextMessageLength = xBufferLengthBytes;
1213 /* Use the minimum of the wanted bytes and the available bytes. */
1214 xCount = configMIN( xNextMessageLength, xBytesAvailable );
1216 if( xCount != ( size_t ) 0 )
1218 /* Read the actual data and update the tail to mark the data as officially consumed. */
1219 /* MISRA Ref 11.5.5 [Void pointer assignment] */
1220 /* More details at: https://github.com/FreeRTOS/FreeRTOS-Kernel/blob/main/MISRA.md#rule-115 */
1221 /* coverity[misra_c_2012_rule_11_5_violation] */
1222 pxStreamBuffer->xTail = prvReadBytesFromBuffer( pxStreamBuffer, ( uint8_t * ) pvRxData, xCount, xNextTail );
1227 /*-----------------------------------------------------------*/
1229 BaseType_t xStreamBufferIsEmpty( StreamBufferHandle_t xStreamBuffer )
1231 const StreamBuffer_t * const pxStreamBuffer = xStreamBuffer;
1235 traceENTER_xStreamBufferIsEmpty( xStreamBuffer );
1237 configASSERT( pxStreamBuffer );
1239 /* True if no bytes are available. */
1240 xTail = pxStreamBuffer->xTail;
1242 if( pxStreamBuffer->xHead == xTail )
1251 traceRETURN_xStreamBufferIsEmpty( xReturn );
1255 /*-----------------------------------------------------------*/
1257 BaseType_t xStreamBufferIsFull( StreamBufferHandle_t xStreamBuffer )
1260 size_t xBytesToStoreMessageLength;
1261 const StreamBuffer_t * const pxStreamBuffer = xStreamBuffer;
1263 traceENTER_xStreamBufferIsFull( xStreamBuffer );
1265 configASSERT( pxStreamBuffer );
1267 /* This generic version of the receive function is used by both message
1268 * buffers, which store discrete messages, and stream buffers, which store a
1269 * continuous stream of bytes. Discrete messages include an additional
1270 * sbBYTES_TO_STORE_MESSAGE_LENGTH bytes that hold the length of the message. */
1271 if( ( pxStreamBuffer->ucFlags & sbFLAGS_IS_MESSAGE_BUFFER ) != ( uint8_t ) 0 )
1273 xBytesToStoreMessageLength = sbBYTES_TO_STORE_MESSAGE_LENGTH;
1277 xBytesToStoreMessageLength = 0;
1280 /* True if the available space equals zero. */
1281 if( xStreamBufferSpacesAvailable( xStreamBuffer ) <= xBytesToStoreMessageLength )
1290 traceRETURN_xStreamBufferIsFull( xReturn );
1294 /*-----------------------------------------------------------*/
1296 BaseType_t xStreamBufferSendCompletedFromISR( StreamBufferHandle_t xStreamBuffer,
1297 BaseType_t * pxHigherPriorityTaskWoken )
1299 StreamBuffer_t * const pxStreamBuffer = xStreamBuffer;
1301 UBaseType_t uxSavedInterruptStatus;
1303 traceENTER_xStreamBufferSendCompletedFromISR( xStreamBuffer, pxHigherPriorityTaskWoken );
1305 configASSERT( pxStreamBuffer );
1307 uxSavedInterruptStatus = taskENTER_CRITICAL_FROM_ISR();
1309 if( ( pxStreamBuffer )->xTaskWaitingToReceive != NULL )
1311 ( void ) xTaskNotifyFromISR( ( pxStreamBuffer )->xTaskWaitingToReceive,
1314 pxHigherPriorityTaskWoken );
1315 ( pxStreamBuffer )->xTaskWaitingToReceive = NULL;
1323 taskEXIT_CRITICAL_FROM_ISR( uxSavedInterruptStatus );
1325 traceRETURN_xStreamBufferSendCompletedFromISR( xReturn );
1329 /*-----------------------------------------------------------*/
1331 BaseType_t xStreamBufferReceiveCompletedFromISR( StreamBufferHandle_t xStreamBuffer,
1332 BaseType_t * pxHigherPriorityTaskWoken )
1334 StreamBuffer_t * const pxStreamBuffer = xStreamBuffer;
1336 UBaseType_t uxSavedInterruptStatus;
1338 traceENTER_xStreamBufferReceiveCompletedFromISR( xStreamBuffer, pxHigherPriorityTaskWoken );
1340 configASSERT( pxStreamBuffer );
1342 uxSavedInterruptStatus = taskENTER_CRITICAL_FROM_ISR();
1344 if( ( pxStreamBuffer )->xTaskWaitingToSend != NULL )
1346 ( void ) xTaskNotifyFromISR( ( pxStreamBuffer )->xTaskWaitingToSend,
1349 pxHigherPriorityTaskWoken );
1350 ( pxStreamBuffer )->xTaskWaitingToSend = NULL;
1358 taskEXIT_CRITICAL_FROM_ISR( uxSavedInterruptStatus );
1360 traceRETURN_xStreamBufferReceiveCompletedFromISR( xReturn );
1364 /*-----------------------------------------------------------*/
1366 static size_t prvWriteBytesToBuffer( StreamBuffer_t * const pxStreamBuffer,
1367 const uint8_t * pucData,
1371 size_t xFirstLength;
1373 configASSERT( xCount > ( size_t ) 0 );
1375 /* Calculate the number of bytes that can be added in the first write -
1376 * which may be less than the total number of bytes that need to be added if
1377 * the buffer will wrap back to the beginning. */
1378 xFirstLength = configMIN( pxStreamBuffer->xLength - xHead, xCount );
1380 /* Write as many bytes as can be written in the first write. */
1381 configASSERT( ( xHead + xFirstLength ) <= pxStreamBuffer->xLength );
1382 ( void ) memcpy( ( void * ) ( &( pxStreamBuffer->pucBuffer[ xHead ] ) ), ( const void * ) pucData, xFirstLength ); /*lint !e9087 memcpy() requires void *. */
1384 /* If the number of bytes written was less than the number that could be
1385 * written in the first write... */
1386 if( xCount > xFirstLength )
1388 /* ...then write the remaining bytes to the start of the buffer. */
1389 configASSERT( ( xCount - xFirstLength ) <= pxStreamBuffer->xLength );
1390 ( void ) memcpy( ( void * ) pxStreamBuffer->pucBuffer, ( const void * ) &( pucData[ xFirstLength ] ), xCount - xFirstLength ); /*lint !e9087 memcpy() requires void *. */
1394 mtCOVERAGE_TEST_MARKER();
1399 if( xHead >= pxStreamBuffer->xLength )
1401 xHead -= pxStreamBuffer->xLength;
1405 mtCOVERAGE_TEST_MARKER();
1410 /*-----------------------------------------------------------*/
1412 static size_t prvReadBytesFromBuffer( StreamBuffer_t * pxStreamBuffer,
1417 size_t xFirstLength;
1419 configASSERT( xCount != ( size_t ) 0 );
1421 /* Calculate the number of bytes that can be read - which may be
1422 * less than the number wanted if the data wraps around to the start of
1424 xFirstLength = configMIN( pxStreamBuffer->xLength - xTail, xCount );
1426 /* Obtain the number of bytes it is possible to obtain in the first
1427 * read. Asserts check bounds of read and write. */
1428 configASSERT( xFirstLength <= xCount );
1429 configASSERT( ( xTail + xFirstLength ) <= pxStreamBuffer->xLength );
1430 ( void ) memcpy( ( void * ) pucData, ( const void * ) &( pxStreamBuffer->pucBuffer[ xTail ] ), xFirstLength ); /*lint !e9087 memcpy() requires void *. */
1432 /* If the total number of wanted bytes is greater than the number
1433 * that could be read in the first read... */
1434 if( xCount > xFirstLength )
1436 /* ...then read the remaining bytes from the start of the buffer. */
1437 ( void ) memcpy( ( void * ) &( pucData[ xFirstLength ] ), ( void * ) ( pxStreamBuffer->pucBuffer ), xCount - xFirstLength ); /*lint !e9087 memcpy() requires void *. */
1441 mtCOVERAGE_TEST_MARKER();
1444 /* Move the tail pointer to effectively remove the data read from the buffer. */
1447 if( xTail >= pxStreamBuffer->xLength )
1449 xTail -= pxStreamBuffer->xLength;
1454 /*-----------------------------------------------------------*/
1456 static size_t prvBytesInBuffer( const StreamBuffer_t * const pxStreamBuffer )
1458 /* Returns the distance between xTail and xHead. */
1461 xCount = pxStreamBuffer->xLength + pxStreamBuffer->xHead;
1462 xCount -= pxStreamBuffer->xTail;
1464 if( xCount >= pxStreamBuffer->xLength )
1466 xCount -= pxStreamBuffer->xLength;
1470 mtCOVERAGE_TEST_MARKER();
1475 /*-----------------------------------------------------------*/
1477 static void prvInitialiseNewStreamBuffer( StreamBuffer_t * const pxStreamBuffer,
1478 uint8_t * const pucBuffer,
1479 size_t xBufferSizeBytes,
1480 size_t xTriggerLevelBytes,
1482 StreamBufferCallbackFunction_t pxSendCompletedCallback,
1483 StreamBufferCallbackFunction_t pxReceiveCompletedCallback )
1485 /* Assert here is deliberately writing to the entire buffer to ensure it can
1486 * be written to without generating exceptions, and is setting the buffer to a
1487 * known value to assist in development/debugging. */
1488 #if ( configASSERT_DEFINED == 1 )
1490 /* The value written just has to be identifiable when looking at the
1491 * memory. Don't use 0xA5 as that is the stack fill value and could
1492 * result in confusion as to what is actually being observed. */
1493 #define STREAM_BUFFER_BUFFER_WRITE_VALUE ( 0x55 )
1494 configASSERT( memset( pucBuffer, ( int ) STREAM_BUFFER_BUFFER_WRITE_VALUE, xBufferSizeBytes ) == pucBuffer );
1498 ( void ) memset( ( void * ) pxStreamBuffer, 0x00, sizeof( StreamBuffer_t ) ); /*lint !e9087 memset() requires void *. */
1499 pxStreamBuffer->pucBuffer = pucBuffer;
1500 pxStreamBuffer->xLength = xBufferSizeBytes;
1501 pxStreamBuffer->xTriggerLevelBytes = xTriggerLevelBytes;
1502 pxStreamBuffer->ucFlags = ucFlags;
1503 #if ( configUSE_SB_COMPLETED_CALLBACK == 1 )
1505 pxStreamBuffer->pxSendCompletedCallback = pxSendCompletedCallback;
1506 pxStreamBuffer->pxReceiveCompletedCallback = pxReceiveCompletedCallback;
1510 ( void ) pxSendCompletedCallback;
1511 ( void ) pxReceiveCompletedCallback;
1516 #if ( configUSE_TRACE_FACILITY == 1 )
1518 UBaseType_t uxStreamBufferGetStreamBufferNumber( StreamBufferHandle_t xStreamBuffer )
1520 traceENTER_uxStreamBufferGetStreamBufferNumber( xStreamBuffer );
1522 traceRETURN_uxStreamBufferGetStreamBufferNumber( xStreamBuffer->uxStreamBufferNumber );
1524 return xStreamBuffer->uxStreamBufferNumber;
1527 #endif /* configUSE_TRACE_FACILITY */
1528 /*-----------------------------------------------------------*/
1530 #if ( configUSE_TRACE_FACILITY == 1 )
1532 void vStreamBufferSetStreamBufferNumber( StreamBufferHandle_t xStreamBuffer,
1533 UBaseType_t uxStreamBufferNumber )
1535 traceENTER_vStreamBufferSetStreamBufferNumber( xStreamBuffer, uxStreamBufferNumber );
1537 xStreamBuffer->uxStreamBufferNumber = uxStreamBufferNumber;
1539 traceRETURN_vStreamBufferSetStreamBufferNumber();
1542 #endif /* configUSE_TRACE_FACILITY */
1543 /*-----------------------------------------------------------*/
1545 #if ( configUSE_TRACE_FACILITY == 1 )
1547 uint8_t ucStreamBufferGetStreamBufferType( StreamBufferHandle_t xStreamBuffer )
1549 traceENTER_ucStreamBufferGetStreamBufferType( xStreamBuffer );
1551 traceRETURN_ucStreamBufferGetStreamBufferType( ( uint8_t ) ( xStreamBuffer->ucFlags & sbFLAGS_IS_MESSAGE_BUFFER ) );
1553 return( ( uint8_t ) ( xStreamBuffer->ucFlags & sbFLAGS_IS_MESSAGE_BUFFER ) );
1556 #endif /* configUSE_TRACE_FACILITY */
1557 /*-----------------------------------------------------------*/