| /* |
| * FreeRTOS Kernel <DEVELOPMENT BRANCH> |
| * Copyright (C) 2015-2019 Cadence Design Systems, Inc. |
| * Copyright (C) 2021 Amazon.com, Inc. or its affiliates. All Rights Reserved. |
| * |
| * SPDX-License-Identifier: MIT |
| * |
| * Permission is hereby granted, free of charge, to any person obtaining a copy of |
| * this software and associated documentation files (the "Software"), to deal in |
| * the Software without restriction, including without limitation the rights to |
| * use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies of |
| * the Software, and to permit persons to whom the Software is furnished to do so, |
| * subject to the following conditions: |
| * |
| * The above copyright notice and this permission notice shall be included in all |
| * copies or substantial portions of the Software. |
| * |
| * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR |
| * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS |
| * FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR |
| * COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER |
| * IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN |
| * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. |
| * |
| * https://www.FreeRTOS.org |
| * https://github.com/FreeRTOS |
| * |
| */ |
| |
| #include "FreeRTOS.h" |
| |
| #if XT_USE_THREAD_SAFE_CLIB |
| |
| #if XSHAL_CLIB == XTHAL_CLIB_XCLIB |
| |
| #include <errno.h> |
| #include <sys/reent.h> |
| |
| #include "semphr.h" |
| |
| typedef SemaphoreHandle_t _Rmtx; |
| |
| /*----------------------------------------------------------------------------- */ |
| /* Override this and set to nonzero to enable locking. */ |
| /*----------------------------------------------------------------------------- */ |
| int32_t _xclib_use_mt = 1; |
| |
| |
| /*----------------------------------------------------------------------------- */ |
| /* Init lock. */ |
| /*----------------------------------------------------------------------------- */ |
| void _Mtxinit( _Rmtx * mtx ) |
| { |
| *mtx = xSemaphoreCreateRecursiveMutex(); |
| } |
| |
| /*----------------------------------------------------------------------------- */ |
| /* Destroy lock. */ |
| /*----------------------------------------------------------------------------- */ |
| void _Mtxdst( _Rmtx * mtx ) |
| { |
| if( ( mtx != NULL ) && ( *mtx != NULL ) ) |
| { |
| vSemaphoreDelete( *mtx ); |
| } |
| } |
| |
| /*----------------------------------------------------------------------------- */ |
| /* Lock. */ |
| /*----------------------------------------------------------------------------- */ |
| void _Mtxlock( _Rmtx * mtx ) |
| { |
| if( ( mtx != NULL ) && ( *mtx != NULL ) ) |
| { |
| xSemaphoreTakeRecursive( *mtx, portMAX_DELAY ); |
| } |
| } |
| |
| /*----------------------------------------------------------------------------- */ |
| /* Unlock. */ |
| /*----------------------------------------------------------------------------- */ |
| void _Mtxunlock( _Rmtx * mtx ) |
| { |
| if( ( mtx != NULL ) && ( *mtx != NULL ) ) |
| { |
| xSemaphoreGiveRecursive( *mtx ); |
| } |
| } |
| |
| /*----------------------------------------------------------------------------- */ |
| /* Called by malloc() to allocate blocks of memory from the heap. */ |
| /*----------------------------------------------------------------------------- */ |
| void * _sbrk_r( struct _reent * reent, |
| int32_t incr ) |
| { |
| extern char _end; |
| extern char _heap_sentry; |
| static char * _heap_sentry_ptr = &_heap_sentry; |
| static char * heap_ptr; |
| char * base; |
| |
| if( !heap_ptr ) |
| { |
| heap_ptr = ( char * ) &_end; |
| } |
| |
| base = heap_ptr; |
| |
| if( heap_ptr + incr >= _heap_sentry_ptr ) |
| { |
| reent->_errno = ENOMEM; |
| return ( char * ) -1; |
| } |
| |
| heap_ptr += incr; |
| return base; |
| } |
| |
| /*----------------------------------------------------------------------------- */ |
| /* Global initialization for C library. */ |
| /*----------------------------------------------------------------------------- */ |
| void vPortClibInit( void ) |
| { |
| } |
| |
| /*----------------------------------------------------------------------------- */ |
| /* Per-thread cleanup stub provided for linking, does nothing. */ |
| /*----------------------------------------------------------------------------- */ |
| void _reclaim_reent( void * ptr ) |
| { |
| } |
| |
| #endif /* XSHAL_CLIB == XTHAL_CLIB_XCLIB */ |
| |
| #if XSHAL_CLIB == XTHAL_CLIB_NEWLIB |
| |
| #include <errno.h> |
| #include <malloc.h> |
| #include <stdio.h> |
| #include <stdlib.h> |
| #include <string.h> |
| |
| #include "semphr.h" |
| |
| static SemaphoreHandle_t xClibMutex; |
| static uint32_t ulClibInitDone = 0; |
| |
| /*----------------------------------------------------------------------------- */ |
| /* Get C library lock. */ |
| /*----------------------------------------------------------------------------- */ |
| void __malloc_lock( struct _reent * ptr ) |
| { |
| if( !ulClibInitDone ) |
| { |
| return; |
| } |
| |
| xSemaphoreTakeRecursive( xClibMutex, portMAX_DELAY ); |
| } |
| |
| /*----------------------------------------------------------------------------- */ |
| /* Release C library lock. */ |
| /*----------------------------------------------------------------------------- */ |
| void __malloc_unlock( struct _reent * ptr ) |
| { |
| if( !ulClibInitDone ) |
| { |
| return; |
| } |
| |
| xSemaphoreGiveRecursive( xClibMutex ); |
| } |
| |
| /*----------------------------------------------------------------------------- */ |
| /* Lock for environment. Since we have only one global lock we can just call */ |
| /* the malloc() lock function. */ |
| /*----------------------------------------------------------------------------- */ |
| void __env_lock( struct _reent * ptr ) |
| { |
| __malloc_lock( ptr ); |
| } |
| |
| |
| /*----------------------------------------------------------------------------- */ |
| /* Unlock environment. */ |
| /*----------------------------------------------------------------------------- */ |
| void __env_unlock( struct _reent * ptr ) |
| { |
| __malloc_unlock( ptr ); |
| } |
| |
| /*----------------------------------------------------------------------------- */ |
| /* Called by malloc() to allocate blocks of memory from the heap. */ |
| /*----------------------------------------------------------------------------- */ |
| void * _sbrk_r( struct _reent * reent, |
| int32_t incr ) |
| { |
| extern char _end; |
| extern char _heap_sentry; |
| static char * _heap_sentry_ptr = &_heap_sentry; |
| static char * heap_ptr; |
| char * base; |
| |
| if( !heap_ptr ) |
| { |
| heap_ptr = ( char * ) &_end; |
| } |
| |
| base = heap_ptr; |
| |
| if( heap_ptr + incr >= _heap_sentry_ptr ) |
| { |
| reent->_errno = ENOMEM; |
| return ( char * ) -1; |
| } |
| |
| heap_ptr += incr; |
| return base; |
| } |
| |
| /*----------------------------------------------------------------------------- */ |
| /* Global initialization for C library. */ |
| /*----------------------------------------------------------------------------- */ |
| void vPortClibInit( void ) |
| { |
| configASSERT( !ulClibInitDone ); |
| |
| xClibMutex = xSemaphoreCreateRecursiveMutex(); |
| ulClibInitDone = 1; |
| } |
| |
| #endif /* XSHAL_CLIB == XTHAL_CLIB_NEWLIB */ |
| |
| #endif /* XT_USE_THREAD_SAFE_CLIB */ |