| /* |
| * 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 */ |