mbed official / mbed

The official Mbed 2 C/C++ SDK provides the software platform and libraries to build your applications.

Dependents:   hello SerialTestv11 SerialTestv12 Sierpinski ... more

mbed 2

This is the mbed 2 library. If you'd like to learn about Mbed OS please see the mbed-os docs.

platform/CThunk.h@160:5571c4ff569f, 2018-01-17 (annotated)

Committer:
Anna Bridge
Date:
Wed Jan 17 16:13:02 2018 +0000
Revision:
160:5571c4ff569f
Parent:
158:1c57384330a6
Child:
161:aa5281ff4a02
mbed library. Release version 158

Who changed what in which revision?

UserRevisionLine numberNew contents of line
AnnaBridge 156:ff21514d8981 1
AnnaBridge 156:ff21514d8981 2 /** \addtogroup platform */
AnnaBridge 156:ff21514d8981 3 /** @{*/
AnnaBridge 158:1c57384330a6 4 /**
AnnaBridge 158:1c57384330a6 5 * \defgroup platform_CThunk CThunk class
AnnaBridge 158:1c57384330a6 6 * @{
AnnaBridge 158:1c57384330a6 7 */
AnnaBridge 156:ff21514d8981 8 /* General C++ Object Thunking class
AnnaBridge 156:ff21514d8981 9 *
AnnaBridge 156:ff21514d8981 10 * - allows direct callbacks to non-static C++ class functions
AnnaBridge 156:ff21514d8981 11 * - keeps track for the corresponding class instance
AnnaBridge 156:ff21514d8981 12 * - supports an optional context parameter for the called function
AnnaBridge 156:ff21514d8981 13 * - ideally suited for class object receiving interrupts (NVIC_SetVector)
AnnaBridge 156:ff21514d8981 14 *
AnnaBridge 156:ff21514d8981 15 * Copyright (c) 2014-2015 ARM Limited
AnnaBridge 156:ff21514d8981 16 *
AnnaBridge 156:ff21514d8981 17 * Licensed under the Apache License, Version 2.0 (the "License");
AnnaBridge 156:ff21514d8981 18 * you may not use this file except in compliance with the License.
AnnaBridge 156:ff21514d8981 19 * You may obtain a copy of the License at
AnnaBridge 156:ff21514d8981 20 *
AnnaBridge 156:ff21514d8981 21 * http://www.apache.org/licenses/LICENSE-2.0
AnnaBridge 156:ff21514d8981 22 *
AnnaBridge 156:ff21514d8981 23 * Unless required by applicable law or agreed to in writing, software
AnnaBridge 156:ff21514d8981 24 * distributed under the License is distributed on an "AS IS" BASIS,
AnnaBridge 156:ff21514d8981 25 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
AnnaBridge 156:ff21514d8981 26 * See the License for the specific language governing permissions and
AnnaBridge 156:ff21514d8981 27 * limitations under the License.
AnnaBridge 156:ff21514d8981 28 */
AnnaBridge 156:ff21514d8981 29
AnnaBridge 156:ff21514d8981 30 /* General C++ Object Thunking class
AnnaBridge 156:ff21514d8981 31 *
AnnaBridge 156:ff21514d8981 32 * - allows direct callbacks to non-static C++ class functions
AnnaBridge 156:ff21514d8981 33 * - keeps track for the corresponding class instance
AnnaBridge 156:ff21514d8981 34 * - supports an optional context parameter for the called function
AnnaBridge 156:ff21514d8981 35 * - ideally suited for class object receiving interrupts (NVIC_SetVector)
AnnaBridge 156:ff21514d8981 36 */
AnnaBridge 156:ff21514d8981 37
AnnaBridge 156:ff21514d8981 38 #ifndef __CTHUNK_H__
AnnaBridge 156:ff21514d8981 39 #define __CTHUNK_H__
AnnaBridge 156:ff21514d8981 40
AnnaBridge 156:ff21514d8981 41 #define CTHUNK_ADDRESS 1
AnnaBridge 156:ff21514d8981 42 #define CTHUNK_VARIABLES volatile uint32_t code[2]
AnnaBridge 156:ff21514d8981 43
AnnaBridge 156:ff21514d8981 44 #if (defined(__CORTEX_M3) || defined(__CORTEX_M4) || defined(__CORTEX_M7) || defined(__CORTEX_A9) \
AnnaBridge 156:ff21514d8981 45 || defined(__CORTEX_M23) || defined(__CORTEX_M33))
AnnaBridge 156:ff21514d8981 46 /**
AnnaBridge 156:ff21514d8981 47 * CTHUNK disassembly for Cortex-M3/M4/M7/A9 (thumb2):
AnnaBridge 156:ff21514d8981 48 * * adr r0, #4
AnnaBridge 156:ff21514d8981 49 * * ldm r0, {r0, r1, r2, pc}
AnnaBridge 156:ff21514d8981 50 *
AnnaBridge 156:ff21514d8981 51 * This instruction loads the arguments for the static thunking function to r0-r2, and
AnnaBridge 156:ff21514d8981 52 * branches to that function by loading its address into PC.
AnnaBridge 156:ff21514d8981 53 *
AnnaBridge 156:ff21514d8981 54 * This is safe for both regular calling and interrupt calling, since it only touches scratch registers
AnnaBridge 156:ff21514d8981 55 * which should be saved by the caller, and are automatically saved as part of the IRQ context switch.
AnnaBridge 156:ff21514d8981 56 */
AnnaBridge 156:ff21514d8981 57 #define CTHUNK_ASSIGMENT do { \
AnnaBridge 156:ff21514d8981 58 m_thunk.code[0] = 0xE890A001; \
AnnaBridge 156:ff21514d8981 59 m_thunk.code[1] = 0x00008007; \
AnnaBridge 156:ff21514d8981 60 } while (0)
AnnaBridge 156:ff21514d8981 61
AnnaBridge 156:ff21514d8981 62 #elif (defined(__CORTEX_M0PLUS) || defined(__CORTEX_M0))
AnnaBridge 156:ff21514d8981 63 /*
AnnaBridge 156:ff21514d8981 64 * CTHUNK disassembly for Cortex M0/M0+ (thumb):
AnnaBridge 156:ff21514d8981 65 * * adr r0, #4
AnnaBridge 156:ff21514d8981 66 * * ldm r0, {r0, r1, r2, r3}
AnnaBridge 156:ff21514d8981 67 * * bx r3
AnnaBridge 156:ff21514d8981 68 */
AnnaBridge 156:ff21514d8981 69 #define CTHUNK_ASSIGMENT do { \
AnnaBridge 156:ff21514d8981 70 m_thunk.code[0] = 0xC80FA001; \
AnnaBridge 156:ff21514d8981 71 m_thunk.code[1] = 0x00004718; \
AnnaBridge 156:ff21514d8981 72 } while (0)
AnnaBridge 156:ff21514d8981 73
AnnaBridge 156:ff21514d8981 74 #else
AnnaBridge 156:ff21514d8981 75 #error "Target is not currently suported."
AnnaBridge 156:ff21514d8981 76 #endif
AnnaBridge 156:ff21514d8981 77
AnnaBridge 156:ff21514d8981 78 /* IRQ/Exception compatible thunk entry function */
AnnaBridge 156:ff21514d8981 79 typedef void (*CThunkEntry)(void);
AnnaBridge 156:ff21514d8981 80
AnnaBridge 156:ff21514d8981 81 /**
AnnaBridge 156:ff21514d8981 82 * Class for created a pointer with data bound to it
AnnaBridge 156:ff21514d8981 83 *
AnnaBridge 156:ff21514d8981 84 * @note Synchronization level: Not protected
AnnaBridge 156:ff21514d8981 85 */
AnnaBridge 156:ff21514d8981 86 template<class T>
AnnaBridge 156:ff21514d8981 87 class CThunk
AnnaBridge 156:ff21514d8981 88 {
AnnaBridge 156:ff21514d8981 89 public:
AnnaBridge 156:ff21514d8981 90 typedef void (T::*CCallbackSimple)(void);
AnnaBridge 156:ff21514d8981 91 typedef void (T::*CCallback)(void* context);
AnnaBridge 156:ff21514d8981 92
AnnaBridge 156:ff21514d8981 93 inline CThunk(T *instance)
AnnaBridge 156:ff21514d8981 94 {
AnnaBridge 156:ff21514d8981 95 init(instance, NULL, NULL);
AnnaBridge 156:ff21514d8981 96 }
AnnaBridge 156:ff21514d8981 97
AnnaBridge 156:ff21514d8981 98 inline CThunk(T *instance, CCallback callback)
AnnaBridge 156:ff21514d8981 99 {
AnnaBridge 156:ff21514d8981 100 init(instance, callback, NULL);
AnnaBridge 156:ff21514d8981 101 }
AnnaBridge 156:ff21514d8981 102
AnnaBridge 156:ff21514d8981 103 ~CThunk() {
AnnaBridge 156:ff21514d8981 104
AnnaBridge 156:ff21514d8981 105 }
AnnaBridge 156:ff21514d8981 106
AnnaBridge 156:ff21514d8981 107 inline CThunk(T *instance, CCallbackSimple callback)
AnnaBridge 156:ff21514d8981 108 {
AnnaBridge 156:ff21514d8981 109 init(instance, (CCallback)callback, NULL);
AnnaBridge 156:ff21514d8981 110 }
AnnaBridge 156:ff21514d8981 111
AnnaBridge 156:ff21514d8981 112 inline CThunk(T &instance, CCallback callback)
AnnaBridge 156:ff21514d8981 113 {
AnnaBridge 156:ff21514d8981 114 init(instance, callback, NULL);
AnnaBridge 156:ff21514d8981 115 }
AnnaBridge 156:ff21514d8981 116
AnnaBridge 156:ff21514d8981 117 inline CThunk(T &instance, CCallbackSimple callback)
AnnaBridge 156:ff21514d8981 118 {
AnnaBridge 156:ff21514d8981 119 init(instance, (CCallback)callback, NULL);
AnnaBridge 156:ff21514d8981 120 }
AnnaBridge 156:ff21514d8981 121
AnnaBridge 156:ff21514d8981 122 inline CThunk(T &instance, CCallback callback, void* context)
AnnaBridge 156:ff21514d8981 123 {
AnnaBridge 156:ff21514d8981 124 init(instance, callback, context);
AnnaBridge 156:ff21514d8981 125 }
AnnaBridge 156:ff21514d8981 126
AnnaBridge 156:ff21514d8981 127 inline void callback(CCallback callback)
AnnaBridge 156:ff21514d8981 128 {
AnnaBridge 156:ff21514d8981 129 m_callback = callback;
AnnaBridge 156:ff21514d8981 130 }
AnnaBridge 156:ff21514d8981 131
AnnaBridge 156:ff21514d8981 132 inline void callback(CCallbackSimple callback)
AnnaBridge 156:ff21514d8981 133 {
AnnaBridge 156:ff21514d8981 134 m_callback = (CCallback)callback;
AnnaBridge 156:ff21514d8981 135 }
AnnaBridge 156:ff21514d8981 136
AnnaBridge 156:ff21514d8981 137 inline void context(void* context)
AnnaBridge 156:ff21514d8981 138 {
AnnaBridge 156:ff21514d8981 139 m_thunk.context = (uint32_t)context;
AnnaBridge 156:ff21514d8981 140 }
AnnaBridge 156:ff21514d8981 141
AnnaBridge 156:ff21514d8981 142 inline void context(uint32_t context)
AnnaBridge 156:ff21514d8981 143 {
AnnaBridge 156:ff21514d8981 144 m_thunk.context = context;
AnnaBridge 156:ff21514d8981 145 }
AnnaBridge 156:ff21514d8981 146
AnnaBridge 156:ff21514d8981 147 inline uint32_t entry(void)
AnnaBridge 156:ff21514d8981 148 {
AnnaBridge 156:ff21514d8981 149 return (((uint32_t)&m_thunk)|CTHUNK_ADDRESS);
AnnaBridge 156:ff21514d8981 150 }
AnnaBridge 156:ff21514d8981 151
AnnaBridge 156:ff21514d8981 152 /* get thunk entry point for connecting rhunk to an IRQ table */
AnnaBridge 156:ff21514d8981 153 inline operator CThunkEntry(void)
AnnaBridge 156:ff21514d8981 154 {
AnnaBridge 156:ff21514d8981 155 return (CThunkEntry)entry();
AnnaBridge 156:ff21514d8981 156 }
AnnaBridge 156:ff21514d8981 157
AnnaBridge 156:ff21514d8981 158 /* get thunk entry point for connecting rhunk to an IRQ table */
AnnaBridge 156:ff21514d8981 159 inline operator uint32_t(void)
AnnaBridge 156:ff21514d8981 160 {
AnnaBridge 156:ff21514d8981 161 return entry();
AnnaBridge 156:ff21514d8981 162 }
AnnaBridge 156:ff21514d8981 163
AnnaBridge 156:ff21514d8981 164 /* simple test function */
AnnaBridge 156:ff21514d8981 165 inline void call(void)
AnnaBridge 156:ff21514d8981 166 {
AnnaBridge 156:ff21514d8981 167 (((CThunkEntry)(entry()))());
AnnaBridge 156:ff21514d8981 168 }
AnnaBridge 156:ff21514d8981 169
AnnaBridge 156:ff21514d8981 170 private:
AnnaBridge 156:ff21514d8981 171 T* m_instance;
AnnaBridge 156:ff21514d8981 172 volatile CCallback m_callback;
AnnaBridge 156:ff21514d8981 173
AnnaBridge 156:ff21514d8981 174 // TODO: this needs proper fix, to refactor toolchain header file and all its use
AnnaBridge 156:ff21514d8981 175 // PACKED there is not defined properly for IAR
AnnaBridge 156:ff21514d8981 176 #if defined (__ICCARM__)
AnnaBridge 156:ff21514d8981 177 typedef __packed struct
AnnaBridge 156:ff21514d8981 178 {
AnnaBridge 156:ff21514d8981 179 CTHUNK_VARIABLES;
AnnaBridge 156:ff21514d8981 180 volatile uint32_t instance;
AnnaBridge 156:ff21514d8981 181 volatile uint32_t context;
AnnaBridge 156:ff21514d8981 182 volatile uint32_t callback;
AnnaBridge 156:ff21514d8981 183 volatile uint32_t trampoline;
AnnaBridge 156:ff21514d8981 184 } CThunkTrampoline;
AnnaBridge 156:ff21514d8981 185 #else
AnnaBridge 156:ff21514d8981 186 typedef struct
AnnaBridge 156:ff21514d8981 187 {
AnnaBridge 156:ff21514d8981 188 CTHUNK_VARIABLES;
AnnaBridge 156:ff21514d8981 189 volatile uint32_t instance;
AnnaBridge 156:ff21514d8981 190 volatile uint32_t context;
AnnaBridge 156:ff21514d8981 191 volatile uint32_t callback;
AnnaBridge 156:ff21514d8981 192 volatile uint32_t trampoline;
AnnaBridge 156:ff21514d8981 193 } __attribute__((__packed__)) CThunkTrampoline;
AnnaBridge 156:ff21514d8981 194 #endif
AnnaBridge 156:ff21514d8981 195
AnnaBridge 156:ff21514d8981 196 static void trampoline(T* instance, void* context, CCallback* callback)
AnnaBridge 156:ff21514d8981 197 {
AnnaBridge 156:ff21514d8981 198 if(instance && *callback) {
AnnaBridge 156:ff21514d8981 199 (static_cast<T*>(instance)->**callback)(context);
AnnaBridge 156:ff21514d8981 200 }
AnnaBridge 156:ff21514d8981 201 }
AnnaBridge 156:ff21514d8981 202
AnnaBridge 156:ff21514d8981 203 volatile CThunkTrampoline m_thunk;
AnnaBridge 156:ff21514d8981 204
AnnaBridge 156:ff21514d8981 205 inline void init(T *instance, CCallback callback, void* context)
AnnaBridge 156:ff21514d8981 206 {
AnnaBridge 156:ff21514d8981 207 /* remember callback - need to add this level of redirection
AnnaBridge 156:ff21514d8981 208 as pointer size for member functions differs between platforms */
AnnaBridge 156:ff21514d8981 209 m_callback = callback;
AnnaBridge 156:ff21514d8981 210
AnnaBridge 156:ff21514d8981 211 /* populate thunking trampoline */
AnnaBridge 156:ff21514d8981 212 CTHUNK_ASSIGMENT;
AnnaBridge 156:ff21514d8981 213 m_thunk.context = (uint32_t)context;
AnnaBridge 156:ff21514d8981 214 m_thunk.instance = (uint32_t)instance;
AnnaBridge 156:ff21514d8981 215 m_thunk.callback = (uint32_t)&m_callback;
AnnaBridge 156:ff21514d8981 216 m_thunk.trampoline = (uint32_t)&trampoline;
AnnaBridge 156:ff21514d8981 217
AnnaBridge 156:ff21514d8981 218 #if defined(__CORTEX_A9)
AnnaBridge 156:ff21514d8981 219 /* Data cache clean */
AnnaBridge 156:ff21514d8981 220 /* Cache control */
AnnaBridge 156:ff21514d8981 221 {
AnnaBridge 156:ff21514d8981 222 uint32_t start_addr = (uint32_t)&m_thunk & 0xFFFFFFE0;
AnnaBridge 156:ff21514d8981 223 uint32_t end_addr = (uint32_t)&m_thunk + sizeof(m_thunk);
AnnaBridge 156:ff21514d8981 224 uint32_t addr;
Anna Bridge 160:5571c4ff569f 225
AnnaBridge 156:ff21514d8981 226 /* Data cache clean and invalid */
AnnaBridge 156:ff21514d8981 227 for (addr = start_addr; addr < end_addr; addr += 0x20) {
Anna Bridge 160:5571c4ff569f 228 L1C_CleanInvalidateDCacheMVA((void *)addr);
AnnaBridge 156:ff21514d8981 229 }
AnnaBridge 156:ff21514d8981 230 /* Instruction cache invalid */
Anna Bridge 160:5571c4ff569f 231 L1C_InvalidateICacheAll();
Anna Bridge 160:5571c4ff569f 232 MMU_InvalidateTLB();
Anna Bridge 160:5571c4ff569f 233 L1C_InvalidateBTAC();
AnnaBridge 156:ff21514d8981 234 }
AnnaBridge 156:ff21514d8981 235 #endif
AnnaBridge 156:ff21514d8981 236 #if defined(__CORTEX_M7)
AnnaBridge 156:ff21514d8981 237 /* Data cache clean and invalid */
AnnaBridge 156:ff21514d8981 238 SCB_CleanInvalidateDCache();
AnnaBridge 156:ff21514d8981 239
AnnaBridge 156:ff21514d8981 240 /* Instruction cache invalid */
AnnaBridge 156:ff21514d8981 241 SCB_InvalidateICache();
AnnaBridge 156:ff21514d8981 242 #endif
AnnaBridge 156:ff21514d8981 243 __ISB();
AnnaBridge 156:ff21514d8981 244 __DSB();
AnnaBridge 156:ff21514d8981 245 }
AnnaBridge 156:ff21514d8981 246 };
AnnaBridge 156:ff21514d8981 247
AnnaBridge 158:1c57384330a6 248 /**@}*/
AnnaBridge 158:1c57384330a6 249
AnnaBridge 158:1c57384330a6 250 /**@}*/
AnnaBridge 158:1c57384330a6 251
AnnaBridge 156:ff21514d8981 252 #endif/*__CTHUNK_H__*/
AnnaBridge 156:ff21514d8981 253