ST
/
ST_Events-old
Important changes to repositories hosted on mbed.com
Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.
To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.
It is also possible to export all your personal repositories from the account settings page.
Dependents: HelloWorld_CCA01M1 HelloWorld_CCA02M1 CI-data-logger-server HelloWorld_CCA02M1 ... more
This is a fork of the events subdirectory of https://github.com/ARMmbed/mbed-os.
Note, you must import this library with import name: events!!!
hal/common/mbed_alloc_wrappers.cpp@7606:dbabbb13e5b0, 2016-08-23 (annotated)
- Committer:
- Bogdan Marinescu
- Date:
- Tue Aug 23 17:09:27 2016 +0300
- Revision:
- 7606:dbabbb13e5b0
- Parent:
- 7604:4544d30abb2a
- Child:
- 7813:04b3c320bf04
- Child:
- 7649:2edb2f062201
Added thread safety to the tracing mechanism
Without this in place, traces might be lost if a another thread
interrupts a memory function at the right time.
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| Bogdan Marinescu |
7604:4544d30abb2a | 1 | /* mbed Microcontroller Library |
| Bogdan Marinescu |
7604:4544d30abb2a | 2 | * Copyright (c) 2006-2016 ARM Limited |
| Bogdan Marinescu |
7604:4544d30abb2a | 3 | * |
| Bogdan Marinescu |
7604:4544d30abb2a | 4 | * Licensed under the Apache License, Version 2.0 (the "License"); |
| Bogdan Marinescu |
7604:4544d30abb2a | 5 | * you may not use this file except in compliance with the License. |
| Bogdan Marinescu |
7604:4544d30abb2a | 6 | * You may obtain a copy of the License at |
| Bogdan Marinescu |
7604:4544d30abb2a | 7 | * |
| Bogdan Marinescu |
7604:4544d30abb2a | 8 | * http://www.apache.org/licenses/LICENSE-2.0 |
| Bogdan Marinescu |
7604:4544d30abb2a | 9 | * |
| Bogdan Marinescu |
7604:4544d30abb2a | 10 | * Unless required by applicable law or agreed to in writing, software |
| Bogdan Marinescu |
7604:4544d30abb2a | 11 | * distributed under the License is distributed on an "AS IS" BASIS, |
| Bogdan Marinescu |
7604:4544d30abb2a | 12 | * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. |
| Bogdan Marinescu |
7604:4544d30abb2a | 13 | * See the License for the specific language governing permissions and |
| Bogdan Marinescu |
7604:4544d30abb2a | 14 | * limitations under the License. |
| Bogdan Marinescu |
7604:4544d30abb2a | 15 | */ |
| Bogdan Marinescu |
7604:4544d30abb2a | 16 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 17 | #include "mbed_mem_trace.h" |
| Bogdan Marinescu |
7604:4544d30abb2a | 18 | #include "mbed_stats.h" |
| Bogdan Marinescu |
7604:4544d30abb2a | 19 | #include "toolchain.h" |
| Bogdan Marinescu |
7604:4544d30abb2a | 20 | #include "SingletonPtr.h" |
| Bogdan Marinescu |
7604:4544d30abb2a | 21 | #include "PlatformMutex.h" |
| Bogdan Marinescu |
7604:4544d30abb2a | 22 | #include <stddef.h> |
| Bogdan Marinescu |
7604:4544d30abb2a | 23 | #include <stdio.h> |
| Bogdan Marinescu |
7604:4544d30abb2a | 24 | #include <string.h> |
| Bogdan Marinescu |
7604:4544d30abb2a | 25 | #include <stdlib.h> |
| Bogdan Marinescu |
7604:4544d30abb2a | 26 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 27 | /* There are two memory tracers in mbed OS: |
| Bogdan Marinescu |
7604:4544d30abb2a | 28 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 29 | - the first can be used to detect the maximum heap usage at runtime. It is |
| Bogdan Marinescu |
7604:4544d30abb2a | 30 | activated by defining the MBED_HEAP_STATS_ENABLED macro. |
| Bogdan Marinescu |
7604:4544d30abb2a | 31 | - the second can be used to trace each memory call by automatically invoking |
| Bogdan Marinescu |
7604:4544d30abb2a | 32 | a callback on each memory operation (see hal/api/mbed_mem_trace.h). It is |
| Bogdan Marinescu |
7604:4544d30abb2a | 33 | activated by defining the MBED_MEM_TRACING_ENABLED macro. |
| Bogdan Marinescu |
7604:4544d30abb2a | 34 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 35 | Both tracers can be activated and deactivated in any combination. If both tracers |
| Bogdan Marinescu |
7604:4544d30abb2a | 36 | are active, the second one (MBED_MEM_TRACING_ENABLED) will trace the first one's |
| Bogdan Marinescu |
7604:4544d30abb2a | 37 | (MBED_HEAP_STATS_ENABLED) memory calls.*/ |
| Bogdan Marinescu |
7604:4544d30abb2a | 38 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 39 | /******************************************************************************/ |
| Bogdan Marinescu |
7604:4544d30abb2a | 40 | /* Implementation of the runtime max heap usage checker */ |
| Bogdan Marinescu |
7604:4544d30abb2a | 41 | /******************************************************************************/ |
| Bogdan Marinescu |
7604:4544d30abb2a | 42 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 43 | /* Size must be a multiple of 8 to keep alignment */ |
| Bogdan Marinescu |
7604:4544d30abb2a | 44 | typedef struct { |
| Bogdan Marinescu |
7604:4544d30abb2a | 45 | uint32_t size; |
| Bogdan Marinescu |
7604:4544d30abb2a | 46 | uint32_t pad; |
| Bogdan Marinescu |
7604:4544d30abb2a | 47 | } alloc_info_t; |
| Bogdan Marinescu |
7604:4544d30abb2a | 48 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 49 | static SingletonPtr<PlatformMutex> malloc_stats_mutex; |
| Bogdan Marinescu |
7606:dbabbb13e5b0 | 50 | static SingletonPtr<PlatformMutex> mem_trace_mutex; |
| Bogdan Marinescu |
7604:4544d30abb2a | 51 | static mbed_stats_heap_t heap_stats = {0, 0, 0, 0, 0}; |
| Bogdan Marinescu |
7604:4544d30abb2a | 52 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 53 | void mbed_stats_heap_get(mbed_stats_heap_t *stats) |
| Bogdan Marinescu |
7604:4544d30abb2a | 54 | { |
| Bogdan Marinescu |
7604:4544d30abb2a | 55 | malloc_stats_mutex->lock(); |
| Bogdan Marinescu |
7604:4544d30abb2a | 56 | memcpy(stats, &heap_stats, sizeof(mbed_stats_heap_t)); |
| Bogdan Marinescu |
7604:4544d30abb2a | 57 | malloc_stats_mutex->unlock(); |
| Bogdan Marinescu |
7604:4544d30abb2a | 58 | } |
| Bogdan Marinescu |
7604:4544d30abb2a | 59 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 60 | /******************************************************************************/ |
| Bogdan Marinescu |
7604:4544d30abb2a | 61 | /* GCC memory allocation wrappers */ |
| Bogdan Marinescu |
7604:4544d30abb2a | 62 | /******************************************************************************/ |
| Bogdan Marinescu |
7604:4544d30abb2a | 63 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 64 | #if defined(TOOLCHAIN_GCC) |
| Bogdan Marinescu |
7604:4544d30abb2a | 65 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 66 | #ifdef FEATURE_UVISOR |
| Bogdan Marinescu |
7604:4544d30abb2a | 67 | #include "uvisor-lib/uvisor-lib.h" |
| Bogdan Marinescu |
7604:4544d30abb2a | 68 | #endif/* FEATURE_UVISOR */ |
| Bogdan Marinescu |
7604:4544d30abb2a | 69 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 70 | // TODO: memory tracing doesn't work with uVisor enabled. |
| Bogdan Marinescu |
7604:4544d30abb2a | 71 | #if !defined(FEATURE_UVISOR) |
| Bogdan Marinescu |
7604:4544d30abb2a | 72 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 73 | extern "C" { |
| Bogdan Marinescu |
7604:4544d30abb2a | 74 | void * __real__malloc_r(struct _reent * r, size_t size); |
| Bogdan Marinescu |
7604:4544d30abb2a | 75 | void * __real__realloc_r(struct _reent * r, void * ptr, size_t size); |
| Bogdan Marinescu |
7604:4544d30abb2a | 76 | void __real__free_r(struct _reent * r, void * ptr); |
| Bogdan Marinescu |
7604:4544d30abb2a | 77 | void* __real__calloc_r(struct _reent * r, size_t nmemb, size_t size); |
| Bogdan Marinescu |
7604:4544d30abb2a | 78 | } |
| Bogdan Marinescu |
7604:4544d30abb2a | 79 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 80 | extern "C" void * __wrap__malloc_r(struct _reent * r, size_t size) { |
| Bogdan Marinescu |
7604:4544d30abb2a | 81 | void *ptr = NULL; |
| Bogdan Marinescu |
7604:4544d30abb2a | 82 | #ifdef MBED_HEAP_STATS_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 83 | malloc_stats_mutex->lock(); |
| Bogdan Marinescu |
7604:4544d30abb2a | 84 | alloc_info_t *alloc_info = (alloc_info_t*)__real__malloc_r(r, size + sizeof(alloc_info_t)); |
| Bogdan Marinescu |
7604:4544d30abb2a | 85 | if (alloc_info != NULL) { |
| Bogdan Marinescu |
7604:4544d30abb2a | 86 | alloc_info->size = size; |
| Bogdan Marinescu |
7604:4544d30abb2a | 87 | ptr = (void*)(alloc_info + 1); |
| Bogdan Marinescu |
7604:4544d30abb2a | 88 | heap_stats.current_size += size; |
| Bogdan Marinescu |
7604:4544d30abb2a | 89 | heap_stats.total_size += size; |
| Bogdan Marinescu |
7604:4544d30abb2a | 90 | heap_stats.alloc_cnt += 1; |
| Bogdan Marinescu |
7604:4544d30abb2a | 91 | if (heap_stats.current_size > heap_stats.max_size) { |
| Bogdan Marinescu |
7604:4544d30abb2a | 92 | heap_stats.max_size = heap_stats.current_size; |
| Bogdan Marinescu |
7604:4544d30abb2a | 93 | } |
| Bogdan Marinescu |
7604:4544d30abb2a | 94 | } else { |
| Bogdan Marinescu |
7604:4544d30abb2a | 95 | heap_stats.alloc_fail_cnt += 1; |
| Bogdan Marinescu |
7604:4544d30abb2a | 96 | } |
| Bogdan Marinescu |
7604:4544d30abb2a | 97 | malloc_stats_mutex->unlock(); |
| Bogdan Marinescu |
7604:4544d30abb2a | 98 | #else // #ifdef MBED_HEAP_STATS_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 99 | ptr = __real__malloc_r(r, size); |
| Bogdan Marinescu |
7604:4544d30abb2a | 100 | #endif // #ifdef MBED_HEAP_STATS_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 101 | #ifdef MBED_MEM_TRACING_ENABLED |
| Bogdan Marinescu |
7606:dbabbb13e5b0 | 102 | mem_trace_mutex->lock(); |
| Bogdan Marinescu |
7604:4544d30abb2a | 103 | mbed_mem_trace_malloc(ptr, size, MBED_CALLER_ADDR()); |
| Bogdan Marinescu |
7606:dbabbb13e5b0 | 104 | mem_trace_mutex->unlock(); |
| Bogdan Marinescu |
7604:4544d30abb2a | 105 | #endif // #ifdef MBED_MEM_TRACING_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 106 | return ptr; |
| Bogdan Marinescu |
7604:4544d30abb2a | 107 | } |
| Bogdan Marinescu |
7604:4544d30abb2a | 108 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 109 | extern "C" void * __wrap__realloc_r(struct _reent * r, void * ptr, size_t size) { |
| Bogdan Marinescu |
7604:4544d30abb2a | 110 | void *new_ptr = NULL; |
| Bogdan Marinescu |
7604:4544d30abb2a | 111 | #ifdef MBED_HEAP_STATS_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 112 | // Implement realloc_r with malloc and free. |
| Bogdan Marinescu |
7604:4544d30abb2a | 113 | // The function realloc_r can't be used here directly since |
| Bogdan Marinescu |
7604:4544d30abb2a | 114 | // it can call into __wrap__malloc_r (returns ptr + 4) or |
| Bogdan Marinescu |
7604:4544d30abb2a | 115 | // resize memory directly (returns ptr + 0). |
| Bogdan Marinescu |
7604:4544d30abb2a | 116 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 117 | // Note - no lock needed since malloc and free are thread safe |
| Bogdan Marinescu |
7604:4544d30abb2a | 118 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 119 | // Get old size |
| Bogdan Marinescu |
7604:4544d30abb2a | 120 | uint32_t old_size = 0; |
| Bogdan Marinescu |
7604:4544d30abb2a | 121 | if (ptr != NULL) { |
| Bogdan Marinescu |
7604:4544d30abb2a | 122 | alloc_info_t *alloc_info = ((alloc_info_t*)ptr) - 1; |
| Bogdan Marinescu |
7604:4544d30abb2a | 123 | old_size = alloc_info->size; |
| Bogdan Marinescu |
7604:4544d30abb2a | 124 | } |
| Bogdan Marinescu |
7604:4544d30abb2a | 125 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 126 | // Allocate space |
| Bogdan Marinescu |
7604:4544d30abb2a | 127 | if (size != 0) { |
| Bogdan Marinescu |
7604:4544d30abb2a | 128 | new_ptr = malloc(size); |
| Bogdan Marinescu |
7604:4544d30abb2a | 129 | } |
| Bogdan Marinescu |
7604:4544d30abb2a | 130 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 131 | // If the new buffer has been allocated copy the data to it |
| Bogdan Marinescu |
7604:4544d30abb2a | 132 | // and free the old buffer |
| Bogdan Marinescu |
7604:4544d30abb2a | 133 | if (new_ptr != NULL) { |
| Bogdan Marinescu |
7604:4544d30abb2a | 134 | uint32_t copy_size = (old_size < size) ? old_size : size; |
| Bogdan Marinescu |
7604:4544d30abb2a | 135 | memcpy(new_ptr, (void*)ptr, copy_size); |
| Bogdan Marinescu |
7604:4544d30abb2a | 136 | free(ptr); |
| Bogdan Marinescu |
7604:4544d30abb2a | 137 | } |
| Bogdan Marinescu |
7604:4544d30abb2a | 138 | #else // #ifdef MBED_HEAP_STATS_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 139 | new_ptr = __real__realloc_r(r, ptr, size); |
| Bogdan Marinescu |
7604:4544d30abb2a | 140 | #endif // #ifdef MBED_HEAP_STATS_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 141 | #ifdef MBED_MEM_TRACING_ENABLED |
| Bogdan Marinescu |
7606:dbabbb13e5b0 | 142 | mem_trace_mutex->lock(); |
| Bogdan Marinescu |
7604:4544d30abb2a | 143 | mbed_mem_trace_realloc(new_ptr, ptr, size, MBED_CALLER_ADDR()); |
| Bogdan Marinescu |
7606:dbabbb13e5b0 | 144 | mem_trace_mutex->unlock(); |
| Bogdan Marinescu |
7604:4544d30abb2a | 145 | #endif // #ifdef MBED_MEM_TRACING_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 146 | return new_ptr; |
| Bogdan Marinescu |
7604:4544d30abb2a | 147 | } |
| Bogdan Marinescu |
7604:4544d30abb2a | 148 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 149 | extern "C" void __wrap__free_r(struct _reent * r, void * ptr) { |
| Bogdan Marinescu |
7604:4544d30abb2a | 150 | #ifdef MBED_HEAP_STATS_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 151 | malloc_stats_mutex->lock(); |
| Bogdan Marinescu |
7604:4544d30abb2a | 152 | alloc_info_t *alloc_info = NULL; |
| Bogdan Marinescu |
7604:4544d30abb2a | 153 | if (ptr != NULL) { |
| Bogdan Marinescu |
7604:4544d30abb2a | 154 | alloc_info = ((alloc_info_t*)ptr) - 1; |
| Bogdan Marinescu |
7604:4544d30abb2a | 155 | heap_stats.current_size -= alloc_info->size; |
| Bogdan Marinescu |
7604:4544d30abb2a | 156 | heap_stats.alloc_cnt -= 1; |
| Bogdan Marinescu |
7604:4544d30abb2a | 157 | } |
| Bogdan Marinescu |
7604:4544d30abb2a | 158 | __real__free_r(r, (void*)alloc_info); |
| Bogdan Marinescu |
7604:4544d30abb2a | 159 | malloc_stats_mutex->unlock(); |
| Bogdan Marinescu |
7604:4544d30abb2a | 160 | #else // #ifdef MBED_HEAP_STATS_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 161 | __real__free_r(r, ptr); |
| Bogdan Marinescu |
7604:4544d30abb2a | 162 | #endif // #ifdef MBED_HEAP_STATS_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 163 | #ifdef MBED_MEM_TRACING_ENABLED |
| Bogdan Marinescu |
7606:dbabbb13e5b0 | 164 | mem_trace_mutex->lock(); |
| Bogdan Marinescu |
7604:4544d30abb2a | 165 | mbed_mem_trace_free(ptr, MBED_CALLER_ADDR()); |
| Bogdan Marinescu |
7606:dbabbb13e5b0 | 166 | mem_trace_mutex->unlock(); |
| Bogdan Marinescu |
7604:4544d30abb2a | 167 | #endif // #ifdef MBED_MEM_TRACING_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 168 | } |
| Bogdan Marinescu |
7604:4544d30abb2a | 169 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 170 | extern "C" void * __wrap__calloc_r(struct _reent * r, size_t nmemb, size_t size) { |
| Bogdan Marinescu |
7604:4544d30abb2a | 171 | void *ptr = NULL; |
| Bogdan Marinescu |
7604:4544d30abb2a | 172 | #ifdef MBED_HEAP_STATS_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 173 | // Note - no lock needed since malloc is thread safe |
| Bogdan Marinescu |
7604:4544d30abb2a | 174 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 175 | ptr = malloc(nmemb * size); |
| Bogdan Marinescu |
7604:4544d30abb2a | 176 | if (ptr != NULL) { |
| Bogdan Marinescu |
7604:4544d30abb2a | 177 | memset(ptr, 0, nmemb * size); |
| Bogdan Marinescu |
7604:4544d30abb2a | 178 | } |
| Bogdan Marinescu |
7604:4544d30abb2a | 179 | #else // #ifdef MBED_HEAP_STATS_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 180 | ptr = __real__calloc_r(r, nmemb, size); |
| Bogdan Marinescu |
7604:4544d30abb2a | 181 | #endif // #ifdef MBED_HEAP_STATS_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 182 | #ifdef MBED_MEM_TRACING_ENABLED |
| Bogdan Marinescu |
7606:dbabbb13e5b0 | 183 | mem_trace_mutex->lock(); |
| Bogdan Marinescu |
7604:4544d30abb2a | 184 | mbed_mem_trace_calloc(ptr, nmemb, size, MBED_CALLER_ADDR()); |
| Bogdan Marinescu |
7606:dbabbb13e5b0 | 185 | mem_trace_mutex->unlock(); |
| Bogdan Marinescu |
7604:4544d30abb2a | 186 | #endif // #ifdef MBED_MEM_TRACING_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 187 | return ptr; |
| Bogdan Marinescu |
7604:4544d30abb2a | 188 | } |
| Bogdan Marinescu |
7604:4544d30abb2a | 189 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 190 | #endif // if !defined(FEATURE_UVISOR) |
| Bogdan Marinescu |
7604:4544d30abb2a | 191 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 192 | /******************************************************************************/ |
| Bogdan Marinescu |
7604:4544d30abb2a | 193 | /* ARMCC memory allocation wrappers */ |
| Bogdan Marinescu |
7604:4544d30abb2a | 194 | /******************************************************************************/ |
| Bogdan Marinescu |
7604:4544d30abb2a | 195 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 196 | #elif defined(TOOLCHAIN_ARM) // #if defined(TOOLCHAIN_GCC) |
| Bogdan Marinescu |
7604:4544d30abb2a | 197 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 198 | /* Enable hooking of memory function only if tracing is also enabled */ |
| Bogdan Marinescu |
7604:4544d30abb2a | 199 | #if defined(MBED_MEM_TRACING_ENABLED) || defined(MBED_HEAP_STATS_ENABLED) |
| Bogdan Marinescu |
7604:4544d30abb2a | 200 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 201 | extern "C" { |
| Bogdan Marinescu |
7604:4544d30abb2a | 202 | void *$Super$$malloc(size_t size); |
| Bogdan Marinescu |
7604:4544d30abb2a | 203 | void *$Super$$realloc(void *ptr, size_t size); |
| Bogdan Marinescu |
7604:4544d30abb2a | 204 | void *$Super$$calloc(size_t nmemb, size_t size); |
| Bogdan Marinescu |
7604:4544d30abb2a | 205 | void $Super$$free(void *ptr); |
| Bogdan Marinescu |
7604:4544d30abb2a | 206 | } |
| Bogdan Marinescu |
7604:4544d30abb2a | 207 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 208 | extern "C" void* $Sub$$malloc(size_t size) { |
| Bogdan Marinescu |
7604:4544d30abb2a | 209 | void *ptr = NULL; |
| Bogdan Marinescu |
7604:4544d30abb2a | 210 | #ifdef MBED_HEAP_STATS_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 211 | malloc_stats_mutex->lock(); |
| Bogdan Marinescu |
7604:4544d30abb2a | 212 | alloc_info_t *alloc_info = (alloc_info_t*)$Super$$malloc(size + sizeof(alloc_info_t)); |
| Bogdan Marinescu |
7604:4544d30abb2a | 213 | if (alloc_info != NULL) { |
| Bogdan Marinescu |
7604:4544d30abb2a | 214 | alloc_info->size = size; |
| Bogdan Marinescu |
7604:4544d30abb2a | 215 | ptr = (void*)(alloc_info + 1); |
| Bogdan Marinescu |
7604:4544d30abb2a | 216 | heap_stats.current_size += size; |
| Bogdan Marinescu |
7604:4544d30abb2a | 217 | heap_stats.total_size += size; |
| Bogdan Marinescu |
7604:4544d30abb2a | 218 | heap_stats.alloc_cnt += 1; |
| Bogdan Marinescu |
7604:4544d30abb2a | 219 | if (heap_stats.current_size > heap_stats.max_size) { |
| Bogdan Marinescu |
7604:4544d30abb2a | 220 | heap_stats.max_size = heap_stats.current_size; |
| Bogdan Marinescu |
7604:4544d30abb2a | 221 | } |
| Bogdan Marinescu |
7604:4544d30abb2a | 222 | } else { |
| Bogdan Marinescu |
7604:4544d30abb2a | 223 | heap_stats.alloc_fail_cnt += 1; |
| Bogdan Marinescu |
7604:4544d30abb2a | 224 | } |
| Bogdan Marinescu |
7604:4544d30abb2a | 225 | malloc_stats_mutex->unlock(); |
| Bogdan Marinescu |
7604:4544d30abb2a | 226 | #else // #ifdef MBED_HEAP_STATS_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 227 | ptr = $Super$$malloc(size); |
| Bogdan Marinescu |
7604:4544d30abb2a | 228 | #endif // #ifdef MBED_HEAP_STATS_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 229 | #ifdef MBED_MEM_TRACING_ENABLED |
| Bogdan Marinescu |
7606:dbabbb13e5b0 | 230 | mem_trace_mutex->lock(); |
| Bogdan Marinescu |
7604:4544d30abb2a | 231 | mbed_mem_trace_malloc(ptr, size, MBED_CALLER_ADDR()); |
| Bogdan Marinescu |
7606:dbabbb13e5b0 | 232 | mem_trace_mutex->unlock(); |
| Bogdan Marinescu |
7604:4544d30abb2a | 233 | #endif // #ifdef MBED_MEM_TRACING_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 234 | return ptr; |
| Bogdan Marinescu |
7604:4544d30abb2a | 235 | } |
| Bogdan Marinescu |
7604:4544d30abb2a | 236 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 237 | extern "C" void* $Sub$$realloc(void *ptr, size_t size) { |
| Bogdan Marinescu |
7604:4544d30abb2a | 238 | void *new_ptr = NULL; |
| Bogdan Marinescu |
7604:4544d30abb2a | 239 | #ifdef MBED_HEAP_STATS_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 240 | // Note - no lock needed since malloc and free are thread safe |
| Bogdan Marinescu |
7604:4544d30abb2a | 241 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 242 | // Get old size |
| Bogdan Marinescu |
7604:4544d30abb2a | 243 | uint32_t old_size = 0; |
| Bogdan Marinescu |
7604:4544d30abb2a | 244 | if (ptr != NULL) { |
| Bogdan Marinescu |
7604:4544d30abb2a | 245 | alloc_info_t *alloc_info = ((alloc_info_t*)ptr) - 1; |
| Bogdan Marinescu |
7604:4544d30abb2a | 246 | old_size = alloc_info->size; |
| Bogdan Marinescu |
7604:4544d30abb2a | 247 | } |
| Bogdan Marinescu |
7604:4544d30abb2a | 248 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 249 | // Allocate space |
| Bogdan Marinescu |
7604:4544d30abb2a | 250 | if (size != 0) { |
| Bogdan Marinescu |
7604:4544d30abb2a | 251 | new_ptr = malloc(size); |
| Bogdan Marinescu |
7604:4544d30abb2a | 252 | } |
| Bogdan Marinescu |
7604:4544d30abb2a | 253 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 254 | // If the new buffer has been allocated copy the data to it |
| Bogdan Marinescu |
7604:4544d30abb2a | 255 | // and free the old buffer |
| Bogdan Marinescu |
7604:4544d30abb2a | 256 | if (new_ptr != NULL) { |
| Bogdan Marinescu |
7604:4544d30abb2a | 257 | uint32_t copy_size = (old_size < size) ? old_size : size; |
| Bogdan Marinescu |
7604:4544d30abb2a | 258 | memcpy(new_ptr, (void*)ptr, copy_size); |
| Bogdan Marinescu |
7604:4544d30abb2a | 259 | free(ptr); |
| Bogdan Marinescu |
7604:4544d30abb2a | 260 | } |
| Bogdan Marinescu |
7604:4544d30abb2a | 261 | #else // #ifdef MBED_HEAP_STATS_ENABLED |
| Bogdan Marinescu |
7606:dbabbb13e5b0 | 262 | mem_trace_mutex->lock(); |
| Bogdan Marinescu |
7604:4544d30abb2a | 263 | new_ptr = $Super$$realloc(ptr, size); |
| Bogdan Marinescu |
7606:dbabbb13e5b0 | 264 | mem_trace_mutex->unlock(); |
| Bogdan Marinescu |
7604:4544d30abb2a | 265 | #endif // #ifdef MBED_HEAP_STATS_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 266 | #ifdef MBED_MEM_TRACING_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 267 | mbed_mem_trace_realloc(new_ptr, ptr, size, MBED_CALLER_ADDR()); |
| Bogdan Marinescu |
7604:4544d30abb2a | 268 | #endif // #ifdef MBED_MEM_TRACING_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 269 | return new_ptr; |
| Bogdan Marinescu |
7604:4544d30abb2a | 270 | } |
| Bogdan Marinescu |
7604:4544d30abb2a | 271 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 272 | extern "C" void *$Sub$$calloc(size_t nmemb, size_t size) { |
| Bogdan Marinescu |
7604:4544d30abb2a | 273 | void *ptr = NULL; |
| Bogdan Marinescu |
7604:4544d30abb2a | 274 | #ifdef MBED_HEAP_STATS_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 275 | // Note - no lock needed since malloc is thread safe |
| Bogdan Marinescu |
7604:4544d30abb2a | 276 | ptr = malloc(nmemb * size); |
| Bogdan Marinescu |
7604:4544d30abb2a | 277 | if (ptr != NULL) { |
| Bogdan Marinescu |
7604:4544d30abb2a | 278 | memset(ptr, 0, nmemb * size); |
| Bogdan Marinescu |
7604:4544d30abb2a | 279 | } |
| Bogdan Marinescu |
7604:4544d30abb2a | 280 | #else // #ifdef MBED_HEAP_STATS_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 281 | ptr = $Super$$calloc(nmemb, size); |
| Bogdan Marinescu |
7604:4544d30abb2a | 282 | #endif // #ifdef MBED_HEAP_STATS_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 283 | #ifdef MBED_MEM_TRACING_ENABLED |
| Bogdan Marinescu |
7606:dbabbb13e5b0 | 284 | mem_trace_mutex->lock(); |
| Bogdan Marinescu |
7604:4544d30abb2a | 285 | mbed_mem_trace_calloc(ptr, nmemb, size, MBED_CALLER_ADDR()); |
| Bogdan Marinescu |
7606:dbabbb13e5b0 | 286 | mem_trace_mutex->unlock(); |
| Bogdan Marinescu |
7604:4544d30abb2a | 287 | #endif // #ifdef MBED_MEM_TRACING_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 288 | return ptr; |
| Bogdan Marinescu |
7604:4544d30abb2a | 289 | } |
| Bogdan Marinescu |
7604:4544d30abb2a | 290 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 291 | extern "C" void $Sub$$free(void *ptr) { |
| Bogdan Marinescu |
7604:4544d30abb2a | 292 | #ifdef MBED_HEAP_STATS_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 293 | malloc_stats_mutex->lock(); |
| Bogdan Marinescu |
7604:4544d30abb2a | 294 | alloc_info_t *alloc_info = NULL; |
| Bogdan Marinescu |
7604:4544d30abb2a | 295 | if (ptr != NULL) { |
| Bogdan Marinescu |
7604:4544d30abb2a | 296 | alloc_info = ((alloc_info_t*)ptr) - 1; |
| Bogdan Marinescu |
7604:4544d30abb2a | 297 | heap_stats.current_size -= alloc_info->size; |
| Bogdan Marinescu |
7604:4544d30abb2a | 298 | heap_stats.alloc_cnt -= 1; |
| Bogdan Marinescu |
7604:4544d30abb2a | 299 | } |
| Bogdan Marinescu |
7604:4544d30abb2a | 300 | $Super$$free((void*)alloc_info); |
| Bogdan Marinescu |
7604:4544d30abb2a | 301 | malloc_stats_mutex->unlock(); |
| Bogdan Marinescu |
7604:4544d30abb2a | 302 | #else // #ifdef MBED_HEAP_STATS_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 303 | $Super$$free(ptr); |
| Bogdan Marinescu |
7604:4544d30abb2a | 304 | #endif // #ifdef MBED_HEAP_STATS_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 305 | #ifdef MBED_MEM_TRACING_ENABLED |
| Bogdan Marinescu |
7606:dbabbb13e5b0 | 306 | mem_trace_mutex->lock(); |
| Bogdan Marinescu |
7604:4544d30abb2a | 307 | mbed_mem_trace_free(ptr, MBED_CALLER_ADDR()); |
| Bogdan Marinescu |
7606:dbabbb13e5b0 | 308 | mem_trace_mutex->unlock(); |
| Bogdan Marinescu |
7604:4544d30abb2a | 309 | #endif // #ifdef MBED_MEM_TRACING_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 310 | } |
| Bogdan Marinescu |
7604:4544d30abb2a | 311 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 312 | #endif // #if defined(MBED_MEM_TRACING_ENABLED) || defined(MBED_HEAP_STATS_ENABLED) |
| Bogdan Marinescu |
7604:4544d30abb2a | 313 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 314 | /******************************************************************************/ |
| Bogdan Marinescu |
7604:4544d30abb2a | 315 | /* Allocation wrappers for other toolchains are not supported yet */ |
| Bogdan Marinescu |
7604:4544d30abb2a | 316 | /******************************************************************************/ |
| Bogdan Marinescu |
7604:4544d30abb2a | 317 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 318 | #else // #if defined(TOOLCHAIN_GCC) |
| Bogdan Marinescu |
7604:4544d30abb2a | 319 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 320 | #ifdef MBED_MEM_TRACING_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 321 | #warning Memory tracing is not supported with the current toolchain. |
| Bogdan Marinescu |
7604:4544d30abb2a | 322 | #endif |
| Bogdan Marinescu |
7604:4544d30abb2a | 323 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 324 | #ifdef MBED_HEAP_STATS_ENABLED |
| Bogdan Marinescu |
7604:4544d30abb2a | 325 | #warning Heap statistics are not supported with the current toolchain. |
| Bogdan Marinescu |
7604:4544d30abb2a | 326 | #endif |
| Bogdan Marinescu |
7604:4544d30abb2a | 327 | |
| Bogdan Marinescu |
7604:4544d30abb2a | 328 | #endif // #if defined(TOOLCHAIN_GCC) |
| Bogdan Marinescu |
7604:4544d30abb2a | 329 |