mbed official / mbed-dev

mbed library sources. Supersedes mbed-src.

Dependents:   Nucleo_Hello_Encoder BLE_iBeaconScan AM1805_DEMO DISCO-F429ZI_ExportTemplate1 ... more

platform/mbed_critical.c@188:bcfe06ba3d64, 2018-11-08 (annotated)

Committer:
AnnaBridge
Date:
Thu Nov 08 11:46:34 2018 +0000
Revision:
188:bcfe06ba3d64
Parent:
187:0387e8f68319
Child:
189:f392fc9709a3
mbed-dev library. Release version 164

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 187:0387e8f68319 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 187:0387e8f68319 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 // If the reentrancy counter overflows something has gone badly wrong.
AnnaBridge 184:08ed48f1de7f 81 MBED_ASSERT(critical_section_reentrancy_counter < UINT32_MAX);
AnnaBridge 184:08ed48f1de7f 82
AnnaBridge 184:08ed48f1de7f 83 hal_critical_section_enter();
<> 149:156823d33999 84
AnnaBridge 184:08ed48f1de7f 85 ++critical_section_reentrancy_counter;
AnnaBridge 184:08ed48f1de7f 86 }
AnnaBridge 184:08ed48f1de7f 87
AnnaBridge 184:08ed48f1de7f 88 void core_util_critical_section_exit(void)
AnnaBridge 184:08ed48f1de7f 89 {
AnnaBridge 184:08ed48f1de7f 90
AnnaBridge 184:08ed48f1de7f 91 // If critical_section_enter has not previously been called, do nothing
AnnaBridge 184:08ed48f1de7f 92 if (critical_section_reentrancy_counter == 0) {
AnnaBridge 184:08ed48f1de7f 93 return;
<> 149:156823d33999 94 }
<> 149:156823d33999 95
AnnaBridge 184:08ed48f1de7f 96 --critical_section_reentrancy_counter;
<> 149:156823d33999 97
AnnaBridge 184:08ed48f1de7f 98 if (critical_section_reentrancy_counter == 0) {
AnnaBridge 184:08ed48f1de7f 99 hal_critical_section_exit();
<> 149:156823d33999 100 }
<> 149:156823d33999 101 }
<> 149:156823d33999 102
AnnaBridge 184:08ed48f1de7f 103 #if MBED_EXCLUSIVE_ACCESS
<> 149:156823d33999 104
<> 149:156823d33999 105 /* Supress __ldrex and __strex deprecated warnings - "#3731-D: intrinsic is deprecated" */
AnnaBridge 187:0387e8f68319 106 #if defined (__CC_ARM)
<> 149:156823d33999 107 #pragma diag_suppress 3731
<> 149:156823d33999 108 #endif
<> 149:156823d33999 109
AnnaBridge 184:08ed48f1de7f 110 bool core_util_atomic_cas_u8(volatile uint8_t *ptr, uint8_t *expectedCurrentValue, uint8_t desiredValue)
<> 149:156823d33999 111 {
Anna Bridge 180:96ed750bd169 112 do {
AnnaBridge 184:08ed48f1de7f 113 uint8_t currentValue = __LDREXB(ptr);
Anna Bridge 180:96ed750bd169 114 if (currentValue != *expectedCurrentValue) {
Anna Bridge 180:96ed750bd169 115 *expectedCurrentValue = currentValue;
Anna Bridge 180:96ed750bd169 116 __CLREX();
Anna Bridge 180:96ed750bd169 117 return false;
Anna Bridge 180:96ed750bd169 118 }
AnnaBridge 184:08ed48f1de7f 119 } while (__STREXB(desiredValue, ptr));
Anna Bridge 180:96ed750bd169 120 return true;
<> 149:156823d33999 121 }
<> 149:156823d33999 122
AnnaBridge 184:08ed48f1de7f 123 bool core_util_atomic_cas_u16(volatile uint16_t *ptr, uint16_t *expectedCurrentValue, uint16_t desiredValue)
<> 149:156823d33999 124 {
Anna Bridge 180:96ed750bd169 125 do {
AnnaBridge 184:08ed48f1de7f 126 uint16_t currentValue = __LDREXH(ptr);
Anna Bridge 180:96ed750bd169 127 if (currentValue != *expectedCurrentValue) {
Anna Bridge 180:96ed750bd169 128 *expectedCurrentValue = currentValue;
Anna Bridge 180:96ed750bd169 129 __CLREX();
Anna Bridge 180:96ed750bd169 130 return false;
Anna Bridge 180:96ed750bd169 131 }
AnnaBridge 184:08ed48f1de7f 132 } while (__STREXH(desiredValue, ptr));
Anna Bridge 180:96ed750bd169 133 return true;
<> 149:156823d33999 134 }
<> 149:156823d33999 135
<> 149:156823d33999 136
AnnaBridge 184:08ed48f1de7f 137 bool core_util_atomic_cas_u32(volatile uint32_t *ptr, uint32_t *expectedCurrentValue, uint32_t desiredValue)
<> 149:156823d33999 138 {
Anna Bridge 180:96ed750bd169 139 do {
AnnaBridge 184:08ed48f1de7f 140 uint32_t currentValue = __LDREXW(ptr);
Anna Bridge 180:96ed750bd169 141 if (currentValue != *expectedCurrentValue) {
Anna Bridge 180:96ed750bd169 142 *expectedCurrentValue = currentValue;
Anna Bridge 180:96ed750bd169 143 __CLREX();
Anna Bridge 180:96ed750bd169 144 return false;
Anna Bridge 180:96ed750bd169 145 }
AnnaBridge 184:08ed48f1de7f 146 } while (__STREXW(desiredValue, ptr));
Anna Bridge 180:96ed750bd169 147 return true;
<> 149:156823d33999 148 }
<> 149:156823d33999 149
AnnaBridge 184:08ed48f1de7f 150 uint8_t core_util_atomic_incr_u8(volatile uint8_t *valuePtr, uint8_t delta)
<> 149:156823d33999 151 {
<> 149:156823d33999 152 uint8_t newValue;
<> 149:156823d33999 153 do {
AnnaBridge 184:08ed48f1de7f 154 newValue = __LDREXB(valuePtr) + delta;
AnnaBridge 184:08ed48f1de7f 155 } while (__STREXB(newValue, valuePtr));
<> 149:156823d33999 156 return newValue;
<> 149:156823d33999 157 }
<> 149:156823d33999 158
AnnaBridge 184:08ed48f1de7f 159 uint16_t core_util_atomic_incr_u16(volatile uint16_t *valuePtr, uint16_t delta)
<> 149:156823d33999 160 {
<> 149:156823d33999 161 uint16_t newValue;
<> 149:156823d33999 162 do {
AnnaBridge 184:08ed48f1de7f 163 newValue = __LDREXH(valuePtr) + delta;
AnnaBridge 184:08ed48f1de7f 164 } while (__STREXH(newValue, valuePtr));
<> 149:156823d33999 165 return newValue;
<> 149:156823d33999 166 }
<> 149:156823d33999 167
AnnaBridge 184:08ed48f1de7f 168 uint32_t core_util_atomic_incr_u32(volatile uint32_t *valuePtr, uint32_t delta)
<> 149:156823d33999 169 {
<> 149:156823d33999 170 uint32_t newValue;
<> 149:156823d33999 171 do {
AnnaBridge 184:08ed48f1de7f 172 newValue = __LDREXW(valuePtr) + delta;
AnnaBridge 184:08ed48f1de7f 173 } while (__STREXW(newValue, valuePtr));
<> 149:156823d33999 174 return newValue;
<> 149:156823d33999 175 }
<> 149:156823d33999 176
<> 149:156823d33999 177
AnnaBridge 184:08ed48f1de7f 178 uint8_t core_util_atomic_decr_u8(volatile uint8_t *valuePtr, uint8_t delta)
<> 149:156823d33999 179 {
<> 149:156823d33999 180 uint8_t newValue;
<> 149:156823d33999 181 do {
AnnaBridge 184:08ed48f1de7f 182 newValue = __LDREXB(valuePtr) - delta;
AnnaBridge 184:08ed48f1de7f 183 } while (__STREXB(newValue, valuePtr));
<> 149:156823d33999 184 return newValue;
<> 149:156823d33999 185 }
<> 149:156823d33999 186
AnnaBridge 184:08ed48f1de7f 187 uint16_t core_util_atomic_decr_u16(volatile uint16_t *valuePtr, uint16_t delta)
<> 149:156823d33999 188 {
<> 149:156823d33999 189 uint16_t newValue;
<> 149:156823d33999 190 do {
AnnaBridge 184:08ed48f1de7f 191 newValue = __LDREXH(valuePtr) - delta;
AnnaBridge 184:08ed48f1de7f 192 } while (__STREXH(newValue, valuePtr));
<> 149:156823d33999 193 return newValue;
<> 149:156823d33999 194 }
<> 149:156823d33999 195
AnnaBridge 184:08ed48f1de7f 196 uint32_t core_util_atomic_decr_u32(volatile uint32_t *valuePtr, uint32_t delta)
<> 149:156823d33999 197 {
<> 149:156823d33999 198 uint32_t newValue;
<> 149:156823d33999 199 do {
AnnaBridge 184:08ed48f1de7f 200 newValue = __LDREXW(valuePtr) - delta;
AnnaBridge 184:08ed48f1de7f 201 } while (__STREXW(newValue, valuePtr));
<> 149:156823d33999 202 return newValue;
<> 149:156823d33999 203 }
<> 149:156823d33999 204
<> 149:156823d33999 205 #else
<> 149:156823d33999 206
AnnaBridge 184:08ed48f1de7f 207 bool core_util_atomic_cas_u8(volatile uint8_t *ptr, uint8_t *expectedCurrentValue, uint8_t desiredValue)
<> 149:156823d33999 208 {
<> 149:156823d33999 209 bool success;
<> 149:156823d33999 210 uint8_t currentValue;
<> 149:156823d33999 211 core_util_critical_section_enter();
<> 149:156823d33999 212 currentValue = *ptr;
<> 149:156823d33999 213 if (currentValue == *expectedCurrentValue) {
<> 149:156823d33999 214 *ptr = desiredValue;
<> 149:156823d33999 215 success = true;
<> 149:156823d33999 216 } else {
<> 149:156823d33999 217 *expectedCurrentValue = currentValue;
<> 149:156823d33999 218 success = false;
<> 149:156823d33999 219 }
<> 149:156823d33999 220 core_util_critical_section_exit();
<> 149:156823d33999 221 return success;
<> 149:156823d33999 222 }
<> 149:156823d33999 223
AnnaBridge 184:08ed48f1de7f 224 bool core_util_atomic_cas_u16(volatile uint16_t *ptr, uint16_t *expectedCurrentValue, uint16_t desiredValue)
<> 149:156823d33999 225 {
<> 149:156823d33999 226 bool success;
<> 149:156823d33999 227 uint16_t currentValue;
<> 149:156823d33999 228 core_util_critical_section_enter();
<> 149:156823d33999 229 currentValue = *ptr;
<> 149:156823d33999 230 if (currentValue == *expectedCurrentValue) {
<> 149:156823d33999 231 *ptr = desiredValue;
<> 149:156823d33999 232 success = true;
<> 149:156823d33999 233 } else {
<> 149:156823d33999 234 *expectedCurrentValue = currentValue;
<> 149:156823d33999 235 success = false;
<> 149:156823d33999 236 }
<> 149:156823d33999 237 core_util_critical_section_exit();
<> 149:156823d33999 238 return success;
<> 149:156823d33999 239 }
<> 149:156823d33999 240
<> 149:156823d33999 241
AnnaBridge 184:08ed48f1de7f 242 bool core_util_atomic_cas_u32(volatile uint32_t *ptr, uint32_t *expectedCurrentValue, uint32_t desiredValue)
<> 149:156823d33999 243 {
<> 149:156823d33999 244 bool success;
<> 149:156823d33999 245 uint32_t currentValue;
<> 149:156823d33999 246 core_util_critical_section_enter();
<> 149:156823d33999 247 currentValue = *ptr;
<> 149:156823d33999 248 if (currentValue == *expectedCurrentValue) {
<> 149:156823d33999 249 *ptr = desiredValue;
<> 149:156823d33999 250 success = true;
<> 149:156823d33999 251 } else {
<> 149:156823d33999 252 *expectedCurrentValue = currentValue;
<> 149:156823d33999 253 success = false;
<> 149:156823d33999 254 }
<> 149:156823d33999 255 core_util_critical_section_exit();
<> 149:156823d33999 256 return success;
<> 149:156823d33999 257 }
<> 149:156823d33999 258
<> 149:156823d33999 259
AnnaBridge 184:08ed48f1de7f 260 uint8_t core_util_atomic_incr_u8(volatile uint8_t *valuePtr, uint8_t delta)
<> 149:156823d33999 261 {
<> 149:156823d33999 262 uint8_t newValue;
<> 149:156823d33999 263 core_util_critical_section_enter();
<> 149:156823d33999 264 newValue = *valuePtr + delta;
<> 149:156823d33999 265 *valuePtr = newValue;
<> 149:156823d33999 266 core_util_critical_section_exit();
<> 149:156823d33999 267 return newValue;
<> 149:156823d33999 268 }
<> 149:156823d33999 269
AnnaBridge 184:08ed48f1de7f 270 uint16_t core_util_atomic_incr_u16(volatile uint16_t *valuePtr, uint16_t delta)
<> 149:156823d33999 271 {
<> 149:156823d33999 272 uint16_t newValue;
<> 149:156823d33999 273 core_util_critical_section_enter();
<> 149:156823d33999 274 newValue = *valuePtr + delta;
<> 149:156823d33999 275 *valuePtr = newValue;
<> 149:156823d33999 276 core_util_critical_section_exit();
<> 149:156823d33999 277 return newValue;
<> 149:156823d33999 278 }
<> 149:156823d33999 279
AnnaBridge 184:08ed48f1de7f 280 uint32_t core_util_atomic_incr_u32(volatile uint32_t *valuePtr, uint32_t delta)
<> 149:156823d33999 281 {
<> 149:156823d33999 282 uint32_t newValue;
<> 149:156823d33999 283 core_util_critical_section_enter();
<> 149:156823d33999 284 newValue = *valuePtr + delta;
<> 149:156823d33999 285 *valuePtr = newValue;
<> 149:156823d33999 286 core_util_critical_section_exit();
<> 149:156823d33999 287 return newValue;
<> 149:156823d33999 288 }
<> 149:156823d33999 289
<> 149:156823d33999 290
AnnaBridge 184:08ed48f1de7f 291 uint8_t core_util_atomic_decr_u8(volatile uint8_t *valuePtr, uint8_t delta)
<> 149:156823d33999 292 {
<> 149:156823d33999 293 uint8_t newValue;
<> 149:156823d33999 294 core_util_critical_section_enter();
<> 149:156823d33999 295 newValue = *valuePtr - delta;
<> 149:156823d33999 296 *valuePtr = newValue;
<> 149:156823d33999 297 core_util_critical_section_exit();
<> 149:156823d33999 298 return newValue;
<> 149:156823d33999 299 }
<> 149:156823d33999 300
AnnaBridge 184:08ed48f1de7f 301 uint16_t core_util_atomic_decr_u16(volatile uint16_t *valuePtr, uint16_t delta)
<> 149:156823d33999 302 {
<> 149:156823d33999 303 uint16_t newValue;
<> 149:156823d33999 304 core_util_critical_section_enter();
<> 149:156823d33999 305 newValue = *valuePtr - delta;
<> 149:156823d33999 306 *valuePtr = newValue;
<> 149:156823d33999 307 core_util_critical_section_exit();
<> 149:156823d33999 308 return newValue;
<> 149:156823d33999 309 }
<> 149:156823d33999 310
AnnaBridge 184:08ed48f1de7f 311 uint32_t core_util_atomic_decr_u32(volatile uint32_t *valuePtr, uint32_t delta)
<> 149:156823d33999 312 {
<> 149:156823d33999 313 uint32_t newValue;
<> 149:156823d33999 314 core_util_critical_section_enter();
<> 149:156823d33999 315 newValue = *valuePtr - delta;
<> 149:156823d33999 316 *valuePtr = newValue;
<> 149:156823d33999 317 core_util_critical_section_exit();
<> 149:156823d33999 318 return newValue;
<> 149:156823d33999 319 }
<> 149:156823d33999 320
<> 149:156823d33999 321 #endif
<> 149:156823d33999 322
<> 149:156823d33999 323
AnnaBridge 187:0387e8f68319 324 bool core_util_atomic_cas_ptr(void *volatile *ptr, void **expectedCurrentValue, void *desiredValue)
AnnaBridge 187:0387e8f68319 325 {
<> 149:156823d33999 326 return core_util_atomic_cas_u32(
AnnaBridge 187:0387e8f68319 327 (volatile uint32_t *)ptr,
AnnaBridge 187:0387e8f68319 328 (uint32_t *)expectedCurrentValue,
AnnaBridge 187:0387e8f68319 329 (uint32_t)desiredValue);
<> 149:156823d33999 330 }
<> 149:156823d33999 331
AnnaBridge 187:0387e8f68319 332 void *core_util_atomic_incr_ptr(void *volatile *valuePtr, ptrdiff_t delta)
AnnaBridge 187:0387e8f68319 333 {
AnnaBridge 184:08ed48f1de7f 334 return (void *)core_util_atomic_incr_u32((volatile uint32_t *)valuePtr, (uint32_t)delta);
<> 149:156823d33999 335 }
<> 149:156823d33999 336
AnnaBridge 187:0387e8f68319 337 void *core_util_atomic_decr_ptr(void *volatile *valuePtr, ptrdiff_t delta)
AnnaBridge 187:0387e8f68319 338 {
AnnaBridge 184:08ed48f1de7f 339 return (void *)core_util_atomic_decr_u32((volatile uint32_t *)valuePtr, (uint32_t)delta);
<> 149:156823d33999 340 }
<> 149:156823d33999 341