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