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