PHung Tung / DISCO-F746_WAV_PLAYER

SPKT

Dependencies:   F746_GUI SD_PlayerSkeleton F746_SAI_IO

SRC_STM32F7/api/CThunk.h@0:8ede47d38d10, 2019-06-04 (annotated)

Committer:
phungductung
Date:
Tue Jun 04 21:37:21 2019 +0000
Revision:
0:8ede47d38d10
SPKT

Who changed what in which revision?

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