Pedro Correia / mbed-dev

mbed library sources. Supersedes mbed-src.

Fork of mbed-dev by mbed official

platform/mbed_critical.c@184:08ed48f1de7f, 2018-04-19 (annotated)

Committer:
AnnaBridge
Date:
Thu Apr 19 17:12:19 2018 +0100
Revision:
184:08ed48f1de7f
Parent:
180:96ed750bd169 
mbed-dev library. Release version 161

Who changed what in which revision?

UserRevisionLine numberNew contents of line
<> 149:156823d33999 1 /*
<> 149:156823d33999 2 * Copyright (c) 2015-2016, ARM Limited, All Rights Reserved
<> 149:156823d33999 3 * SPDX-License-Identifier: Apache-2.0
<> 149:156823d33999 4 *
<> 149:156823d33999 5 * Licensed under the Apache License, Version 2.0 (the "License"); you may
<> 149:156823d33999 6 * not use this file except in compliance with the License.
<> 149:156823d33999 7 * You may obtain a copy of the License at
<> 149:156823d33999 8 *
<> 149:156823d33999 9 * http://www.apache.org/licenses/LICENSE-2.0
<> 149:156823d33999 10 *
<> 149:156823d33999 11 * Unless required by applicable law or agreed to in writing, software
<> 149:156823d33999 12 * distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
<> 149:156823d33999 13 * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
<> 149:156823d33999 14 * See the License for the specific language governing permissions and
<> 149:156823d33999 15 * limitations under the License.
<> 149:156823d33999 16 */
<> 149:156823d33999 17
<> 153:fa9ff456f731 18 /* Declare __STDC_LIMIT_MACROS so stdint.h defines UINT32_MAX when using C++ */
<> 153:fa9ff456f731 19 #define __STDC_LIMIT_MACROS
AnnaBridge 184:08ed48f1de7f 20 #include "hal/critical_section_api.h"
<> 149:156823d33999 21
<> 149:156823d33999 22 #include "cmsis.h"
<> 149:156823d33999 23 #include "platform/mbed_assert.h"
AnnaBridge 184:08ed48f1de7f 24 #include "platform/mbed_critical.h"
<> 160:d5399cc887bb 25 #include "platform/mbed_toolchain.h"
<> 149:156823d33999 26
AnnaBridge 184:08ed48f1de7f 27 // if __EXCLUSIVE_ACCESS rtx macro not defined, we need to get this via own-set architecture macros
AnnaBridge 184:08ed48f1de7f 28 #ifndef MBED_EXCLUSIVE_ACCESS
AnnaBridge 184:08ed48f1de7f 29 #ifndef __EXCLUSIVE_ACCESS
AnnaBridge 184:08ed48f1de7f 30 #if ((__ARM_ARCH_7M__ == 1U) || \
AnnaBridge 184:08ed48f1de7f 31 (__ARM_ARCH_7EM__ == 1U) || \
AnnaBridge 184:08ed48f1de7f 32 (__ARM_ARCH_8M_BASE__ == 1U) || \
AnnaBridge 184:08ed48f1de7f 33 (__ARM_ARCH_8M_MAIN__ == 1U)) || \
AnnaBridge 184:08ed48f1de7f 34 (__ARM_ARCH_7A__ == 1U)
AnnaBridge 184:08ed48f1de7f 35 #define MBED_EXCLUSIVE_ACCESS 1U
AnnaBridge 184:08ed48f1de7f 36 #elif (__ARM_ARCH_6M__ == 1U)
AnnaBridge 184:08ed48f1de7f 37 #define MBED_EXCLUSIVE_ACCESS 0U
AnnaBridge 184:08ed48f1de7f 38 #else
AnnaBridge 184:08ed48f1de7f 39 #error "Unknown architecture for exclusive access"
AnnaBridge 184:08ed48f1de7f 40 #endif
AnnaBridge 184:08ed48f1de7f 41 #else
AnnaBridge 184:08ed48f1de7f 42 #define MBED_EXCLUSIVE_ACCESS __EXCLUSIVE_ACCESS
AnnaBridge 184:08ed48f1de7f 43 #endif
AnnaBridge 184:08ed48f1de7f 44 #endif
AnnaBridge 184:08ed48f1de7f 45
AnnaBridge 184:08ed48f1de7f 46 static volatile uint32_t critical_section_reentrancy_counter = 0;
<> 149:156823d33999 47
<> 149:156823d33999 48 bool core_util_are_interrupts_enabled(void)
<> 149:156823d33999 49 {
<> 149:156823d33999 50 #if defined(__CORTEX_A9)
<> 149:156823d33999 51 return ((__get_CPSR() & 0x80) == 0);
<> 149:156823d33999 52 #else
<> 149:156823d33999 53 return ((__get_PRIMASK() & 0x1) == 0);
<> 149:156823d33999 54 #endif
<> 149:156823d33999 55 }
<> 149:156823d33999 56
AnnaBridge 167:e84263d55307 57 bool core_util_is_isr_active(void)
AnnaBridge 167:e84263d55307 58 {
AnnaBridge 167:e84263d55307 59 #if defined(__CORTEX_A9)
AnnaBridge 167:e84263d55307 60 switch(__get_CPSR() & 0x1FU) {
Anna Bridge 180:96ed750bd169 61 case CPSR_M_USR:
Anna Bridge 180:96ed750bd169 62 case CPSR_M_SYS:
AnnaBridge 167:e84263d55307 63 return false;
Anna Bridge 180:96ed750bd169 64 case CPSR_M_SVC:
AnnaBridge 167:e84263d55307 65 default:
AnnaBridge 167:e84263d55307 66 return true;
AnnaBridge 167:e84263d55307 67 }
AnnaBridge 167:e84263d55307 68 #else
AnnaBridge 167:e84263d55307 69 return (__get_IPSR() != 0U);
AnnaBridge 167:e84263d55307 70 #endif
AnnaBridge 167:e84263d55307 71 }
AnnaBridge 167:e84263d55307 72
AnnaBridge 184:08ed48f1de7f 73 bool core_util_in_critical_section(void)
AnnaBridge 184:08ed48f1de7f 74 {
AnnaBridge 184:08ed48f1de7f 75 return hal_in_critical_section();
AnnaBridge 184:08ed48f1de7f 76 }
AnnaBridge 184:08ed48f1de7f 77
AnnaBridge 184:08ed48f1de7f 78 void core_util_critical_section_enter(void)
<> 149:156823d33999 79 {
AnnaBridge 184:08ed48f1de7f 80 // FIXME
AnnaBridge 184:08ed48f1de7f 81 #ifdef FEATURE_UVISOR
AnnaBridge 184:08ed48f1de7f 82 #warning "core_util_critical_section_enter needs fixing to work from unprivileged code"
AnnaBridge 184:08ed48f1de7f 83 #else
AnnaBridge 184:08ed48f1de7f 84 // If the reentrancy counter overflows something has gone badly wrong.
AnnaBridge 184:08ed48f1de7f 85 MBED_ASSERT(critical_section_reentrancy_counter < UINT32_MAX);
AnnaBridge 184:08ed48f1de7f 86 #endif /* FEATURE_UVISOR */
AnnaBridge 184:08ed48f1de7f 87
AnnaBridge 184:08ed48f1de7f 88 hal_critical_section_enter();
<> 149:156823d33999 89
AnnaBridge 184:08ed48f1de7f 90 ++critical_section_reentrancy_counter;
AnnaBridge 184:08ed48f1de7f 91 }
AnnaBridge 184:08ed48f1de7f 92
AnnaBridge 184:08ed48f1de7f 93 void core_util_critical_section_exit(void)
AnnaBridge 184:08ed48f1de7f 94 {
AnnaBridge 184:08ed48f1de7f 95 // FIXME
AnnaBridge 184:08ed48f1de7f 96 #ifdef FEATURE_UVISOR
AnnaBridge 184:08ed48f1de7f 97 #warning "core_util_critical_section_exit needs fixing to work from unprivileged code"
AnnaBridge 184:08ed48f1de7f 98 #endif /* FEATURE_UVISOR */
AnnaBridge 184:08ed48f1de7f 99
AnnaBridge 184:08ed48f1de7f 100 // If critical_section_enter has not previously been called, do nothing
AnnaBridge 184:08ed48f1de7f 101 if (critical_section_reentrancy_counter == 0) {
AnnaBridge 184:08ed48f1de7f 102 return;
<> 149:156823d33999 103 }
<> 149:156823d33999 104
AnnaBridge 184:08ed48f1de7f 105 --critical_section_reentrancy_counter;
<> 149:156823d33999 106
AnnaBridge 184:08ed48f1de7f 107 if (critical_section_reentrancy_counter == 0) {
AnnaBridge 184:08ed48f1de7f 108 hal_critical_section_exit();
<> 149:156823d33999 109 }
<> 149:156823d33999 110 }
<> 149:156823d33999 111
AnnaBridge 184:08ed48f1de7f 112 #if MBED_EXCLUSIVE_ACCESS
<> 149:156823d33999 113
<> 149:156823d33999 114 /* Supress __ldrex and __strex deprecated warnings - "#3731-D: intrinsic is deprecated" */
<> 149:156823d33999 115 #if defined (__CC_ARM)
<> 149:156823d33999 116 #pragma diag_suppress 3731
<> 149:156823d33999 117 #endif
<> 149:156823d33999 118
AnnaBridge 184:08ed48f1de7f 119 bool core_util_atomic_cas_u8(volatile uint8_t *ptr, uint8_t *expectedCurrentValue, uint8_t desiredValue)
<> 149:156823d33999 120 {
Anna Bridge 180:96ed750bd169 121 do {
AnnaBridge 184:08ed48f1de7f 122 uint8_t currentValue = __LDREXB(ptr);
Anna Bridge 180:96ed750bd169 123 if (currentValue != *expectedCurrentValue) {
Anna Bridge 180:96ed750bd169 124 *expectedCurrentValue = currentValue;
Anna Bridge 180:96ed750bd169 125 __CLREX();
Anna Bridge 180:96ed750bd169 126 return false;
Anna Bridge 180:96ed750bd169 127 }
AnnaBridge 184:08ed48f1de7f 128 } while (__STREXB(desiredValue, ptr));
Anna Bridge 180:96ed750bd169 129 return true;
<> 149:156823d33999 130 }
<> 149:156823d33999 131
AnnaBridge 184:08ed48f1de7f 132 bool core_util_atomic_cas_u16(volatile uint16_t *ptr, uint16_t *expectedCurrentValue, uint16_t desiredValue)
<> 149:156823d33999 133 {
Anna Bridge 180:96ed750bd169 134 do {
AnnaBridge 184:08ed48f1de7f 135 uint16_t currentValue = __LDREXH(ptr);
Anna Bridge 180:96ed750bd169 136 if (currentValue != *expectedCurrentValue) {
Anna Bridge 180:96ed750bd169 137 *expectedCurrentValue = currentValue;
Anna Bridge 180:96ed750bd169 138 __CLREX();
Anna Bridge 180:96ed750bd169 139 return false;
Anna Bridge 180:96ed750bd169 140 }
AnnaBridge 184:08ed48f1de7f 141 } while (__STREXH(desiredValue, ptr));
Anna Bridge 180:96ed750bd169 142 return true;
<> 149:156823d33999 143 }
<> 149:156823d33999 144
<> 149:156823d33999 145
AnnaBridge 184:08ed48f1de7f 146 bool core_util_atomic_cas_u32(volatile uint32_t *ptr, uint32_t *expectedCurrentValue, uint32_t desiredValue)
<> 149:156823d33999 147 {
Anna Bridge 180:96ed750bd169 148 do {
AnnaBridge 184:08ed48f1de7f 149 uint32_t currentValue = __LDREXW(ptr);
Anna Bridge 180:96ed750bd169 150 if (currentValue != *expectedCurrentValue) {
Anna Bridge 180:96ed750bd169 151 *expectedCurrentValue = currentValue;
Anna Bridge 180:96ed750bd169 152 __CLREX();
Anna Bridge 180:96ed750bd169 153 return false;
Anna Bridge 180:96ed750bd169 154 }
AnnaBridge 184:08ed48f1de7f 155 } while (__STREXW(desiredValue, ptr));
Anna Bridge 180:96ed750bd169 156 return true;
<> 149:156823d33999 157 }
<> 149:156823d33999 158
AnnaBridge 184:08ed48f1de7f 159 uint8_t core_util_atomic_incr_u8(volatile uint8_t *valuePtr, uint8_t delta)
<> 149:156823d33999 160 {
<> 149:156823d33999 161 uint8_t newValue;
<> 149:156823d33999 162 do {
AnnaBridge 184:08ed48f1de7f 163 newValue = __LDREXB(valuePtr) + delta;
AnnaBridge 184:08ed48f1de7f 164 } while (__STREXB(newValue, valuePtr));
<> 149:156823d33999 165 return newValue;
<> 149:156823d33999 166 }
<> 149:156823d33999 167
AnnaBridge 184:08ed48f1de7f 168 uint16_t core_util_atomic_incr_u16(volatile uint16_t *valuePtr, uint16_t delta)
<> 149:156823d33999 169 {
<> 149:156823d33999 170 uint16_t newValue;
<> 149:156823d33999 171 do {
AnnaBridge 184:08ed48f1de7f 172 newValue = __LDREXH(valuePtr) + delta;
AnnaBridge 184:08ed48f1de7f 173 } while (__STREXH(newValue, valuePtr));
<> 149:156823d33999 174 return newValue;
<> 149:156823d33999 175 }
<> 149:156823d33999 176
AnnaBridge 184:08ed48f1de7f 177 uint32_t core_util_atomic_incr_u32(volatile uint32_t *valuePtr, uint32_t delta)
<> 149:156823d33999 178 {
<> 149:156823d33999 179 uint32_t newValue;
<> 149:156823d33999 180 do {
AnnaBridge 184:08ed48f1de7f 181 newValue = __LDREXW(valuePtr) + delta;
AnnaBridge 184:08ed48f1de7f 182 } while (__STREXW(newValue, valuePtr));
<> 149:156823d33999 183 return newValue;
<> 149:156823d33999 184 }
<> 149:156823d33999 185
<> 149:156823d33999 186
AnnaBridge 184:08ed48f1de7f 187 uint8_t core_util_atomic_decr_u8(volatile uint8_t *valuePtr, uint8_t delta)
<> 149:156823d33999 188 {
<> 149:156823d33999 189 uint8_t newValue;
<> 149:156823d33999 190 do {
AnnaBridge 184:08ed48f1de7f 191 newValue = __LDREXB(valuePtr) - delta;
AnnaBridge 184:08ed48f1de7f 192 } while (__STREXB(newValue, valuePtr));
<> 149:156823d33999 193 return newValue;
<> 149:156823d33999 194 }
<> 149:156823d33999 195
AnnaBridge 184:08ed48f1de7f 196 uint16_t core_util_atomic_decr_u16(volatile uint16_t *valuePtr, uint16_t delta)
<> 149:156823d33999 197 {
<> 149:156823d33999 198 uint16_t newValue;
<> 149:156823d33999 199 do {
AnnaBridge 184:08ed48f1de7f 200 newValue = __LDREXH(valuePtr) - delta;
AnnaBridge 184:08ed48f1de7f 201 } while (__STREXH(newValue, valuePtr));
<> 149:156823d33999 202 return newValue;
<> 149:156823d33999 203 }
<> 149:156823d33999 204
AnnaBridge 184:08ed48f1de7f 205 uint32_t core_util_atomic_decr_u32(volatile uint32_t *valuePtr, uint32_t delta)
<> 149:156823d33999 206 {
<> 149:156823d33999 207 uint32_t newValue;
<> 149:156823d33999 208 do {
AnnaBridge 184:08ed48f1de7f 209 newValue = __LDREXW(valuePtr) - delta;
AnnaBridge 184:08ed48f1de7f 210 } while (__STREXW(newValue, valuePtr));
<> 149:156823d33999 211 return newValue;
<> 149:156823d33999 212 }
<> 149:156823d33999 213
<> 149:156823d33999 214 #else
<> 149:156823d33999 215
AnnaBridge 184:08ed48f1de7f 216 bool core_util_atomic_cas_u8(volatile uint8_t *ptr, uint8_t *expectedCurrentValue, uint8_t desiredValue)
<> 149:156823d33999 217 {
<> 149:156823d33999 218 bool success;
<> 149:156823d33999 219 uint8_t currentValue;
<> 149:156823d33999 220 core_util_critical_section_enter();
<> 149:156823d33999 221 currentValue = *ptr;
<> 149:156823d33999 222 if (currentValue == *expectedCurrentValue) {
<> 149:156823d33999 223 *ptr = desiredValue;
<> 149:156823d33999 224 success = true;
<> 149:156823d33999 225 } else {
<> 149:156823d33999 226 *expectedCurrentValue = currentValue;
<> 149:156823d33999 227 success = false;
<> 149:156823d33999 228 }
<> 149:156823d33999 229 core_util_critical_section_exit();
<> 149:156823d33999 230 return success;
<> 149:156823d33999 231 }
<> 149:156823d33999 232
AnnaBridge 184:08ed48f1de7f 233 bool core_util_atomic_cas_u16(volatile uint16_t *ptr, uint16_t *expectedCurrentValue, uint16_t desiredValue)
<> 149:156823d33999 234 {
<> 149:156823d33999 235 bool success;
<> 149:156823d33999 236 uint16_t currentValue;
<> 149:156823d33999 237 core_util_critical_section_enter();
<> 149:156823d33999 238 currentValue = *ptr;
<> 149:156823d33999 239 if (currentValue == *expectedCurrentValue) {
<> 149:156823d33999 240 *ptr = desiredValue;
<> 149:156823d33999 241 success = true;
<> 149:156823d33999 242 } else {
<> 149:156823d33999 243 *expectedCurrentValue = currentValue;
<> 149:156823d33999 244 success = false;
<> 149:156823d33999 245 }
<> 149:156823d33999 246 core_util_critical_section_exit();
<> 149:156823d33999 247 return success;
<> 149:156823d33999 248 }
<> 149:156823d33999 249
<> 149:156823d33999 250
AnnaBridge 184:08ed48f1de7f 251 bool core_util_atomic_cas_u32(volatile uint32_t *ptr, uint32_t *expectedCurrentValue, uint32_t desiredValue)
<> 149:156823d33999 252 {
<> 149:156823d33999 253 bool success;
<> 149:156823d33999 254 uint32_t currentValue;
<> 149:156823d33999 255 core_util_critical_section_enter();
<> 149:156823d33999 256 currentValue = *ptr;
<> 149:156823d33999 257 if (currentValue == *expectedCurrentValue) {
<> 149:156823d33999 258 *ptr = desiredValue;
<> 149:156823d33999 259 success = true;
<> 149:156823d33999 260 } else {
<> 149:156823d33999 261 *expectedCurrentValue = currentValue;
<> 149:156823d33999 262 success = false;
<> 149:156823d33999 263 }
<> 149:156823d33999 264 core_util_critical_section_exit();
<> 149:156823d33999 265 return success;
<> 149:156823d33999 266 }
<> 149:156823d33999 267
<> 149:156823d33999 268
AnnaBridge 184:08ed48f1de7f 269 uint8_t core_util_atomic_incr_u8(volatile uint8_t *valuePtr, uint8_t delta)
<> 149:156823d33999 270 {
<> 149:156823d33999 271 uint8_t newValue;
<> 149:156823d33999 272 core_util_critical_section_enter();
<> 149:156823d33999 273 newValue = *valuePtr + delta;
<> 149:156823d33999 274 *valuePtr = newValue;
<> 149:156823d33999 275 core_util_critical_section_exit();
<> 149:156823d33999 276 return newValue;
<> 149:156823d33999 277 }
<> 149:156823d33999 278
AnnaBridge 184:08ed48f1de7f 279 uint16_t core_util_atomic_incr_u16(volatile uint16_t *valuePtr, uint16_t delta)
<> 149:156823d33999 280 {
<> 149:156823d33999 281 uint16_t newValue;
<> 149:156823d33999 282 core_util_critical_section_enter();
<> 149:156823d33999 283 newValue = *valuePtr + delta;
<> 149:156823d33999 284 *valuePtr = newValue;
<> 149:156823d33999 285 core_util_critical_section_exit();
<> 149:156823d33999 286 return newValue;
<> 149:156823d33999 287 }
<> 149:156823d33999 288
AnnaBridge 184:08ed48f1de7f 289 uint32_t core_util_atomic_incr_u32(volatile uint32_t *valuePtr, uint32_t delta)
<> 149:156823d33999 290 {
<> 149:156823d33999 291 uint32_t newValue;
<> 149:156823d33999 292 core_util_critical_section_enter();
<> 149:156823d33999 293 newValue = *valuePtr + delta;
<> 149:156823d33999 294 *valuePtr = newValue;
<> 149:156823d33999 295 core_util_critical_section_exit();
<> 149:156823d33999 296 return newValue;
<> 149:156823d33999 297 }
<> 149:156823d33999 298
<> 149:156823d33999 299
AnnaBridge 184:08ed48f1de7f 300 uint8_t core_util_atomic_decr_u8(volatile uint8_t *valuePtr, uint8_t delta)
<> 149:156823d33999 301 {
<> 149:156823d33999 302 uint8_t newValue;
<> 149:156823d33999 303 core_util_critical_section_enter();
<> 149:156823d33999 304 newValue = *valuePtr - delta;
<> 149:156823d33999 305 *valuePtr = newValue;
<> 149:156823d33999 306 core_util_critical_section_exit();
<> 149:156823d33999 307 return newValue;
<> 149:156823d33999 308 }
<> 149:156823d33999 309
AnnaBridge 184:08ed48f1de7f 310 uint16_t core_util_atomic_decr_u16(volatile uint16_t *valuePtr, uint16_t delta)
<> 149:156823d33999 311 {
<> 149:156823d33999 312 uint16_t newValue;
<> 149:156823d33999 313 core_util_critical_section_enter();
<> 149:156823d33999 314 newValue = *valuePtr - delta;
<> 149:156823d33999 315 *valuePtr = newValue;
<> 149:156823d33999 316 core_util_critical_section_exit();
<> 149:156823d33999 317 return newValue;
<> 149:156823d33999 318 }
<> 149:156823d33999 319
AnnaBridge 184:08ed48f1de7f 320 uint32_t core_util_atomic_decr_u32(volatile uint32_t *valuePtr, uint32_t delta)
<> 149:156823d33999 321 {
<> 149:156823d33999 322 uint32_t newValue;
<> 149:156823d33999 323 core_util_critical_section_enter();
<> 149:156823d33999 324 newValue = *valuePtr - delta;
<> 149:156823d33999 325 *valuePtr = newValue;
<> 149:156823d33999 326 core_util_critical_section_exit();
<> 149:156823d33999 327 return newValue;
<> 149:156823d33999 328 }
<> 149:156823d33999 329
<> 149:156823d33999 330 #endif
<> 149:156823d33999 331
<> 149:156823d33999 332
AnnaBridge 184:08ed48f1de7f 333 bool core_util_atomic_cas_ptr(void * volatile *ptr, void **expectedCurrentValue, void *desiredValue) {
<> 149:156823d33999 334 return core_util_atomic_cas_u32(
AnnaBridge 184:08ed48f1de7f 335 (volatile uint32_t *)ptr,
<> 149:156823d33999 336 (uint32_t *)expectedCurrentValue,
<> 149:156823d33999 337 (uint32_t)desiredValue);
<> 149:156823d33999 338 }
<> 149:156823d33999 339
AnnaBridge 184:08ed48f1de7f 340 void *core_util_atomic_incr_ptr(void * volatile *valuePtr, ptrdiff_t delta) {
AnnaBridge 184:08ed48f1de7f 341 return (void *)core_util_atomic_incr_u32((volatile uint32_t *)valuePtr, (uint32_t)delta);
<> 149:156823d33999 342 }
<> 149:156823d33999 343
AnnaBridge 184:08ed48f1de7f 344 void *core_util_atomic_decr_ptr(void * volatile *valuePtr, ptrdiff_t delta) {
AnnaBridge 184:08ed48f1de7f 345 return (void *)core_util_atomic_decr_u32((volatile uint32_t *)valuePtr, (uint32_t)delta);
<> 149:156823d33999 346 }
<> 149:156823d33999 347