mbed official / mbed-dev

mbed library sources. Supersedes mbed-src.

Dependents:   Nucleo_Hello_Encoder BLE_iBeaconScan AM1805_DEMO DISCO-F429ZI_ExportTemplate1 ... more

platform/CThunkBase.cpp@189:f392fc9709a3, 2019-02-20 (annotated)

Committer:
AnnaBridge
Date:
Wed Feb 20 22:31:08 2019 +0000
Revision:
189:f392fc9709a3
mbed library release version 165

Who changed what in which revision?

UserRevisionLine numberNew contents of line
AnnaBridge 189:f392fc9709a3 1 /* mbed Microcontroller Library
AnnaBridge 189:f392fc9709a3 2 * Copyright (c) 2018-2018 ARM Limited
AnnaBridge 189:f392fc9709a3 3 * SPDX-License-Identifier: Apache-2.0
AnnaBridge 189:f392fc9709a3 4 *
AnnaBridge 189:f392fc9709a3 5 * Licensed under the Apache License, Version 2.0 (the "License");
AnnaBridge 189:f392fc9709a3 6 * you may not use this file except in compliance with the License.
AnnaBridge 189:f392fc9709a3 7 * You may obtain a copy of the License at
AnnaBridge 189:f392fc9709a3 8 *
AnnaBridge 189:f392fc9709a3 9 * http://www.apache.org/licenses/LICENSE-2.0
AnnaBridge 189:f392fc9709a3 10 *
AnnaBridge 189:f392fc9709a3 11 * Unless required by applicable law or agreed to in writing, software
AnnaBridge 189:f392fc9709a3 12 * distributed under the License is distributed on an "AS IS" BASIS,
AnnaBridge 189:f392fc9709a3 13 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
AnnaBridge 189:f392fc9709a3 14 * See the License for the specific language governing permissions and
AnnaBridge 189:f392fc9709a3 15 * limitations under the License.
AnnaBridge 189:f392fc9709a3 16 */
AnnaBridge 189:f392fc9709a3 17
AnnaBridge 189:f392fc9709a3 18 #include "platform/platform.h"
AnnaBridge 189:f392fc9709a3 19 #include "platform/mbed_critical.h"
AnnaBridge 189:f392fc9709a3 20 #include "platform/mbed_assert.h"
AnnaBridge 189:f392fc9709a3 21 #include "platform/mbed_error.h"
AnnaBridge 189:f392fc9709a3 22
AnnaBridge 189:f392fc9709a3 23
AnnaBridge 189:f392fc9709a3 24 #include "CThunkBase.h"
AnnaBridge 189:f392fc9709a3 25
AnnaBridge 189:f392fc9709a3 26 MBED_STATIC_ASSERT(MBED_CONF_PLATFORM_CTHUNK_COUNT_MAX < 256, "MBED_CONF_PLATFORM_CTHUNK_COUNT_MAX must be less than 256");
AnnaBridge 189:f392fc9709a3 27 MBED_STATIC_ASSERT(MBED_CONF_PLATFORM_CTHUNK_COUNT_MAX > 0, "MBED_CONF_PLATFORM_CTHUNK_COUNT_MAX must be greater than 0");
AnnaBridge 189:f392fc9709a3 28
AnnaBridge 189:f392fc9709a3 29 #define ENABLE_N(N) ((MBED_CONF_PLATFORM_CTHUNK_COUNT_MAX & N) ? 1 : 0)
AnnaBridge 189:f392fc9709a3 30
AnnaBridge 189:f392fc9709a3 31 #define START_128 0
AnnaBridge 189:f392fc9709a3 32 #define START_64 (START_128 + ENABLE_N(128) * 128)
AnnaBridge 189:f392fc9709a3 33 #define START_32 (START_64 + ENABLE_N(64) * 64)
AnnaBridge 189:f392fc9709a3 34 #define START_16 (START_32 + ENABLE_N(32) * 32)
AnnaBridge 189:f392fc9709a3 35 #define START_8 (START_16 + ENABLE_N(16) * 16)
AnnaBridge 189:f392fc9709a3 36 #define START_4 (START_8 + ENABLE_N(8) * 8)
AnnaBridge 189:f392fc9709a3 37 #define START_2 (START_4 + ENABLE_N(4) * 4)
AnnaBridge 189:f392fc9709a3 38 #define START_1 (START_2 + ENABLE_N(2) * 2)
AnnaBridge 189:f392fc9709a3 39
AnnaBridge 189:f392fc9709a3 40 #define DECLARE_THUNK128(start) \
AnnaBridge 189:f392fc9709a3 41 DECLARE_THUNK64(start), \
AnnaBridge 189:f392fc9709a3 42 DECLARE_THUNK64(start + 64)
AnnaBridge 189:f392fc9709a3 43 #define DECLARE_THUNK64(start) \
AnnaBridge 189:f392fc9709a3 44 DECLARE_THUNK32(start), \
AnnaBridge 189:f392fc9709a3 45 DECLARE_THUNK32(start + 32)
AnnaBridge 189:f392fc9709a3 46 #define DECLARE_THUNK32(start) \
AnnaBridge 189:f392fc9709a3 47 DECLARE_THUNK16(start), \
AnnaBridge 189:f392fc9709a3 48 DECLARE_THUNK16(start + 16)
AnnaBridge 189:f392fc9709a3 49 #define DECLARE_THUNK16(start) \
AnnaBridge 189:f392fc9709a3 50 DECLARE_THUNK8(start), \
AnnaBridge 189:f392fc9709a3 51 DECLARE_THUNK8(start + 8)
AnnaBridge 189:f392fc9709a3 52 #define DECLARE_THUNK8(start) \
AnnaBridge 189:f392fc9709a3 53 DECLARE_THUNK4(start), \
AnnaBridge 189:f392fc9709a3 54 DECLARE_THUNK4(start + 4)
AnnaBridge 189:f392fc9709a3 55 #define DECLARE_THUNK4(start) \
AnnaBridge 189:f392fc9709a3 56 DECLARE_THUNK2(start), \
AnnaBridge 189:f392fc9709a3 57 DECLARE_THUNK2(start + 2)
AnnaBridge 189:f392fc9709a3 58 #define DECLARE_THUNK2(start) \
AnnaBridge 189:f392fc9709a3 59 DECLARE_THUNK1(start), \
AnnaBridge 189:f392fc9709a3 60 DECLARE_THUNK1(start + 1)
AnnaBridge 189:f392fc9709a3 61 #define DECLARE_THUNK1(index) &CThunkBase::thunk_entry<index>
AnnaBridge 189:f392fc9709a3 62
AnnaBridge 189:f392fc9709a3 63 const CThunkEntry CThunkBase::_thunk_table[MBED_CONF_PLATFORM_CTHUNK_COUNT_MAX] = {
AnnaBridge 189:f392fc9709a3 64 #if ENABLE_N(128)
AnnaBridge 189:f392fc9709a3 65 DECLARE_THUNK128(START_128),
AnnaBridge 189:f392fc9709a3 66 #endif
AnnaBridge 189:f392fc9709a3 67 #if ENABLE_N(64)
AnnaBridge 189:f392fc9709a3 68 DECLARE_THUNK64(START_64),
AnnaBridge 189:f392fc9709a3 69 #endif
AnnaBridge 189:f392fc9709a3 70 #if ENABLE_N(32)
AnnaBridge 189:f392fc9709a3 71 DECLARE_THUNK32(START_32),
AnnaBridge 189:f392fc9709a3 72 #endif
AnnaBridge 189:f392fc9709a3 73 #if ENABLE_N(16)
AnnaBridge 189:f392fc9709a3 74 DECLARE_THUNK16(START_16),
AnnaBridge 189:f392fc9709a3 75 #endif
AnnaBridge 189:f392fc9709a3 76 #if ENABLE_N(8)
AnnaBridge 189:f392fc9709a3 77 DECLARE_THUNK8(START_8),
AnnaBridge 189:f392fc9709a3 78 #endif
AnnaBridge 189:f392fc9709a3 79 #if ENABLE_N(4)
AnnaBridge 189:f392fc9709a3 80 DECLARE_THUNK4(START_4),
AnnaBridge 189:f392fc9709a3 81 #endif
AnnaBridge 189:f392fc9709a3 82 #if ENABLE_N(2)
AnnaBridge 189:f392fc9709a3 83 DECLARE_THUNK2(START_2),
AnnaBridge 189:f392fc9709a3 84 #endif
AnnaBridge 189:f392fc9709a3 85 #if ENABLE_N(1)
AnnaBridge 189:f392fc9709a3 86 DECLARE_THUNK1(START_1)
AnnaBridge 189:f392fc9709a3 87 #endif
AnnaBridge 189:f392fc9709a3 88 };
AnnaBridge 189:f392fc9709a3 89
AnnaBridge 189:f392fc9709a3 90 CThunkBase *CThunkBase::_thunk_storage[MBED_CONF_PLATFORM_CTHUNK_COUNT_MAX];
AnnaBridge 189:f392fc9709a3 91
AnnaBridge 189:f392fc9709a3 92 CThunkBase::CthunkFree CThunkBase::_cthunk_free_real = NULL;
AnnaBridge 189:f392fc9709a3 93
AnnaBridge 189:f392fc9709a3 94 CThunkEntry CThunkBase::cthunk_alloc(CThunkBase *cthunk)
AnnaBridge 189:f392fc9709a3 95 {
AnnaBridge 189:f392fc9709a3 96 // Atomically allocate one entry
AnnaBridge 189:f392fc9709a3 97 core_util_critical_section_enter();
AnnaBridge 189:f392fc9709a3 98 CThunkEntry entry = NULL;
AnnaBridge 189:f392fc9709a3 99 for (int i = 0; i < MBED_CONF_PLATFORM_CTHUNK_COUNT_MAX; i++) {
AnnaBridge 189:f392fc9709a3 100 if (_thunk_storage[i] == NULL) {
AnnaBridge 189:f392fc9709a3 101 _thunk_storage[i] = cthunk;
AnnaBridge 189:f392fc9709a3 102 entry = _thunk_table[i];
AnnaBridge 189:f392fc9709a3 103 break;
AnnaBridge 189:f392fc9709a3 104 }
AnnaBridge 189:f392fc9709a3 105 }
AnnaBridge 189:f392fc9709a3 106 core_util_critical_section_exit();
AnnaBridge 189:f392fc9709a3 107
AnnaBridge 189:f392fc9709a3 108 if (entry == NULL) {
AnnaBridge 189:f392fc9709a3 109 MBED_ERROR(MBED_MAKE_ERROR(MBED_MODULE_PLATFORM, MBED_ERROR_CODE_OUT_OF_RESOURCES), "Ran out of CThunk entries. Increase MBED_CONF_PLATFORM_CTHUNK_COUNT_MAX to fix this error");
AnnaBridge 189:f392fc9709a3 110 }
AnnaBridge 189:f392fc9709a3 111
AnnaBridge 189:f392fc9709a3 112 // Set function pointer on first use. This allows _thunk_table
AnnaBridge 189:f392fc9709a3 113 // and _thunk_storage to get removed by the linker if
AnnaBridge 189:f392fc9709a3 114 // cthunk_alloc is never used.
AnnaBridge 189:f392fc9709a3 115 _cthunk_free_real = &cthunk_free_real;
AnnaBridge 189:f392fc9709a3 116
AnnaBridge 189:f392fc9709a3 117 return entry;
AnnaBridge 189:f392fc9709a3 118 }
AnnaBridge 189:f392fc9709a3 119
AnnaBridge 189:f392fc9709a3 120 void CThunkBase::cthunk_free(CThunkEntry item)
AnnaBridge 189:f392fc9709a3 121 {
AnnaBridge 189:f392fc9709a3 122 if (_cthunk_free_real) {
AnnaBridge 189:f392fc9709a3 123 _cthunk_free_real(item);
AnnaBridge 189:f392fc9709a3 124 }
AnnaBridge 189:f392fc9709a3 125 }
AnnaBridge 189:f392fc9709a3 126
AnnaBridge 189:f392fc9709a3 127 void CThunkBase::cthunk_free_real(CThunkEntry item)
AnnaBridge 189:f392fc9709a3 128 {
AnnaBridge 189:f392fc9709a3 129 bool found = false;
AnnaBridge 189:f392fc9709a3 130
AnnaBridge 189:f392fc9709a3 131 core_util_critical_section_enter();
AnnaBridge 189:f392fc9709a3 132 for (int i = 0; i < MBED_CONF_PLATFORM_CTHUNK_COUNT_MAX; i++) {
AnnaBridge 189:f392fc9709a3 133 if (_thunk_table[i] == item) {
AnnaBridge 189:f392fc9709a3 134 _thunk_storage[i] = NULL;
AnnaBridge 189:f392fc9709a3 135 found = true;
AnnaBridge 189:f392fc9709a3 136 break;
AnnaBridge 189:f392fc9709a3 137 }
AnnaBridge 189:f392fc9709a3 138 }
AnnaBridge 189:f392fc9709a3 139 core_util_critical_section_exit();
AnnaBridge 189:f392fc9709a3 140
AnnaBridge 189:f392fc9709a3 141 if (!found) {
AnnaBridge 189:f392fc9709a3 142 MBED_ERROR(MBED_MAKE_ERROR(MBED_MODULE_PLATFORM, MBED_ERROR_CODE_INVALID_ARGUMENT), "Tried to free invalid CThunkEntry");
AnnaBridge 189:f392fc9709a3 143 }
AnnaBridge 189:f392fc9709a3 144
AnnaBridge 189:f392fc9709a3 145 }