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?
User | Revision | Line number | New 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 | } |