mbed library sources. Supersedes mbed-src.
Dependents: Nucleo_Hello_Encoder BLE_iBeaconScan AM1805_DEMO DISCO-F429ZI_ExportTemplate1 ... more
platform/mbed_critical.c@189:f392fc9709a3, 2019-02-20 (annotated)
- Committer:
- AnnaBridge
- Date:
- Wed Feb 20 22:31:08 2019 +0000
- Revision:
- 189:f392fc9709a3
- Parent:
- 188:bcfe06ba3d64
mbed library release version 165
Who changed what in which revision?
User | Revision | Line number | New 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 | 189:f392fc9709a3 | 103 | void core_util_atomic_flag_clear(volatile core_util_atomic_flag *flagPtr) |
AnnaBridge | 189:f392fc9709a3 | 104 | { |
AnnaBridge | 189:f392fc9709a3 | 105 | flagPtr->_flag = false; |
AnnaBridge | 189:f392fc9709a3 | 106 | } |
AnnaBridge | 189:f392fc9709a3 | 107 | |
AnnaBridge | 184:08ed48f1de7f | 108 | #if MBED_EXCLUSIVE_ACCESS |
<> | 149:156823d33999 | 109 | |
<> | 149:156823d33999 | 110 | /* Supress __ldrex and __strex deprecated warnings - "#3731-D: intrinsic is deprecated" */ |
AnnaBridge | 187:0387e8f68319 | 111 | #if defined (__CC_ARM) |
<> | 149:156823d33999 | 112 | #pragma diag_suppress 3731 |
<> | 149:156823d33999 | 113 | #endif |
<> | 149:156823d33999 | 114 | |
AnnaBridge | 189:f392fc9709a3 | 115 | bool core_util_atomic_flag_test_and_set(volatile core_util_atomic_flag *flagPtr) |
AnnaBridge | 189:f392fc9709a3 | 116 | { |
AnnaBridge | 189:f392fc9709a3 | 117 | uint8_t currentValue; |
AnnaBridge | 189:f392fc9709a3 | 118 | do { |
AnnaBridge | 189:f392fc9709a3 | 119 | currentValue = __LDREXB(&flagPtr->_flag); |
AnnaBridge | 189:f392fc9709a3 | 120 | } while (__STREXB(true, &flagPtr->_flag)); |
AnnaBridge | 189:f392fc9709a3 | 121 | return currentValue; |
AnnaBridge | 189:f392fc9709a3 | 122 | } |
AnnaBridge | 189:f392fc9709a3 | 123 | |
AnnaBridge | 184:08ed48f1de7f | 124 | bool core_util_atomic_cas_u8(volatile uint8_t *ptr, uint8_t *expectedCurrentValue, uint8_t desiredValue) |
<> | 149:156823d33999 | 125 | { |
Anna Bridge |
180:96ed750bd169 | 126 | do { |
AnnaBridge | 184:08ed48f1de7f | 127 | uint8_t currentValue = __LDREXB(ptr); |
Anna Bridge |
180:96ed750bd169 | 128 | if (currentValue != *expectedCurrentValue) { |
Anna Bridge |
180:96ed750bd169 | 129 | *expectedCurrentValue = currentValue; |
Anna Bridge |
180:96ed750bd169 | 130 | __CLREX(); |
Anna Bridge |
180:96ed750bd169 | 131 | return false; |
Anna Bridge |
180:96ed750bd169 | 132 | } |
AnnaBridge | 184:08ed48f1de7f | 133 | } while (__STREXB(desiredValue, ptr)); |
Anna Bridge |
180:96ed750bd169 | 134 | return true; |
<> | 149:156823d33999 | 135 | } |
<> | 149:156823d33999 | 136 | |
AnnaBridge | 184:08ed48f1de7f | 137 | bool core_util_atomic_cas_u16(volatile uint16_t *ptr, uint16_t *expectedCurrentValue, uint16_t desiredValue) |
<> | 149:156823d33999 | 138 | { |
Anna Bridge |
180:96ed750bd169 | 139 | do { |
AnnaBridge | 184:08ed48f1de7f | 140 | uint16_t currentValue = __LDREXH(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 (__STREXH(desiredValue, ptr)); |
Anna Bridge |
180:96ed750bd169 | 147 | return true; |
<> | 149:156823d33999 | 148 | } |
<> | 149:156823d33999 | 149 | |
<> | 149:156823d33999 | 150 | |
AnnaBridge | 184:08ed48f1de7f | 151 | bool core_util_atomic_cas_u32(volatile uint32_t *ptr, uint32_t *expectedCurrentValue, uint32_t desiredValue) |
<> | 149:156823d33999 | 152 | { |
Anna Bridge |
180:96ed750bd169 | 153 | do { |
AnnaBridge | 184:08ed48f1de7f | 154 | uint32_t currentValue = __LDREXW(ptr); |
Anna Bridge |
180:96ed750bd169 | 155 | if (currentValue != *expectedCurrentValue) { |
Anna Bridge |
180:96ed750bd169 | 156 | *expectedCurrentValue = currentValue; |
Anna Bridge |
180:96ed750bd169 | 157 | __CLREX(); |
Anna Bridge |
180:96ed750bd169 | 158 | return false; |
Anna Bridge |
180:96ed750bd169 | 159 | } |
AnnaBridge | 184:08ed48f1de7f | 160 | } while (__STREXW(desiredValue, ptr)); |
Anna Bridge |
180:96ed750bd169 | 161 | return true; |
<> | 149:156823d33999 | 162 | } |
<> | 149:156823d33999 | 163 | |
AnnaBridge | 184:08ed48f1de7f | 164 | uint8_t core_util_atomic_incr_u8(volatile uint8_t *valuePtr, uint8_t delta) |
<> | 149:156823d33999 | 165 | { |
<> | 149:156823d33999 | 166 | uint8_t newValue; |
<> | 149:156823d33999 | 167 | do { |
AnnaBridge | 184:08ed48f1de7f | 168 | newValue = __LDREXB(valuePtr) + delta; |
AnnaBridge | 184:08ed48f1de7f | 169 | } while (__STREXB(newValue, valuePtr)); |
<> | 149:156823d33999 | 170 | return newValue; |
<> | 149:156823d33999 | 171 | } |
<> | 149:156823d33999 | 172 | |
AnnaBridge | 184:08ed48f1de7f | 173 | uint16_t core_util_atomic_incr_u16(volatile uint16_t *valuePtr, uint16_t delta) |
<> | 149:156823d33999 | 174 | { |
<> | 149:156823d33999 | 175 | uint16_t newValue; |
<> | 149:156823d33999 | 176 | do { |
AnnaBridge | 184:08ed48f1de7f | 177 | newValue = __LDREXH(valuePtr) + delta; |
AnnaBridge | 184:08ed48f1de7f | 178 | } while (__STREXH(newValue, valuePtr)); |
<> | 149:156823d33999 | 179 | return newValue; |
<> | 149:156823d33999 | 180 | } |
<> | 149:156823d33999 | 181 | |
AnnaBridge | 184:08ed48f1de7f | 182 | uint32_t core_util_atomic_incr_u32(volatile uint32_t *valuePtr, uint32_t delta) |
<> | 149:156823d33999 | 183 | { |
<> | 149:156823d33999 | 184 | uint32_t newValue; |
<> | 149:156823d33999 | 185 | do { |
AnnaBridge | 184:08ed48f1de7f | 186 | newValue = __LDREXW(valuePtr) + delta; |
AnnaBridge | 184:08ed48f1de7f | 187 | } while (__STREXW(newValue, valuePtr)); |
<> | 149:156823d33999 | 188 | return newValue; |
<> | 149:156823d33999 | 189 | } |
<> | 149:156823d33999 | 190 | |
<> | 149:156823d33999 | 191 | |
AnnaBridge | 184:08ed48f1de7f | 192 | uint8_t core_util_atomic_decr_u8(volatile uint8_t *valuePtr, uint8_t delta) |
<> | 149:156823d33999 | 193 | { |
<> | 149:156823d33999 | 194 | uint8_t newValue; |
<> | 149:156823d33999 | 195 | do { |
AnnaBridge | 184:08ed48f1de7f | 196 | newValue = __LDREXB(valuePtr) - delta; |
AnnaBridge | 184:08ed48f1de7f | 197 | } while (__STREXB(newValue, valuePtr)); |
<> | 149:156823d33999 | 198 | return newValue; |
<> | 149:156823d33999 | 199 | } |
<> | 149:156823d33999 | 200 | |
AnnaBridge | 184:08ed48f1de7f | 201 | uint16_t core_util_atomic_decr_u16(volatile uint16_t *valuePtr, uint16_t delta) |
<> | 149:156823d33999 | 202 | { |
<> | 149:156823d33999 | 203 | uint16_t newValue; |
<> | 149:156823d33999 | 204 | do { |
AnnaBridge | 184:08ed48f1de7f | 205 | newValue = __LDREXH(valuePtr) - delta; |
AnnaBridge | 184:08ed48f1de7f | 206 | } while (__STREXH(newValue, valuePtr)); |
<> | 149:156823d33999 | 207 | return newValue; |
<> | 149:156823d33999 | 208 | } |
<> | 149:156823d33999 | 209 | |
AnnaBridge | 184:08ed48f1de7f | 210 | uint32_t core_util_atomic_decr_u32(volatile uint32_t *valuePtr, uint32_t delta) |
<> | 149:156823d33999 | 211 | { |
<> | 149:156823d33999 | 212 | uint32_t newValue; |
<> | 149:156823d33999 | 213 | do { |
AnnaBridge | 184:08ed48f1de7f | 214 | newValue = __LDREXW(valuePtr) - delta; |
AnnaBridge | 184:08ed48f1de7f | 215 | } while (__STREXW(newValue, valuePtr)); |
<> | 149:156823d33999 | 216 | return newValue; |
<> | 149:156823d33999 | 217 | } |
<> | 149:156823d33999 | 218 | |
<> | 149:156823d33999 | 219 | #else |
<> | 149:156823d33999 | 220 | |
AnnaBridge | 189:f392fc9709a3 | 221 | bool core_util_atomic_flag_test_and_set(volatile core_util_atomic_flag *flagPtr) |
AnnaBridge | 189:f392fc9709a3 | 222 | { |
AnnaBridge | 189:f392fc9709a3 | 223 | core_util_critical_section_enter(); |
AnnaBridge | 189:f392fc9709a3 | 224 | uint8_t currentValue = flagPtr->_flag; |
AnnaBridge | 189:f392fc9709a3 | 225 | flagPtr->_flag = true; |
AnnaBridge | 189:f392fc9709a3 | 226 | core_util_critical_section_exit(); |
AnnaBridge | 189:f392fc9709a3 | 227 | return currentValue; |
AnnaBridge | 189:f392fc9709a3 | 228 | } |
AnnaBridge | 189:f392fc9709a3 | 229 | |
AnnaBridge | 184:08ed48f1de7f | 230 | bool core_util_atomic_cas_u8(volatile uint8_t *ptr, uint8_t *expectedCurrentValue, uint8_t desiredValue) |
<> | 149:156823d33999 | 231 | { |
<> | 149:156823d33999 | 232 | bool success; |
<> | 149:156823d33999 | 233 | uint8_t currentValue; |
<> | 149:156823d33999 | 234 | core_util_critical_section_enter(); |
<> | 149:156823d33999 | 235 | currentValue = *ptr; |
<> | 149:156823d33999 | 236 | if (currentValue == *expectedCurrentValue) { |
<> | 149:156823d33999 | 237 | *ptr = desiredValue; |
<> | 149:156823d33999 | 238 | success = true; |
<> | 149:156823d33999 | 239 | } else { |
<> | 149:156823d33999 | 240 | *expectedCurrentValue = currentValue; |
<> | 149:156823d33999 | 241 | success = false; |
<> | 149:156823d33999 | 242 | } |
<> | 149:156823d33999 | 243 | core_util_critical_section_exit(); |
<> | 149:156823d33999 | 244 | return success; |
<> | 149:156823d33999 | 245 | } |
<> | 149:156823d33999 | 246 | |
AnnaBridge | 184:08ed48f1de7f | 247 | bool core_util_atomic_cas_u16(volatile uint16_t *ptr, uint16_t *expectedCurrentValue, uint16_t desiredValue) |
<> | 149:156823d33999 | 248 | { |
<> | 149:156823d33999 | 249 | bool success; |
<> | 149:156823d33999 | 250 | uint16_t currentValue; |
<> | 149:156823d33999 | 251 | core_util_critical_section_enter(); |
<> | 149:156823d33999 | 252 | currentValue = *ptr; |
<> | 149:156823d33999 | 253 | if (currentValue == *expectedCurrentValue) { |
<> | 149:156823d33999 | 254 | *ptr = desiredValue; |
<> | 149:156823d33999 | 255 | success = true; |
<> | 149:156823d33999 | 256 | } else { |
<> | 149:156823d33999 | 257 | *expectedCurrentValue = currentValue; |
<> | 149:156823d33999 | 258 | success = false; |
<> | 149:156823d33999 | 259 | } |
<> | 149:156823d33999 | 260 | core_util_critical_section_exit(); |
<> | 149:156823d33999 | 261 | return success; |
<> | 149:156823d33999 | 262 | } |
<> | 149:156823d33999 | 263 | |
<> | 149:156823d33999 | 264 | |
AnnaBridge | 184:08ed48f1de7f | 265 | bool core_util_atomic_cas_u32(volatile uint32_t *ptr, uint32_t *expectedCurrentValue, uint32_t desiredValue) |
<> | 149:156823d33999 | 266 | { |
<> | 149:156823d33999 | 267 | bool success; |
<> | 149:156823d33999 | 268 | uint32_t currentValue; |
<> | 149:156823d33999 | 269 | core_util_critical_section_enter(); |
<> | 149:156823d33999 | 270 | currentValue = *ptr; |
<> | 149:156823d33999 | 271 | if (currentValue == *expectedCurrentValue) { |
<> | 149:156823d33999 | 272 | *ptr = desiredValue; |
<> | 149:156823d33999 | 273 | success = true; |
<> | 149:156823d33999 | 274 | } else { |
<> | 149:156823d33999 | 275 | *expectedCurrentValue = currentValue; |
<> | 149:156823d33999 | 276 | success = false; |
<> | 149:156823d33999 | 277 | } |
<> | 149:156823d33999 | 278 | core_util_critical_section_exit(); |
<> | 149:156823d33999 | 279 | return success; |
<> | 149:156823d33999 | 280 | } |
<> | 149:156823d33999 | 281 | |
<> | 149:156823d33999 | 282 | |
AnnaBridge | 184:08ed48f1de7f | 283 | uint8_t core_util_atomic_incr_u8(volatile uint8_t *valuePtr, uint8_t delta) |
<> | 149:156823d33999 | 284 | { |
<> | 149:156823d33999 | 285 | uint8_t newValue; |
<> | 149:156823d33999 | 286 | core_util_critical_section_enter(); |
<> | 149:156823d33999 | 287 | newValue = *valuePtr + delta; |
<> | 149:156823d33999 | 288 | *valuePtr = newValue; |
<> | 149:156823d33999 | 289 | core_util_critical_section_exit(); |
<> | 149:156823d33999 | 290 | return newValue; |
<> | 149:156823d33999 | 291 | } |
<> | 149:156823d33999 | 292 | |
AnnaBridge | 184:08ed48f1de7f | 293 | uint16_t core_util_atomic_incr_u16(volatile uint16_t *valuePtr, uint16_t delta) |
<> | 149:156823d33999 | 294 | { |
<> | 149:156823d33999 | 295 | uint16_t newValue; |
<> | 149:156823d33999 | 296 | core_util_critical_section_enter(); |
<> | 149:156823d33999 | 297 | newValue = *valuePtr + delta; |
<> | 149:156823d33999 | 298 | *valuePtr = newValue; |
<> | 149:156823d33999 | 299 | core_util_critical_section_exit(); |
<> | 149:156823d33999 | 300 | return newValue; |
<> | 149:156823d33999 | 301 | } |
<> | 149:156823d33999 | 302 | |
AnnaBridge | 184:08ed48f1de7f | 303 | uint32_t core_util_atomic_incr_u32(volatile uint32_t *valuePtr, uint32_t delta) |
<> | 149:156823d33999 | 304 | { |
<> | 149:156823d33999 | 305 | uint32_t newValue; |
<> | 149:156823d33999 | 306 | core_util_critical_section_enter(); |
<> | 149:156823d33999 | 307 | newValue = *valuePtr + delta; |
<> | 149:156823d33999 | 308 | *valuePtr = newValue; |
<> | 149:156823d33999 | 309 | core_util_critical_section_exit(); |
<> | 149:156823d33999 | 310 | return newValue; |
<> | 149:156823d33999 | 311 | } |
<> | 149:156823d33999 | 312 | |
<> | 149:156823d33999 | 313 | |
AnnaBridge | 184:08ed48f1de7f | 314 | uint8_t core_util_atomic_decr_u8(volatile uint8_t *valuePtr, uint8_t delta) |
<> | 149:156823d33999 | 315 | { |
<> | 149:156823d33999 | 316 | uint8_t newValue; |
<> | 149:156823d33999 | 317 | core_util_critical_section_enter(); |
<> | 149:156823d33999 | 318 | newValue = *valuePtr - delta; |
<> | 149:156823d33999 | 319 | *valuePtr = newValue; |
<> | 149:156823d33999 | 320 | core_util_critical_section_exit(); |
<> | 149:156823d33999 | 321 | return newValue; |
<> | 149:156823d33999 | 322 | } |
<> | 149:156823d33999 | 323 | |
AnnaBridge | 184:08ed48f1de7f | 324 | uint16_t core_util_atomic_decr_u16(volatile uint16_t *valuePtr, uint16_t delta) |
<> | 149:156823d33999 | 325 | { |
<> | 149:156823d33999 | 326 | uint16_t newValue; |
<> | 149:156823d33999 | 327 | core_util_critical_section_enter(); |
<> | 149:156823d33999 | 328 | newValue = *valuePtr - delta; |
<> | 149:156823d33999 | 329 | *valuePtr = newValue; |
<> | 149:156823d33999 | 330 | core_util_critical_section_exit(); |
<> | 149:156823d33999 | 331 | return newValue; |
<> | 149:156823d33999 | 332 | } |
<> | 149:156823d33999 | 333 | |
AnnaBridge | 184:08ed48f1de7f | 334 | uint32_t core_util_atomic_decr_u32(volatile uint32_t *valuePtr, uint32_t delta) |
<> | 149:156823d33999 | 335 | { |
<> | 149:156823d33999 | 336 | uint32_t newValue; |
<> | 149:156823d33999 | 337 | core_util_critical_section_enter(); |
<> | 149:156823d33999 | 338 | newValue = *valuePtr - delta; |
<> | 149:156823d33999 | 339 | *valuePtr = newValue; |
<> | 149:156823d33999 | 340 | core_util_critical_section_exit(); |
<> | 149:156823d33999 | 341 | return newValue; |
<> | 149:156823d33999 | 342 | } |
<> | 149:156823d33999 | 343 | |
<> | 149:156823d33999 | 344 | #endif |
<> | 149:156823d33999 | 345 | |
<> | 149:156823d33999 | 346 | |
AnnaBridge | 187:0387e8f68319 | 347 | bool core_util_atomic_cas_ptr(void *volatile *ptr, void **expectedCurrentValue, void *desiredValue) |
AnnaBridge | 187:0387e8f68319 | 348 | { |
<> | 149:156823d33999 | 349 | return core_util_atomic_cas_u32( |
AnnaBridge | 187:0387e8f68319 | 350 | (volatile uint32_t *)ptr, |
AnnaBridge | 187:0387e8f68319 | 351 | (uint32_t *)expectedCurrentValue, |
AnnaBridge | 187:0387e8f68319 | 352 | (uint32_t)desiredValue); |
<> | 149:156823d33999 | 353 | } |
<> | 149:156823d33999 | 354 | |
AnnaBridge | 187:0387e8f68319 | 355 | void *core_util_atomic_incr_ptr(void *volatile *valuePtr, ptrdiff_t delta) |
AnnaBridge | 187:0387e8f68319 | 356 | { |
AnnaBridge | 184:08ed48f1de7f | 357 | return (void *)core_util_atomic_incr_u32((volatile uint32_t *)valuePtr, (uint32_t)delta); |
<> | 149:156823d33999 | 358 | } |
<> | 149:156823d33999 | 359 | |
AnnaBridge | 187:0387e8f68319 | 360 | void *core_util_atomic_decr_ptr(void *volatile *valuePtr, ptrdiff_t delta) |
AnnaBridge | 187:0387e8f68319 | 361 | { |
AnnaBridge | 184:08ed48f1de7f | 362 | return (void *)core_util_atomic_decr_u32((volatile uint32_t *)valuePtr, (uint32_t)delta); |
<> | 149:156823d33999 | 363 | } |
<> | 149:156823d33999 | 364 |