mbed official / mbed-dev

mbed library sources. Supersedes mbed-src.

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

cmsis/TARGET_CORTEX_M/cmsis_gcc.h@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?

UserRevisionLine numberNew contents of line
Anna Bridge 180:96ed750bd169 1 /**************************************************************************//**
Anna Bridge 180:96ed750bd169 2 * @file cmsis_gcc.h
Anna Bridge 180:96ed750bd169 3 * @brief CMSIS compiler GCC header file
AnnaBridge 188:bcfe06ba3d64 4 * @version V5.0.4
AnnaBridge 188:bcfe06ba3d64 5 * @date 09. April 2018
Anna Bridge 180:96ed750bd169 6 ******************************************************************************/
Anna Bridge 180:96ed750bd169 7 /*
AnnaBridge 188:bcfe06ba3d64 8 * Copyright (c) 2009-2018 Arm Limited. All rights reserved.
Anna Bridge 180:96ed750bd169 9 *
Anna Bridge 180:96ed750bd169 10 * SPDX-License-Identifier: Apache-2.0
Anna Bridge 180:96ed750bd169 11 *
Anna Bridge 180:96ed750bd169 12 * Licensed under the Apache License, Version 2.0 (the License); you may
Anna Bridge 180:96ed750bd169 13 * not use this file except in compliance with the License.
Anna Bridge 180:96ed750bd169 14 * You may obtain a copy of the License at
Anna Bridge 180:96ed750bd169 15 *
Anna Bridge 180:96ed750bd169 16 * www.apache.org/licenses/LICENSE-2.0
Anna Bridge 180:96ed750bd169 17 *
Anna Bridge 180:96ed750bd169 18 * Unless required by applicable law or agreed to in writing, software
Anna Bridge 180:96ed750bd169 19 * distributed under the License is distributed on an AS IS BASIS, WITHOUT
Anna Bridge 180:96ed750bd169 20 * WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
Anna Bridge 180:96ed750bd169 21 * See the License for the specific language governing permissions and
Anna Bridge 180:96ed750bd169 22 * limitations under the License.
Anna Bridge 180:96ed750bd169 23 */
Anna Bridge 180:96ed750bd169 24
Anna Bridge 180:96ed750bd169 25 #ifndef __CMSIS_GCC_H
Anna Bridge 180:96ed750bd169 26 #define __CMSIS_GCC_H
Anna Bridge 180:96ed750bd169 27
Anna Bridge 180:96ed750bd169 28 /* ignore some GCC warnings */
Anna Bridge 180:96ed750bd169 29 #pragma GCC diagnostic push
Anna Bridge 180:96ed750bd169 30 #pragma GCC diagnostic ignored "-Wsign-conversion"
Anna Bridge 180:96ed750bd169 31 #pragma GCC diagnostic ignored "-Wconversion"
Anna Bridge 180:96ed750bd169 32 #pragma GCC diagnostic ignored "-Wunused-parameter"
Anna Bridge 180:96ed750bd169 33
Anna Bridge 180:96ed750bd169 34 /* Fallback for __has_builtin */
Anna Bridge 180:96ed750bd169 35 #ifndef __has_builtin
Anna Bridge 180:96ed750bd169 36 #define __has_builtin(x) (0)
Anna Bridge 180:96ed750bd169 37 #endif
Anna Bridge 180:96ed750bd169 38
Anna Bridge 180:96ed750bd169 39 /* CMSIS compiler specific defines */
Anna Bridge 180:96ed750bd169 40 #ifndef __ASM
Anna Bridge 180:96ed750bd169 41 #define __ASM __asm
Anna Bridge 180:96ed750bd169 42 #endif
Anna Bridge 180:96ed750bd169 43 #ifndef __INLINE
Anna Bridge 180:96ed750bd169 44 #define __INLINE inline
Anna Bridge 180:96ed750bd169 45 #endif
Anna Bridge 180:96ed750bd169 46 #ifndef __STATIC_INLINE
Anna Bridge 180:96ed750bd169 47 #define __STATIC_INLINE static inline
Anna Bridge 180:96ed750bd169 48 #endif
Anna Bridge 186:707f6e361f3e 49 #ifndef __STATIC_FORCEINLINE
Anna Bridge 186:707f6e361f3e 50 #define __STATIC_FORCEINLINE __attribute__((always_inline)) static inline
Anna Bridge 186:707f6e361f3e 51 #endif
Anna Bridge 180:96ed750bd169 52 #ifndef __NO_RETURN
Anna Bridge 186:707f6e361f3e 53 #define __NO_RETURN __attribute__((__noreturn__))
Anna Bridge 180:96ed750bd169 54 #endif
Anna Bridge 180:96ed750bd169 55 #ifndef __USED
Anna Bridge 180:96ed750bd169 56 #define __USED __attribute__((used))
Anna Bridge 180:96ed750bd169 57 #endif
Anna Bridge 180:96ed750bd169 58 #ifndef __WEAK
Anna Bridge 180:96ed750bd169 59 #define __WEAK __attribute__((weak))
Anna Bridge 180:96ed750bd169 60 #endif
Anna Bridge 180:96ed750bd169 61 #ifndef __PACKED
Anna Bridge 180:96ed750bd169 62 #define __PACKED __attribute__((packed, aligned(1)))
Anna Bridge 180:96ed750bd169 63 #endif
Anna Bridge 180:96ed750bd169 64 #ifndef __PACKED_STRUCT
Anna Bridge 180:96ed750bd169 65 #define __PACKED_STRUCT struct __attribute__((packed, aligned(1)))
Anna Bridge 180:96ed750bd169 66 #endif
Anna Bridge 180:96ed750bd169 67 #ifndef __PACKED_UNION
Anna Bridge 180:96ed750bd169 68 #define __PACKED_UNION union __attribute__((packed, aligned(1)))
Anna Bridge 180:96ed750bd169 69 #endif
Anna Bridge 180:96ed750bd169 70 #ifndef __UNALIGNED_UINT32 /* deprecated */
Anna Bridge 180:96ed750bd169 71 #pragma GCC diagnostic push
Anna Bridge 180:96ed750bd169 72 #pragma GCC diagnostic ignored "-Wpacked"
Anna Bridge 180:96ed750bd169 73 #pragma GCC diagnostic ignored "-Wattributes"
Anna Bridge 180:96ed750bd169 74 struct __attribute__((packed)) T_UINT32 { uint32_t v; };
Anna Bridge 180:96ed750bd169 75 #pragma GCC diagnostic pop
Anna Bridge 180:96ed750bd169 76 #define __UNALIGNED_UINT32(x) (((struct T_UINT32 *)(x))->v)
Anna Bridge 180:96ed750bd169 77 #endif
Anna Bridge 180:96ed750bd169 78 #ifndef __UNALIGNED_UINT16_WRITE
Anna Bridge 180:96ed750bd169 79 #pragma GCC diagnostic push
Anna Bridge 180:96ed750bd169 80 #pragma GCC diagnostic ignored "-Wpacked"
Anna Bridge 180:96ed750bd169 81 #pragma GCC diagnostic ignored "-Wattributes"
Anna Bridge 180:96ed750bd169 82 __PACKED_STRUCT T_UINT16_WRITE { uint16_t v; };
Anna Bridge 180:96ed750bd169 83 #pragma GCC diagnostic pop
Anna Bridge 180:96ed750bd169 84 #define __UNALIGNED_UINT16_WRITE(addr, val) (void)((((struct T_UINT16_WRITE *)(void *)(addr))->v) = (val))
Anna Bridge 180:96ed750bd169 85 #endif
Anna Bridge 180:96ed750bd169 86 #ifndef __UNALIGNED_UINT16_READ
Anna Bridge 180:96ed750bd169 87 #pragma GCC diagnostic push
Anna Bridge 180:96ed750bd169 88 #pragma GCC diagnostic ignored "-Wpacked"
Anna Bridge 180:96ed750bd169 89 #pragma GCC diagnostic ignored "-Wattributes"
Anna Bridge 180:96ed750bd169 90 __PACKED_STRUCT T_UINT16_READ { uint16_t v; };
Anna Bridge 180:96ed750bd169 91 #pragma GCC diagnostic pop
Anna Bridge 180:96ed750bd169 92 #define __UNALIGNED_UINT16_READ(addr) (((const struct T_UINT16_READ *)(const void *)(addr))->v)
Anna Bridge 180:96ed750bd169 93 #endif
Anna Bridge 180:96ed750bd169 94 #ifndef __UNALIGNED_UINT32_WRITE
Anna Bridge 180:96ed750bd169 95 #pragma GCC diagnostic push
Anna Bridge 180:96ed750bd169 96 #pragma GCC diagnostic ignored "-Wpacked"
Anna Bridge 180:96ed750bd169 97 #pragma GCC diagnostic ignored "-Wattributes"
Anna Bridge 180:96ed750bd169 98 __PACKED_STRUCT T_UINT32_WRITE { uint32_t v; };
Anna Bridge 180:96ed750bd169 99 #pragma GCC diagnostic pop
Anna Bridge 180:96ed750bd169 100 #define __UNALIGNED_UINT32_WRITE(addr, val) (void)((((struct T_UINT32_WRITE *)(void *)(addr))->v) = (val))
Anna Bridge 180:96ed750bd169 101 #endif
Anna Bridge 180:96ed750bd169 102 #ifndef __UNALIGNED_UINT32_READ
Anna Bridge 180:96ed750bd169 103 #pragma GCC diagnostic push
Anna Bridge 180:96ed750bd169 104 #pragma GCC diagnostic ignored "-Wpacked"
Anna Bridge 180:96ed750bd169 105 #pragma GCC diagnostic ignored "-Wattributes"
Anna Bridge 180:96ed750bd169 106 __PACKED_STRUCT T_UINT32_READ { uint32_t v; };
Anna Bridge 180:96ed750bd169 107 #pragma GCC diagnostic pop
Anna Bridge 180:96ed750bd169 108 #define __UNALIGNED_UINT32_READ(addr) (((const struct T_UINT32_READ *)(const void *)(addr))->v)
Anna Bridge 180:96ed750bd169 109 #endif
Anna Bridge 180:96ed750bd169 110 #ifndef __ALIGNED
Anna Bridge 180:96ed750bd169 111 #define __ALIGNED(x) __attribute__((aligned(x)))
Anna Bridge 180:96ed750bd169 112 #endif
Anna Bridge 180:96ed750bd169 113 #ifndef __RESTRICT
Anna Bridge 180:96ed750bd169 114 #define __RESTRICT __restrict
Anna Bridge 180:96ed750bd169 115 #endif
Anna Bridge 180:96ed750bd169 116
Anna Bridge 180:96ed750bd169 117
Anna Bridge 180:96ed750bd169 118 /* ########################### Core Function Access ########################### */
Anna Bridge 180:96ed750bd169 119 /** \ingroup CMSIS_Core_FunctionInterface
Anna Bridge 180:96ed750bd169 120 \defgroup CMSIS_Core_RegAccFunctions CMSIS Core Register Access Functions
Anna Bridge 180:96ed750bd169 121 @{
Anna Bridge 180:96ed750bd169 122 */
Anna Bridge 180:96ed750bd169 123
Anna Bridge 180:96ed750bd169 124 /**
Anna Bridge 180:96ed750bd169 125 \brief Enable IRQ Interrupts
Anna Bridge 180:96ed750bd169 126 \details Enables IRQ interrupts by clearing the I-bit in the CPSR.
Anna Bridge 180:96ed750bd169 127 Can only be executed in Privileged modes.
Anna Bridge 180:96ed750bd169 128 */
Anna Bridge 186:707f6e361f3e 129 __STATIC_FORCEINLINE void __enable_irq(void)
Anna Bridge 180:96ed750bd169 130 {
Anna Bridge 180:96ed750bd169 131 __ASM volatile ("cpsie i" : : : "memory");
Anna Bridge 180:96ed750bd169 132 }
Anna Bridge 180:96ed750bd169 133
Anna Bridge 180:96ed750bd169 134
Anna Bridge 180:96ed750bd169 135 /**
Anna Bridge 180:96ed750bd169 136 \brief Disable IRQ Interrupts
Anna Bridge 180:96ed750bd169 137 \details Disables IRQ interrupts by setting the I-bit in the CPSR.
Anna Bridge 180:96ed750bd169 138 Can only be executed in Privileged modes.
Anna Bridge 180:96ed750bd169 139 */
Anna Bridge 186:707f6e361f3e 140 __STATIC_FORCEINLINE void __disable_irq(void)
Anna Bridge 180:96ed750bd169 141 {
Anna Bridge 180:96ed750bd169 142 __ASM volatile ("cpsid i" : : : "memory");
Anna Bridge 180:96ed750bd169 143 }
Anna Bridge 180:96ed750bd169 144
Anna Bridge 180:96ed750bd169 145
Anna Bridge 180:96ed750bd169 146 /**
Anna Bridge 180:96ed750bd169 147 \brief Get Control Register
Anna Bridge 180:96ed750bd169 148 \details Returns the content of the Control Register.
Anna Bridge 180:96ed750bd169 149 \return Control Register value
Anna Bridge 180:96ed750bd169 150 */
Anna Bridge 186:707f6e361f3e 151 __STATIC_FORCEINLINE uint32_t __get_CONTROL(void)
Anna Bridge 180:96ed750bd169 152 {
Anna Bridge 180:96ed750bd169 153 uint32_t result;
Anna Bridge 180:96ed750bd169 154
Anna Bridge 180:96ed750bd169 155 __ASM volatile ("MRS %0, control" : "=r" (result) );
Anna Bridge 180:96ed750bd169 156 return(result);
Anna Bridge 180:96ed750bd169 157 }
Anna Bridge 180:96ed750bd169 158
Anna Bridge 180:96ed750bd169 159
Anna Bridge 180:96ed750bd169 160 #if (defined (__ARM_FEATURE_CMSE ) && (__ARM_FEATURE_CMSE == 3))
Anna Bridge 180:96ed750bd169 161 /**
Anna Bridge 180:96ed750bd169 162 \brief Get Control Register (non-secure)
Anna Bridge 180:96ed750bd169 163 \details Returns the content of the non-secure Control Register when in secure mode.
Anna Bridge 180:96ed750bd169 164 \return non-secure Control Register value
Anna Bridge 180:96ed750bd169 165 */
Anna Bridge 186:707f6e361f3e 166 __STATIC_FORCEINLINE uint32_t __TZ_get_CONTROL_NS(void)
Anna Bridge 180:96ed750bd169 167 {
Anna Bridge 180:96ed750bd169 168 uint32_t result;
Anna Bridge 180:96ed750bd169 169
Anna Bridge 180:96ed750bd169 170 __ASM volatile ("MRS %0, control_ns" : "=r" (result) );
Anna Bridge 180:96ed750bd169 171 return(result);
Anna Bridge 180:96ed750bd169 172 }
Anna Bridge 180:96ed750bd169 173 #endif
Anna Bridge 180:96ed750bd169 174
Anna Bridge 180:96ed750bd169 175
Anna Bridge 180:96ed750bd169 176 /**
Anna Bridge 180:96ed750bd169 177 \brief Set Control Register
Anna Bridge 180:96ed750bd169 178 \details Writes the given value to the Control Register.
Anna Bridge 180:96ed750bd169 179 \param [in] control Control Register value to set
Anna Bridge 180:96ed750bd169 180 */
Anna Bridge 186:707f6e361f3e 181 __STATIC_FORCEINLINE void __set_CONTROL(uint32_t control)
Anna Bridge 180:96ed750bd169 182 {
Anna Bridge 180:96ed750bd169 183 __ASM volatile ("MSR control, %0" : : "r" (control) : "memory");
Anna Bridge 180:96ed750bd169 184 }
Anna Bridge 180:96ed750bd169 185
Anna Bridge 180:96ed750bd169 186
Anna Bridge 180:96ed750bd169 187 #if (defined (__ARM_FEATURE_CMSE ) && (__ARM_FEATURE_CMSE == 3))
Anna Bridge 180:96ed750bd169 188 /**
Anna Bridge 180:96ed750bd169 189 \brief Set Control Register (non-secure)
Anna Bridge 180:96ed750bd169 190 \details Writes the given value to the non-secure Control Register when in secure state.
Anna Bridge 180:96ed750bd169 191 \param [in] control Control Register value to set
Anna Bridge 180:96ed750bd169 192 */
Anna Bridge 186:707f6e361f3e 193 __STATIC_FORCEINLINE void __TZ_set_CONTROL_NS(uint32_t control)
Anna Bridge 180:96ed750bd169 194 {
Anna Bridge 180:96ed750bd169 195 __ASM volatile ("MSR control_ns, %0" : : "r" (control) : "memory");
Anna Bridge 180:96ed750bd169 196 }
Anna Bridge 180:96ed750bd169 197 #endif
Anna Bridge 180:96ed750bd169 198
Anna Bridge 180:96ed750bd169 199
Anna Bridge 180:96ed750bd169 200 /**
Anna Bridge 180:96ed750bd169 201 \brief Get IPSR Register
Anna Bridge 180:96ed750bd169 202 \details Returns the content of the IPSR Register.
Anna Bridge 180:96ed750bd169 203 \return IPSR Register value
Anna Bridge 180:96ed750bd169 204 */
Anna Bridge 186:707f6e361f3e 205 __STATIC_FORCEINLINE uint32_t __get_IPSR(void)
Anna Bridge 180:96ed750bd169 206 {
Anna Bridge 180:96ed750bd169 207 uint32_t result;
Anna Bridge 180:96ed750bd169 208
Anna Bridge 180:96ed750bd169 209 __ASM volatile ("MRS %0, ipsr" : "=r" (result) );
Anna Bridge 180:96ed750bd169 210 return(result);
Anna Bridge 180:96ed750bd169 211 }
Anna Bridge 180:96ed750bd169 212
Anna Bridge 180:96ed750bd169 213
Anna Bridge 180:96ed750bd169 214 /**
Anna Bridge 180:96ed750bd169 215 \brief Get APSR Register
Anna Bridge 180:96ed750bd169 216 \details Returns the content of the APSR Register.
Anna Bridge 180:96ed750bd169 217 \return APSR Register value
Anna Bridge 180:96ed750bd169 218 */
Anna Bridge 186:707f6e361f3e 219 __STATIC_FORCEINLINE uint32_t __get_APSR(void)
Anna Bridge 180:96ed750bd169 220 {
Anna Bridge 180:96ed750bd169 221 uint32_t result;
Anna Bridge 180:96ed750bd169 222
Anna Bridge 180:96ed750bd169 223 __ASM volatile ("MRS %0, apsr" : "=r" (result) );
Anna Bridge 180:96ed750bd169 224 return(result);
Anna Bridge 180:96ed750bd169 225 }
Anna Bridge 180:96ed750bd169 226
Anna Bridge 180:96ed750bd169 227
Anna Bridge 180:96ed750bd169 228 /**
Anna Bridge 180:96ed750bd169 229 \brief Get xPSR Register
Anna Bridge 180:96ed750bd169 230 \details Returns the content of the xPSR Register.
Anna Bridge 180:96ed750bd169 231 \return xPSR Register value
Anna Bridge 180:96ed750bd169 232 */
Anna Bridge 186:707f6e361f3e 233 __STATIC_FORCEINLINE uint32_t __get_xPSR(void)
Anna Bridge 180:96ed750bd169 234 {
Anna Bridge 180:96ed750bd169 235 uint32_t result;
Anna Bridge 180:96ed750bd169 236
Anna Bridge 180:96ed750bd169 237 __ASM volatile ("MRS %0, xpsr" : "=r" (result) );
Anna Bridge 180:96ed750bd169 238 return(result);
Anna Bridge 180:96ed750bd169 239 }
Anna Bridge 180:96ed750bd169 240
Anna Bridge 180:96ed750bd169 241
Anna Bridge 180:96ed750bd169 242 /**
Anna Bridge 180:96ed750bd169 243 \brief Get Process Stack Pointer
Anna Bridge 180:96ed750bd169 244 \details Returns the current value of the Process Stack Pointer (PSP).
Anna Bridge 180:96ed750bd169 245 \return PSP Register value
Anna Bridge 180:96ed750bd169 246 */
Anna Bridge 186:707f6e361f3e 247 __STATIC_FORCEINLINE uint32_t __get_PSP(void)
Anna Bridge 180:96ed750bd169 248 {
AnnaBridge 188:bcfe06ba3d64 249 uint32_t result;
Anna Bridge 180:96ed750bd169 250
Anna Bridge 180:96ed750bd169 251 __ASM volatile ("MRS %0, psp" : "=r" (result) );
Anna Bridge 180:96ed750bd169 252 return(result);
Anna Bridge 180:96ed750bd169 253 }
Anna Bridge 180:96ed750bd169 254
Anna Bridge 180:96ed750bd169 255
Anna Bridge 180:96ed750bd169 256 #if (defined (__ARM_FEATURE_CMSE ) && (__ARM_FEATURE_CMSE == 3))
Anna Bridge 180:96ed750bd169 257 /**
Anna Bridge 180:96ed750bd169 258 \brief Get Process Stack Pointer (non-secure)
Anna Bridge 180:96ed750bd169 259 \details Returns the current value of the non-secure Process Stack Pointer (PSP) when in secure state.
Anna Bridge 180:96ed750bd169 260 \return PSP Register value
Anna Bridge 180:96ed750bd169 261 */
Anna Bridge 186:707f6e361f3e 262 __STATIC_FORCEINLINE uint32_t __TZ_get_PSP_NS(void)
Anna Bridge 180:96ed750bd169 263 {
AnnaBridge 188:bcfe06ba3d64 264 uint32_t result;
Anna Bridge 180:96ed750bd169 265
Anna Bridge 180:96ed750bd169 266 __ASM volatile ("MRS %0, psp_ns" : "=r" (result) );
Anna Bridge 180:96ed750bd169 267 return(result);
Anna Bridge 180:96ed750bd169 268 }
Anna Bridge 180:96ed750bd169 269 #endif
Anna Bridge 180:96ed750bd169 270
Anna Bridge 180:96ed750bd169 271
Anna Bridge 180:96ed750bd169 272 /**
Anna Bridge 180:96ed750bd169 273 \brief Set Process Stack Pointer
Anna Bridge 180:96ed750bd169 274 \details Assigns the given value to the Process Stack Pointer (PSP).
Anna Bridge 180:96ed750bd169 275 \param [in] topOfProcStack Process Stack Pointer value to set
Anna Bridge 180:96ed750bd169 276 */
Anna Bridge 186:707f6e361f3e 277 __STATIC_FORCEINLINE void __set_PSP(uint32_t topOfProcStack)
Anna Bridge 180:96ed750bd169 278 {
Anna Bridge 180:96ed750bd169 279 __ASM volatile ("MSR psp, %0" : : "r" (topOfProcStack) : );
Anna Bridge 180:96ed750bd169 280 }
Anna Bridge 180:96ed750bd169 281
Anna Bridge 180:96ed750bd169 282
Anna Bridge 180:96ed750bd169 283 #if (defined (__ARM_FEATURE_CMSE ) && (__ARM_FEATURE_CMSE == 3))
Anna Bridge 180:96ed750bd169 284 /**
Anna Bridge 180:96ed750bd169 285 \brief Set Process Stack Pointer (non-secure)
Anna Bridge 180:96ed750bd169 286 \details Assigns the given value to the non-secure Process Stack Pointer (PSP) when in secure state.
Anna Bridge 180:96ed750bd169 287 \param [in] topOfProcStack Process Stack Pointer value to set
Anna Bridge 180:96ed750bd169 288 */
Anna Bridge 186:707f6e361f3e 289 __STATIC_FORCEINLINE void __TZ_set_PSP_NS(uint32_t topOfProcStack)
Anna Bridge 180:96ed750bd169 290 {
Anna Bridge 180:96ed750bd169 291 __ASM volatile ("MSR psp_ns, %0" : : "r" (topOfProcStack) : );
Anna Bridge 180:96ed750bd169 292 }
Anna Bridge 180:96ed750bd169 293 #endif
Anna Bridge 180:96ed750bd169 294
Anna Bridge 180:96ed750bd169 295
Anna Bridge 180:96ed750bd169 296 /**
Anna Bridge 180:96ed750bd169 297 \brief Get Main Stack Pointer
Anna Bridge 180:96ed750bd169 298 \details Returns the current value of the Main Stack Pointer (MSP).
Anna Bridge 180:96ed750bd169 299 \return MSP Register value
Anna Bridge 180:96ed750bd169 300 */
Anna Bridge 186:707f6e361f3e 301 __STATIC_FORCEINLINE uint32_t __get_MSP(void)
Anna Bridge 180:96ed750bd169 302 {
AnnaBridge 188:bcfe06ba3d64 303 uint32_t result;
Anna Bridge 180:96ed750bd169 304
Anna Bridge 180:96ed750bd169 305 __ASM volatile ("MRS %0, msp" : "=r" (result) );
Anna Bridge 180:96ed750bd169 306 return(result);
Anna Bridge 180:96ed750bd169 307 }
Anna Bridge 180:96ed750bd169 308
Anna Bridge 180:96ed750bd169 309
Anna Bridge 180:96ed750bd169 310 #if (defined (__ARM_FEATURE_CMSE ) && (__ARM_FEATURE_CMSE == 3))
Anna Bridge 180:96ed750bd169 311 /**
Anna Bridge 180:96ed750bd169 312 \brief Get Main Stack Pointer (non-secure)
Anna Bridge 180:96ed750bd169 313 \details Returns the current value of the non-secure Main Stack Pointer (MSP) when in secure state.
Anna Bridge 180:96ed750bd169 314 \return MSP Register value
Anna Bridge 180:96ed750bd169 315 */
Anna Bridge 186:707f6e361f3e 316 __STATIC_FORCEINLINE uint32_t __TZ_get_MSP_NS(void)
Anna Bridge 180:96ed750bd169 317 {
AnnaBridge 188:bcfe06ba3d64 318 uint32_t result;
Anna Bridge 180:96ed750bd169 319
Anna Bridge 180:96ed750bd169 320 __ASM volatile ("MRS %0, msp_ns" : "=r" (result) );
Anna Bridge 180:96ed750bd169 321 return(result);
Anna Bridge 180:96ed750bd169 322 }
Anna Bridge 180:96ed750bd169 323 #endif
Anna Bridge 180:96ed750bd169 324
Anna Bridge 180:96ed750bd169 325
Anna Bridge 180:96ed750bd169 326 /**
Anna Bridge 180:96ed750bd169 327 \brief Set Main Stack Pointer
Anna Bridge 180:96ed750bd169 328 \details Assigns the given value to the Main Stack Pointer (MSP).
Anna Bridge 180:96ed750bd169 329 \param [in] topOfMainStack Main Stack Pointer value to set
Anna Bridge 180:96ed750bd169 330 */
Anna Bridge 186:707f6e361f3e 331 __STATIC_FORCEINLINE void __set_MSP(uint32_t topOfMainStack)
Anna Bridge 180:96ed750bd169 332 {
Anna Bridge 180:96ed750bd169 333 __ASM volatile ("MSR msp, %0" : : "r" (topOfMainStack) : );
Anna Bridge 180:96ed750bd169 334 }
Anna Bridge 180:96ed750bd169 335
Anna Bridge 180:96ed750bd169 336
Anna Bridge 180:96ed750bd169 337 #if (defined (__ARM_FEATURE_CMSE ) && (__ARM_FEATURE_CMSE == 3))
Anna Bridge 180:96ed750bd169 338 /**
Anna Bridge 180:96ed750bd169 339 \brief Set Main Stack Pointer (non-secure)
Anna Bridge 180:96ed750bd169 340 \details Assigns the given value to the non-secure Main Stack Pointer (MSP) when in secure state.
Anna Bridge 180:96ed750bd169 341 \param [in] topOfMainStack Main Stack Pointer value to set
Anna Bridge 180:96ed750bd169 342 */
Anna Bridge 186:707f6e361f3e 343 __STATIC_FORCEINLINE void __TZ_set_MSP_NS(uint32_t topOfMainStack)
Anna Bridge 180:96ed750bd169 344 {
Anna Bridge 180:96ed750bd169 345 __ASM volatile ("MSR msp_ns, %0" : : "r" (topOfMainStack) : );
Anna Bridge 180:96ed750bd169 346 }
Anna Bridge 180:96ed750bd169 347 #endif
Anna Bridge 180:96ed750bd169 348
Anna Bridge 180:96ed750bd169 349
Anna Bridge 180:96ed750bd169 350 #if (defined (__ARM_FEATURE_CMSE ) && (__ARM_FEATURE_CMSE == 3))
Anna Bridge 180:96ed750bd169 351 /**
Anna Bridge 180:96ed750bd169 352 \brief Get Stack Pointer (non-secure)
Anna Bridge 180:96ed750bd169 353 \details Returns the current value of the non-secure Stack Pointer (SP) when in secure state.
Anna Bridge 180:96ed750bd169 354 \return SP Register value
Anna Bridge 180:96ed750bd169 355 */
Anna Bridge 186:707f6e361f3e 356 __STATIC_FORCEINLINE uint32_t __TZ_get_SP_NS(void)
Anna Bridge 180:96ed750bd169 357 {
AnnaBridge 188:bcfe06ba3d64 358 uint32_t result;
Anna Bridge 180:96ed750bd169 359
Anna Bridge 180:96ed750bd169 360 __ASM volatile ("MRS %0, sp_ns" : "=r" (result) );
Anna Bridge 180:96ed750bd169 361 return(result);
Anna Bridge 180:96ed750bd169 362 }
Anna Bridge 180:96ed750bd169 363
Anna Bridge 180:96ed750bd169 364
Anna Bridge 180:96ed750bd169 365 /**
Anna Bridge 180:96ed750bd169 366 \brief Set Stack Pointer (non-secure)
Anna Bridge 180:96ed750bd169 367 \details Assigns the given value to the non-secure Stack Pointer (SP) when in secure state.
Anna Bridge 180:96ed750bd169 368 \param [in] topOfStack Stack Pointer value to set
Anna Bridge 180:96ed750bd169 369 */
Anna Bridge 186:707f6e361f3e 370 __STATIC_FORCEINLINE void __TZ_set_SP_NS(uint32_t topOfStack)
Anna Bridge 180:96ed750bd169 371 {
Anna Bridge 180:96ed750bd169 372 __ASM volatile ("MSR sp_ns, %0" : : "r" (topOfStack) : );
Anna Bridge 180:96ed750bd169 373 }
Anna Bridge 180:96ed750bd169 374 #endif
Anna Bridge 180:96ed750bd169 375
Anna Bridge 180:96ed750bd169 376
Anna Bridge 180:96ed750bd169 377 /**
Anna Bridge 180:96ed750bd169 378 \brief Get Priority Mask
Anna Bridge 180:96ed750bd169 379 \details Returns the current state of the priority mask bit from the Priority Mask Register.
Anna Bridge 180:96ed750bd169 380 \return Priority Mask value
Anna Bridge 180:96ed750bd169 381 */
Anna Bridge 186:707f6e361f3e 382 __STATIC_FORCEINLINE uint32_t __get_PRIMASK(void)
Anna Bridge 180:96ed750bd169 383 {
Anna Bridge 180:96ed750bd169 384 uint32_t result;
Anna Bridge 180:96ed750bd169 385
Anna Bridge 186:707f6e361f3e 386 __ASM volatile ("MRS %0, primask" : "=r" (result) :: "memory");
Anna Bridge 180:96ed750bd169 387 return(result);
Anna Bridge 180:96ed750bd169 388 }
Anna Bridge 180:96ed750bd169 389
Anna Bridge 180:96ed750bd169 390
Anna Bridge 180:96ed750bd169 391 #if (defined (__ARM_FEATURE_CMSE ) && (__ARM_FEATURE_CMSE == 3))
Anna Bridge 180:96ed750bd169 392 /**
Anna Bridge 180:96ed750bd169 393 \brief Get Priority Mask (non-secure)
Anna Bridge 180:96ed750bd169 394 \details Returns the current state of the non-secure priority mask bit from the Priority Mask Register when in secure state.
Anna Bridge 180:96ed750bd169 395 \return Priority Mask value
Anna Bridge 180:96ed750bd169 396 */
Anna Bridge 186:707f6e361f3e 397 __STATIC_FORCEINLINE uint32_t __TZ_get_PRIMASK_NS(void)
Anna Bridge 180:96ed750bd169 398 {
Anna Bridge 180:96ed750bd169 399 uint32_t result;
Anna Bridge 180:96ed750bd169 400
Anna Bridge 186:707f6e361f3e 401 __ASM volatile ("MRS %0, primask_ns" : "=r" (result) :: "memory");
Anna Bridge 180:96ed750bd169 402 return(result);
Anna Bridge 180:96ed750bd169 403 }
Anna Bridge 180:96ed750bd169 404 #endif
Anna Bridge 180:96ed750bd169 405
Anna Bridge 180:96ed750bd169 406
Anna Bridge 180:96ed750bd169 407 /**
Anna Bridge 180:96ed750bd169 408 \brief Set Priority Mask
Anna Bridge 180:96ed750bd169 409 \details Assigns the given value to the Priority Mask Register.
Anna Bridge 180:96ed750bd169 410 \param [in] priMask Priority Mask
Anna Bridge 180:96ed750bd169 411 */
Anna Bridge 186:707f6e361f3e 412 __STATIC_FORCEINLINE void __set_PRIMASK(uint32_t priMask)
Anna Bridge 180:96ed750bd169 413 {
Anna Bridge 180:96ed750bd169 414 __ASM volatile ("MSR primask, %0" : : "r" (priMask) : "memory");
Anna Bridge 180:96ed750bd169 415 }
Anna Bridge 180:96ed750bd169 416
Anna Bridge 180:96ed750bd169 417
Anna Bridge 180:96ed750bd169 418 #if (defined (__ARM_FEATURE_CMSE ) && (__ARM_FEATURE_CMSE == 3))
Anna Bridge 180:96ed750bd169 419 /**
Anna Bridge 180:96ed750bd169 420 \brief Set Priority Mask (non-secure)
Anna Bridge 180:96ed750bd169 421 \details Assigns the given value to the non-secure Priority Mask Register when in secure state.
Anna Bridge 180:96ed750bd169 422 \param [in] priMask Priority Mask
Anna Bridge 180:96ed750bd169 423 */
Anna Bridge 186:707f6e361f3e 424 __STATIC_FORCEINLINE void __TZ_set_PRIMASK_NS(uint32_t priMask)
Anna Bridge 180:96ed750bd169 425 {
Anna Bridge 180:96ed750bd169 426 __ASM volatile ("MSR primask_ns, %0" : : "r" (priMask) : "memory");
Anna Bridge 180:96ed750bd169 427 }
Anna Bridge 180:96ed750bd169 428 #endif
Anna Bridge 180:96ed750bd169 429
Anna Bridge 180:96ed750bd169 430
Anna Bridge 180:96ed750bd169 431 #if ((defined (__ARM_ARCH_7M__ ) && (__ARM_ARCH_7M__ == 1)) || \
Anna Bridge 180:96ed750bd169 432 (defined (__ARM_ARCH_7EM__ ) && (__ARM_ARCH_7EM__ == 1)) || \
Anna Bridge 180:96ed750bd169 433 (defined (__ARM_ARCH_8M_MAIN__ ) && (__ARM_ARCH_8M_MAIN__ == 1)) )
Anna Bridge 180:96ed750bd169 434 /**
Anna Bridge 180:96ed750bd169 435 \brief Enable FIQ
Anna Bridge 180:96ed750bd169 436 \details Enables FIQ interrupts by clearing the F-bit in the CPSR.
Anna Bridge 180:96ed750bd169 437 Can only be executed in Privileged modes.
Anna Bridge 180:96ed750bd169 438 */
Anna Bridge 186:707f6e361f3e 439 __STATIC_FORCEINLINE void __enable_fault_irq(void)
Anna Bridge 180:96ed750bd169 440 {
Anna Bridge 180:96ed750bd169 441 __ASM volatile ("cpsie f" : : : "memory");
Anna Bridge 180:96ed750bd169 442 }
Anna Bridge 180:96ed750bd169 443
Anna Bridge 180:96ed750bd169 444
Anna Bridge 180:96ed750bd169 445 /**
Anna Bridge 180:96ed750bd169 446 \brief Disable FIQ
Anna Bridge 180:96ed750bd169 447 \details Disables FIQ interrupts by setting the F-bit in the CPSR.
Anna Bridge 180:96ed750bd169 448 Can only be executed in Privileged modes.
Anna Bridge 180:96ed750bd169 449 */
Anna Bridge 186:707f6e361f3e 450 __STATIC_FORCEINLINE void __disable_fault_irq(void)
Anna Bridge 180:96ed750bd169 451 {
Anna Bridge 180:96ed750bd169 452 __ASM volatile ("cpsid f" : : : "memory");
Anna Bridge 180:96ed750bd169 453 }
Anna Bridge 180:96ed750bd169 454
Anna Bridge 180:96ed750bd169 455
Anna Bridge 180:96ed750bd169 456 /**
Anna Bridge 180:96ed750bd169 457 \brief Get Base Priority
Anna Bridge 180:96ed750bd169 458 \details Returns the current value of the Base Priority register.
Anna Bridge 180:96ed750bd169 459 \return Base Priority register value
Anna Bridge 180:96ed750bd169 460 */
Anna Bridge 186:707f6e361f3e 461 __STATIC_FORCEINLINE uint32_t __get_BASEPRI(void)
Anna Bridge 180:96ed750bd169 462 {
Anna Bridge 180:96ed750bd169 463 uint32_t result;
Anna Bridge 180:96ed750bd169 464
Anna Bridge 180:96ed750bd169 465 __ASM volatile ("MRS %0, basepri" : "=r" (result) );
Anna Bridge 180:96ed750bd169 466 return(result);
Anna Bridge 180:96ed750bd169 467 }
Anna Bridge 180:96ed750bd169 468
Anna Bridge 180:96ed750bd169 469
Anna Bridge 180:96ed750bd169 470 #if (defined (__ARM_FEATURE_CMSE ) && (__ARM_FEATURE_CMSE == 3))
Anna Bridge 180:96ed750bd169 471 /**
Anna Bridge 180:96ed750bd169 472 \brief Get Base Priority (non-secure)
Anna Bridge 180:96ed750bd169 473 \details Returns the current value of the non-secure Base Priority register when in secure state.
Anna Bridge 180:96ed750bd169 474 \return Base Priority register value
Anna Bridge 180:96ed750bd169 475 */
Anna Bridge 186:707f6e361f3e 476 __STATIC_FORCEINLINE uint32_t __TZ_get_BASEPRI_NS(void)
Anna Bridge 180:96ed750bd169 477 {
Anna Bridge 180:96ed750bd169 478 uint32_t result;
Anna Bridge 180:96ed750bd169 479
Anna Bridge 180:96ed750bd169 480 __ASM volatile ("MRS %0, basepri_ns" : "=r" (result) );
Anna Bridge 180:96ed750bd169 481 return(result);
Anna Bridge 180:96ed750bd169 482 }
Anna Bridge 180:96ed750bd169 483 #endif
Anna Bridge 180:96ed750bd169 484
Anna Bridge 180:96ed750bd169 485
Anna Bridge 180:96ed750bd169 486 /**
Anna Bridge 180:96ed750bd169 487 \brief Set Base Priority
Anna Bridge 180:96ed750bd169 488 \details Assigns the given value to the Base Priority register.
Anna Bridge 180:96ed750bd169 489 \param [in] basePri Base Priority value to set
Anna Bridge 180:96ed750bd169 490 */
Anna Bridge 186:707f6e361f3e 491 __STATIC_FORCEINLINE void __set_BASEPRI(uint32_t basePri)
Anna Bridge 180:96ed750bd169 492 {
Anna Bridge 180:96ed750bd169 493 __ASM volatile ("MSR basepri, %0" : : "r" (basePri) : "memory");
Anna Bridge 180:96ed750bd169 494 }
Anna Bridge 180:96ed750bd169 495
Anna Bridge 180:96ed750bd169 496
Anna Bridge 180:96ed750bd169 497 #if (defined (__ARM_FEATURE_CMSE ) && (__ARM_FEATURE_CMSE == 3))
Anna Bridge 180:96ed750bd169 498 /**
Anna Bridge 180:96ed750bd169 499 \brief Set Base Priority (non-secure)
Anna Bridge 180:96ed750bd169 500 \details Assigns the given value to the non-secure Base Priority register when in secure state.
Anna Bridge 180:96ed750bd169 501 \param [in] basePri Base Priority value to set
Anna Bridge 180:96ed750bd169 502 */
Anna Bridge 186:707f6e361f3e 503 __STATIC_FORCEINLINE void __TZ_set_BASEPRI_NS(uint32_t basePri)
Anna Bridge 180:96ed750bd169 504 {
Anna Bridge 180:96ed750bd169 505 __ASM volatile ("MSR basepri_ns, %0" : : "r" (basePri) : "memory");
Anna Bridge 180:96ed750bd169 506 }
Anna Bridge 180:96ed750bd169 507 #endif
Anna Bridge 180:96ed750bd169 508
Anna Bridge 180:96ed750bd169 509
Anna Bridge 180:96ed750bd169 510 /**
Anna Bridge 180:96ed750bd169 511 \brief Set Base Priority with condition
Anna Bridge 180:96ed750bd169 512 \details Assigns the given value to the Base Priority register only if BASEPRI masking is disabled,
Anna Bridge 180:96ed750bd169 513 or the new value increases the BASEPRI priority level.
Anna Bridge 180:96ed750bd169 514 \param [in] basePri Base Priority value to set
Anna Bridge 180:96ed750bd169 515 */
Anna Bridge 186:707f6e361f3e 516 __STATIC_FORCEINLINE void __set_BASEPRI_MAX(uint32_t basePri)
Anna Bridge 180:96ed750bd169 517 {
Anna Bridge 180:96ed750bd169 518 __ASM volatile ("MSR basepri_max, %0" : : "r" (basePri) : "memory");
Anna Bridge 180:96ed750bd169 519 }
Anna Bridge 180:96ed750bd169 520
Anna Bridge 180:96ed750bd169 521
Anna Bridge 180:96ed750bd169 522 /**
Anna Bridge 180:96ed750bd169 523 \brief Get Fault Mask
Anna Bridge 180:96ed750bd169 524 \details Returns the current value of the Fault Mask register.
Anna Bridge 180:96ed750bd169 525 \return Fault Mask register value
Anna Bridge 180:96ed750bd169 526 */
Anna Bridge 186:707f6e361f3e 527 __STATIC_FORCEINLINE uint32_t __get_FAULTMASK(void)
Anna Bridge 180:96ed750bd169 528 {
Anna Bridge 180:96ed750bd169 529 uint32_t result;
Anna Bridge 180:96ed750bd169 530
Anna Bridge 180:96ed750bd169 531 __ASM volatile ("MRS %0, faultmask" : "=r" (result) );
Anna Bridge 180:96ed750bd169 532 return(result);
Anna Bridge 180:96ed750bd169 533 }
Anna Bridge 180:96ed750bd169 534
Anna Bridge 180:96ed750bd169 535
Anna Bridge 180:96ed750bd169 536 #if (defined (__ARM_FEATURE_CMSE ) && (__ARM_FEATURE_CMSE == 3))
Anna Bridge 180:96ed750bd169 537 /**
Anna Bridge 180:96ed750bd169 538 \brief Get Fault Mask (non-secure)
Anna Bridge 180:96ed750bd169 539 \details Returns the current value of the non-secure Fault Mask register when in secure state.
Anna Bridge 180:96ed750bd169 540 \return Fault Mask register value
Anna Bridge 180:96ed750bd169 541 */
Anna Bridge 186:707f6e361f3e 542 __STATIC_FORCEINLINE uint32_t __TZ_get_FAULTMASK_NS(void)
Anna Bridge 180:96ed750bd169 543 {
Anna Bridge 180:96ed750bd169 544 uint32_t result;
Anna Bridge 180:96ed750bd169 545
Anna Bridge 180:96ed750bd169 546 __ASM volatile ("MRS %0, faultmask_ns" : "=r" (result) );
Anna Bridge 180:96ed750bd169 547 return(result);
Anna Bridge 180:96ed750bd169 548 }
Anna Bridge 180:96ed750bd169 549 #endif
Anna Bridge 180:96ed750bd169 550
Anna Bridge 180:96ed750bd169 551
Anna Bridge 180:96ed750bd169 552 /**
Anna Bridge 180:96ed750bd169 553 \brief Set Fault Mask
Anna Bridge 180:96ed750bd169 554 \details Assigns the given value to the Fault Mask register.
Anna Bridge 180:96ed750bd169 555 \param [in] faultMask Fault Mask value to set
Anna Bridge 180:96ed750bd169 556 */
Anna Bridge 186:707f6e361f3e 557 __STATIC_FORCEINLINE void __set_FAULTMASK(uint32_t faultMask)
Anna Bridge 180:96ed750bd169 558 {
Anna Bridge 180:96ed750bd169 559 __ASM volatile ("MSR faultmask, %0" : : "r" (faultMask) : "memory");
Anna Bridge 180:96ed750bd169 560 }
Anna Bridge 180:96ed750bd169 561
Anna Bridge 180:96ed750bd169 562
Anna Bridge 180:96ed750bd169 563 #if (defined (__ARM_FEATURE_CMSE ) && (__ARM_FEATURE_CMSE == 3))
Anna Bridge 180:96ed750bd169 564 /**
Anna Bridge 180:96ed750bd169 565 \brief Set Fault Mask (non-secure)
Anna Bridge 180:96ed750bd169 566 \details Assigns the given value to the non-secure Fault Mask register when in secure state.
Anna Bridge 180:96ed750bd169 567 \param [in] faultMask Fault Mask value to set
Anna Bridge 180:96ed750bd169 568 */
Anna Bridge 186:707f6e361f3e 569 __STATIC_FORCEINLINE void __TZ_set_FAULTMASK_NS(uint32_t faultMask)
Anna Bridge 180:96ed750bd169 570 {
Anna Bridge 180:96ed750bd169 571 __ASM volatile ("MSR faultmask_ns, %0" : : "r" (faultMask) : "memory");
Anna Bridge 180:96ed750bd169 572 }
Anna Bridge 180:96ed750bd169 573 #endif
Anna Bridge 180:96ed750bd169 574
Anna Bridge 180:96ed750bd169 575 #endif /* ((defined (__ARM_ARCH_7M__ ) && (__ARM_ARCH_7M__ == 1)) || \
Anna Bridge 180:96ed750bd169 576 (defined (__ARM_ARCH_7EM__ ) && (__ARM_ARCH_7EM__ == 1)) || \
Anna Bridge 180:96ed750bd169 577 (defined (__ARM_ARCH_8M_MAIN__ ) && (__ARM_ARCH_8M_MAIN__ == 1)) ) */
Anna Bridge 180:96ed750bd169 578
Anna Bridge 180:96ed750bd169 579
Anna Bridge 180:96ed750bd169 580 #if ((defined (__ARM_ARCH_8M_MAIN__ ) && (__ARM_ARCH_8M_MAIN__ == 1)) || \
Anna Bridge 180:96ed750bd169 581 (defined (__ARM_ARCH_8M_BASE__ ) && (__ARM_ARCH_8M_BASE__ == 1)) )
Anna Bridge 180:96ed750bd169 582
Anna Bridge 180:96ed750bd169 583 /**
Anna Bridge 180:96ed750bd169 584 \brief Get Process Stack Pointer Limit
Anna Bridge 186:707f6e361f3e 585 Devices without ARMv8-M Main Extensions (i.e. Cortex-M23) lack the non-secure
Anna Bridge 186:707f6e361f3e 586 Stack Pointer Limit register hence zero is returned always in non-secure
Anna Bridge 186:707f6e361f3e 587 mode.
Anna Bridge 186:707f6e361f3e 588
Anna Bridge 180:96ed750bd169 589 \details Returns the current value of the Process Stack Pointer Limit (PSPLIM).
Anna Bridge 180:96ed750bd169 590 \return PSPLIM Register value
Anna Bridge 180:96ed750bd169 591 */
Anna Bridge 186:707f6e361f3e 592 __STATIC_FORCEINLINE uint32_t __get_PSPLIM(void)
Anna Bridge 180:96ed750bd169 593 {
Anna Bridge 186:707f6e361f3e 594 #if (!(defined (__ARM_ARCH_8M_MAIN__ ) && (__ARM_ARCH_8M_MAIN__ == 1)) && \
Anna Bridge 186:707f6e361f3e 595 (!defined (__ARM_FEATURE_CMSE) || (__ARM_FEATURE_CMSE < 3)))
Anna Bridge 186:707f6e361f3e 596 // without main extensions, the non-secure PSPLIM is RAZ/WI
Anna Bridge 186:707f6e361f3e 597 return 0U;
Anna Bridge 186:707f6e361f3e 598 #else
AnnaBridge 188:bcfe06ba3d64 599 uint32_t result;
Anna Bridge 180:96ed750bd169 600 __ASM volatile ("MRS %0, psplim" : "=r" (result) );
Anna Bridge 186:707f6e361f3e 601 return result;
Anna Bridge 186:707f6e361f3e 602 #endif
Anna Bridge 180:96ed750bd169 603 }
Anna Bridge 180:96ed750bd169 604
Anna Bridge 186:707f6e361f3e 605 #if (defined (__ARM_FEATURE_CMSE) && (__ARM_FEATURE_CMSE == 3))
Anna Bridge 180:96ed750bd169 606 /**
Anna Bridge 180:96ed750bd169 607 \brief Get Process Stack Pointer Limit (non-secure)
Anna Bridge 186:707f6e361f3e 608 Devices without ARMv8-M Main Extensions (i.e. Cortex-M23) lack the non-secure
Anna Bridge 186:707f6e361f3e 609 Stack Pointer Limit register hence zero is returned always.
Anna Bridge 186:707f6e361f3e 610
Anna Bridge 180:96ed750bd169 611 \details Returns the current value of the non-secure Process Stack Pointer Limit (PSPLIM) when in secure state.
Anna Bridge 180:96ed750bd169 612 \return PSPLIM Register value
Anna Bridge 180:96ed750bd169 613 */
Anna Bridge 186:707f6e361f3e 614 __STATIC_FORCEINLINE uint32_t __TZ_get_PSPLIM_NS(void)
Anna Bridge 180:96ed750bd169 615 {
Anna Bridge 186:707f6e361f3e 616 #if (!(defined (__ARM_ARCH_8M_MAIN__ ) && (__ARM_ARCH_8M_MAIN__ == 1)))
Anna Bridge 186:707f6e361f3e 617 // without main extensions, the non-secure PSPLIM is RAZ/WI
Anna Bridge 186:707f6e361f3e 618 return 0U;
Anna Bridge 186:707f6e361f3e 619 #else
AnnaBridge 188:bcfe06ba3d64 620 uint32_t result;
Anna Bridge 180:96ed750bd169 621 __ASM volatile ("MRS %0, psplim_ns" : "=r" (result) );
Anna Bridge 186:707f6e361f3e 622 return result;
Anna Bridge 186:707f6e361f3e 623 #endif
Anna Bridge 180:96ed750bd169 624 }
Anna Bridge 180:96ed750bd169 625 #endif
Anna Bridge 180:96ed750bd169 626
Anna Bridge 180:96ed750bd169 627
Anna Bridge 180:96ed750bd169 628 /**
Anna Bridge 180:96ed750bd169 629 \brief Set Process Stack Pointer Limit
Anna Bridge 186:707f6e361f3e 630 Devices without ARMv8-M Main Extensions (i.e. Cortex-M23) lack the non-secure
Anna Bridge 186:707f6e361f3e 631 Stack Pointer Limit register hence the write is silently ignored in non-secure
Anna Bridge 186:707f6e361f3e 632 mode.
Anna Bridge 186:707f6e361f3e 633
Anna Bridge 180:96ed750bd169 634 \details Assigns the given value to the Process Stack Pointer Limit (PSPLIM).
Anna Bridge 180:96ed750bd169 635 \param [in] ProcStackPtrLimit Process Stack Pointer Limit value to set
Anna Bridge 180:96ed750bd169 636 */
Anna Bridge 186:707f6e361f3e 637 __STATIC_FORCEINLINE void __set_PSPLIM(uint32_t ProcStackPtrLimit)
Anna Bridge 180:96ed750bd169 638 {
Anna Bridge 186:707f6e361f3e 639 #if (!(defined (__ARM_ARCH_8M_MAIN__ ) && (__ARM_ARCH_8M_MAIN__ == 1)) && \
Anna Bridge 186:707f6e361f3e 640 (!defined (__ARM_FEATURE_CMSE) || (__ARM_FEATURE_CMSE < 3)))
Anna Bridge 186:707f6e361f3e 641 // without main extensions, the non-secure PSPLIM is RAZ/WI
Anna Bridge 186:707f6e361f3e 642 (void)ProcStackPtrLimit;
Anna Bridge 186:707f6e361f3e 643 #else
Anna Bridge 180:96ed750bd169 644 __ASM volatile ("MSR psplim, %0" : : "r" (ProcStackPtrLimit));
Anna Bridge 186:707f6e361f3e 645 #endif
Anna Bridge 180:96ed750bd169 646 }
Anna Bridge 180:96ed750bd169 647
Anna Bridge 180:96ed750bd169 648
Anna Bridge 186:707f6e361f3e 649 #if (defined (__ARM_FEATURE_CMSE ) && (__ARM_FEATURE_CMSE == 3))
Anna Bridge 180:96ed750bd169 650 /**
Anna Bridge 180:96ed750bd169 651 \brief Set Process Stack Pointer (non-secure)
Anna Bridge 186:707f6e361f3e 652 Devices without ARMv8-M Main Extensions (i.e. Cortex-M23) lack the non-secure
Anna Bridge 186:707f6e361f3e 653 Stack Pointer Limit register hence the write is silently ignored.
Anna Bridge 186:707f6e361f3e 654
Anna Bridge 180:96ed750bd169 655 \details Assigns the given value to the non-secure Process Stack Pointer Limit (PSPLIM) when in secure state.
Anna Bridge 180:96ed750bd169 656 \param [in] ProcStackPtrLimit Process Stack Pointer Limit value to set
Anna Bridge 180:96ed750bd169 657 */
Anna Bridge 186:707f6e361f3e 658 __STATIC_FORCEINLINE void __TZ_set_PSPLIM_NS(uint32_t ProcStackPtrLimit)
Anna Bridge 180:96ed750bd169 659 {
Anna Bridge 186:707f6e361f3e 660 #if (!(defined (__ARM_ARCH_8M_MAIN__ ) && (__ARM_ARCH_8M_MAIN__ == 1)))
Anna Bridge 186:707f6e361f3e 661 // without main extensions, the non-secure PSPLIM is RAZ/WI
Anna Bridge 186:707f6e361f3e 662 (void)ProcStackPtrLimit;
Anna Bridge 186:707f6e361f3e 663 #else
Anna Bridge 180:96ed750bd169 664 __ASM volatile ("MSR psplim_ns, %0\n" : : "r" (ProcStackPtrLimit));
Anna Bridge 186:707f6e361f3e 665 #endif
Anna Bridge 180:96ed750bd169 666 }
Anna Bridge 180:96ed750bd169 667 #endif
Anna Bridge 180:96ed750bd169 668
Anna Bridge 180:96ed750bd169 669
Anna Bridge 180:96ed750bd169 670 /**
Anna Bridge 180:96ed750bd169 671 \brief Get Main Stack Pointer Limit
Anna Bridge 186:707f6e361f3e 672 Devices without ARMv8-M Main Extensions (i.e. Cortex-M23) lack the non-secure
Anna Bridge 186:707f6e361f3e 673 Stack Pointer Limit register hence zero is returned always in non-secure
Anna Bridge 186:707f6e361f3e 674 mode.
Anna Bridge 186:707f6e361f3e 675
Anna Bridge 180:96ed750bd169 676 \details Returns the current value of the Main Stack Pointer Limit (MSPLIM).
Anna Bridge 180:96ed750bd169 677 \return MSPLIM Register value
Anna Bridge 180:96ed750bd169 678 */
Anna Bridge 186:707f6e361f3e 679 __STATIC_FORCEINLINE uint32_t __get_MSPLIM(void)
Anna Bridge 180:96ed750bd169 680 {
Anna Bridge 186:707f6e361f3e 681 #if (!(defined (__ARM_ARCH_8M_MAIN__ ) && (__ARM_ARCH_8M_MAIN__ == 1)) && \
Anna Bridge 186:707f6e361f3e 682 (!defined (__ARM_FEATURE_CMSE) || (__ARM_FEATURE_CMSE < 3)))
Anna Bridge 186:707f6e361f3e 683 // without main extensions, the non-secure MSPLIM is RAZ/WI
Anna Bridge 186:707f6e361f3e 684 return 0U;
Anna Bridge 186:707f6e361f3e 685 #else
AnnaBridge 188:bcfe06ba3d64 686 uint32_t result;
Anna Bridge 180:96ed750bd169 687 __ASM volatile ("MRS %0, msplim" : "=r" (result) );
Anna Bridge 186:707f6e361f3e 688 return result;
Anna Bridge 186:707f6e361f3e 689 #endif
Anna Bridge 180:96ed750bd169 690 }
Anna Bridge 180:96ed750bd169 691
Anna Bridge 180:96ed750bd169 692
Anna Bridge 186:707f6e361f3e 693 #if (defined (__ARM_FEATURE_CMSE ) && (__ARM_FEATURE_CMSE == 3))
Anna Bridge 180:96ed750bd169 694 /**
Anna Bridge 180:96ed750bd169 695 \brief Get Main Stack Pointer Limit (non-secure)
Anna Bridge 186:707f6e361f3e 696 Devices without ARMv8-M Main Extensions (i.e. Cortex-M23) lack the non-secure
Anna Bridge 186:707f6e361f3e 697 Stack Pointer Limit register hence zero is returned always.
Anna Bridge 186:707f6e361f3e 698
Anna Bridge 180:96ed750bd169 699 \details Returns the current value of the non-secure Main Stack Pointer Limit(MSPLIM) when in secure state.
Anna Bridge 180:96ed750bd169 700 \return MSPLIM Register value
Anna Bridge 180:96ed750bd169 701 */
Anna Bridge 186:707f6e361f3e 702 __STATIC_FORCEINLINE uint32_t __TZ_get_MSPLIM_NS(void)
Anna Bridge 180:96ed750bd169 703 {
Anna Bridge 186:707f6e361f3e 704 #if (!(defined (__ARM_ARCH_8M_MAIN__ ) && (__ARM_ARCH_8M_MAIN__ == 1)))
Anna Bridge 186:707f6e361f3e 705 // without main extensions, the non-secure MSPLIM is RAZ/WI
Anna Bridge 186:707f6e361f3e 706 return 0U;
Anna Bridge 186:707f6e361f3e 707 #else
AnnaBridge 188:bcfe06ba3d64 708 uint32_t result;
Anna Bridge 180:96ed750bd169 709 __ASM volatile ("MRS %0, msplim_ns" : "=r" (result) );
Anna Bridge 186:707f6e361f3e 710 return result;
Anna Bridge 186:707f6e361f3e 711 #endif
Anna Bridge 180:96ed750bd169 712 }
Anna Bridge 180:96ed750bd169 713 #endif
Anna Bridge 180:96ed750bd169 714
Anna Bridge 180:96ed750bd169 715
Anna Bridge 180:96ed750bd169 716 /**
Anna Bridge 180:96ed750bd169 717 \brief Set Main Stack Pointer Limit
Anna Bridge 186:707f6e361f3e 718 Devices without ARMv8-M Main Extensions (i.e. Cortex-M23) lack the non-secure
Anna Bridge 186:707f6e361f3e 719 Stack Pointer Limit register hence the write is silently ignored in non-secure
Anna Bridge 186:707f6e361f3e 720 mode.
Anna Bridge 186:707f6e361f3e 721
Anna Bridge 180:96ed750bd169 722 \details Assigns the given value to the Main Stack Pointer Limit (MSPLIM).
Anna Bridge 180:96ed750bd169 723 \param [in] MainStackPtrLimit Main Stack Pointer Limit value to set
Anna Bridge 180:96ed750bd169 724 */
Anna Bridge 186:707f6e361f3e 725 __STATIC_FORCEINLINE void __set_MSPLIM(uint32_t MainStackPtrLimit)
Anna Bridge 180:96ed750bd169 726 {
Anna Bridge 186:707f6e361f3e 727 #if (!(defined (__ARM_ARCH_8M_MAIN__ ) && (__ARM_ARCH_8M_MAIN__ == 1)) && \
Anna Bridge 186:707f6e361f3e 728 (!defined (__ARM_FEATURE_CMSE) || (__ARM_FEATURE_CMSE < 3)))
Anna Bridge 186:707f6e361f3e 729 // without main extensions, the non-secure MSPLIM is RAZ/WI
Anna Bridge 186:707f6e361f3e 730 (void)MainStackPtrLimit;
Anna Bridge 186:707f6e361f3e 731 #else
Anna Bridge 180:96ed750bd169 732 __ASM volatile ("MSR msplim, %0" : : "r" (MainStackPtrLimit));
Anna Bridge 186:707f6e361f3e 733 #endif
Anna Bridge 180:96ed750bd169 734 }
Anna Bridge 180:96ed750bd169 735
Anna Bridge 180:96ed750bd169 736
Anna Bridge 186:707f6e361f3e 737 #if (defined (__ARM_FEATURE_CMSE ) && (__ARM_FEATURE_CMSE == 3))
Anna Bridge 180:96ed750bd169 738 /**
Anna Bridge 180:96ed750bd169 739 \brief Set Main Stack Pointer Limit (non-secure)
Anna Bridge 186:707f6e361f3e 740 Devices without ARMv8-M Main Extensions (i.e. Cortex-M23) lack the non-secure
Anna Bridge 186:707f6e361f3e 741 Stack Pointer Limit register hence the write is silently ignored.
Anna Bridge 186:707f6e361f3e 742
Anna Bridge 180:96ed750bd169 743 \details Assigns the given value to the non-secure Main Stack Pointer Limit (MSPLIM) when in secure state.
Anna Bridge 180:96ed750bd169 744 \param [in] MainStackPtrLimit Main Stack Pointer value to set
Anna Bridge 180:96ed750bd169 745 */
Anna Bridge 186:707f6e361f3e 746 __STATIC_FORCEINLINE void __TZ_set_MSPLIM_NS(uint32_t MainStackPtrLimit)
Anna Bridge 180:96ed750bd169 747 {
Anna Bridge 186:707f6e361f3e 748 #if (!(defined (__ARM_ARCH_8M_MAIN__ ) && (__ARM_ARCH_8M_MAIN__ == 1)))
Anna Bridge 186:707f6e361f3e 749 // without main extensions, the non-secure MSPLIM is RAZ/WI
Anna Bridge 186:707f6e361f3e 750 (void)MainStackPtrLimit;
Anna Bridge 186:707f6e361f3e 751 #else
Anna Bridge 180:96ed750bd169 752 __ASM volatile ("MSR msplim_ns, %0" : : "r" (MainStackPtrLimit));
Anna Bridge 186:707f6e361f3e 753 #endif
Anna Bridge 180:96ed750bd169 754 }
Anna Bridge 180:96ed750bd169 755 #endif
Anna Bridge 180:96ed750bd169 756
Anna Bridge 180:96ed750bd169 757 #endif /* ((defined (__ARM_ARCH_8M_MAIN__ ) && (__ARM_ARCH_8M_MAIN__ == 1)) || \
Anna Bridge 180:96ed750bd169 758 (defined (__ARM_ARCH_8M_BASE__ ) && (__ARM_ARCH_8M_BASE__ == 1)) ) */
Anna Bridge 180:96ed750bd169 759
Anna Bridge 180:96ed750bd169 760
Anna Bridge 180:96ed750bd169 761 /**
Anna Bridge 180:96ed750bd169 762 \brief Get FPSCR
Anna Bridge 180:96ed750bd169 763 \details Returns the current value of the Floating Point Status/Control register.
Anna Bridge 180:96ed750bd169 764 \return Floating Point Status/Control register value
Anna Bridge 180:96ed750bd169 765 */
Anna Bridge 186:707f6e361f3e 766 __STATIC_FORCEINLINE uint32_t __get_FPSCR(void)
Anna Bridge 180:96ed750bd169 767 {
Anna Bridge 180:96ed750bd169 768 #if ((defined (__FPU_PRESENT) && (__FPU_PRESENT == 1U)) && \
Anna Bridge 180:96ed750bd169 769 (defined (__FPU_USED ) && (__FPU_USED == 1U)) )
AnnaBridge 188:bcfe06ba3d64 770 #if __has_builtin(__builtin_arm_get_fpscr)
AnnaBridge 188:bcfe06ba3d64 771 // Re-enable using built-in when GCC has been fixed
AnnaBridge 188:bcfe06ba3d64 772 // || (__GNUC__ > 7) || (__GNUC__ == 7 && __GNUC_MINOR__ >= 2)
Anna Bridge 180:96ed750bd169 773 /* see https://gcc.gnu.org/ml/gcc-patches/2017-04/msg00443.html */
Anna Bridge 180:96ed750bd169 774 return __builtin_arm_get_fpscr();
Anna Bridge 180:96ed750bd169 775 #else
Anna Bridge 180:96ed750bd169 776 uint32_t result;
Anna Bridge 180:96ed750bd169 777
Anna Bridge 180:96ed750bd169 778 __ASM volatile ("VMRS %0, fpscr" : "=r" (result) );
Anna Bridge 180:96ed750bd169 779 return(result);
Anna Bridge 180:96ed750bd169 780 #endif
Anna Bridge 180:96ed750bd169 781 #else
Anna Bridge 180:96ed750bd169 782 return(0U);
Anna Bridge 180:96ed750bd169 783 #endif
Anna Bridge 180:96ed750bd169 784 }
Anna Bridge 180:96ed750bd169 785
Anna Bridge 180:96ed750bd169 786
Anna Bridge 180:96ed750bd169 787 /**
Anna Bridge 180:96ed750bd169 788 \brief Set FPSCR
Anna Bridge 180:96ed750bd169 789 \details Assigns the given value to the Floating Point Status/Control register.
Anna Bridge 180:96ed750bd169 790 \param [in] fpscr Floating Point Status/Control value to set
Anna Bridge 180:96ed750bd169 791 */
Anna Bridge 186:707f6e361f3e 792 __STATIC_FORCEINLINE void __set_FPSCR(uint32_t fpscr)
Anna Bridge 180:96ed750bd169 793 {
Anna Bridge 180:96ed750bd169 794 #if ((defined (__FPU_PRESENT) && (__FPU_PRESENT == 1U)) && \
Anna Bridge 180:96ed750bd169 795 (defined (__FPU_USED ) && (__FPU_USED == 1U)) )
AnnaBridge 188:bcfe06ba3d64 796 #if __has_builtin(__builtin_arm_set_fpscr)
AnnaBridge 188:bcfe06ba3d64 797 // Re-enable using built-in when GCC has been fixed
AnnaBridge 188:bcfe06ba3d64 798 // || (__GNUC__ > 7) || (__GNUC__ == 7 && __GNUC_MINOR__ >= 2)
Anna Bridge 180:96ed750bd169 799 /* see https://gcc.gnu.org/ml/gcc-patches/2017-04/msg00443.html */
Anna Bridge 180:96ed750bd169 800 __builtin_arm_set_fpscr(fpscr);
Anna Bridge 180:96ed750bd169 801 #else
Anna Bridge 180:96ed750bd169 802 __ASM volatile ("VMSR fpscr, %0" : : "r" (fpscr) : "vfpcc", "memory");
Anna Bridge 180:96ed750bd169 803 #endif
Anna Bridge 180:96ed750bd169 804 #else
Anna Bridge 180:96ed750bd169 805 (void)fpscr;
Anna Bridge 180:96ed750bd169 806 #endif
Anna Bridge 180:96ed750bd169 807 }
Anna Bridge 180:96ed750bd169 808
Anna Bridge 180:96ed750bd169 809
Anna Bridge 180:96ed750bd169 810 /*@} end of CMSIS_Core_RegAccFunctions */
Anna Bridge 180:96ed750bd169 811
Anna Bridge 180:96ed750bd169 812
Anna Bridge 180:96ed750bd169 813 /* ########################## Core Instruction Access ######################### */
Anna Bridge 180:96ed750bd169 814 /** \defgroup CMSIS_Core_InstructionInterface CMSIS Core Instruction Interface
Anna Bridge 180:96ed750bd169 815 Access to dedicated instructions
Anna Bridge 180:96ed750bd169 816 @{
Anna Bridge 180:96ed750bd169 817 */
Anna Bridge 180:96ed750bd169 818
Anna Bridge 180:96ed750bd169 819 /* Define macros for porting to both thumb1 and thumb2.
Anna Bridge 180:96ed750bd169 820 * For thumb1, use low register (r0-r7), specified by constraint "l"
Anna Bridge 180:96ed750bd169 821 * Otherwise, use general registers, specified by constraint "r" */
Anna Bridge 180:96ed750bd169 822 #if defined (__thumb__) && !defined (__thumb2__)
Anna Bridge 180:96ed750bd169 823 #define __CMSIS_GCC_OUT_REG(r) "=l" (r)
Anna Bridge 180:96ed750bd169 824 #define __CMSIS_GCC_RW_REG(r) "+l" (r)
Anna Bridge 180:96ed750bd169 825 #define __CMSIS_GCC_USE_REG(r) "l" (r)
Anna Bridge 180:96ed750bd169 826 #else
Anna Bridge 180:96ed750bd169 827 #define __CMSIS_GCC_OUT_REG(r) "=r" (r)
Anna Bridge 180:96ed750bd169 828 #define __CMSIS_GCC_RW_REG(r) "+r" (r)
Anna Bridge 180:96ed750bd169 829 #define __CMSIS_GCC_USE_REG(r) "r" (r)
Anna Bridge 180:96ed750bd169 830 #endif
Anna Bridge 180:96ed750bd169 831
Anna Bridge 180:96ed750bd169 832 /**
Anna Bridge 180:96ed750bd169 833 \brief No Operation
Anna Bridge 180:96ed750bd169 834 \details No Operation does nothing. This instruction can be used for code alignment purposes.
Anna Bridge 180:96ed750bd169 835 */
Anna Bridge 186:707f6e361f3e 836 #define __NOP() __ASM volatile ("nop")
Anna Bridge 180:96ed750bd169 837
Anna Bridge 180:96ed750bd169 838 /**
Anna Bridge 180:96ed750bd169 839 \brief Wait For Interrupt
Anna Bridge 180:96ed750bd169 840 \details Wait For Interrupt is a hint instruction that suspends execution until one of a number of events occurs.
Anna Bridge 180:96ed750bd169 841 */
Anna Bridge 186:707f6e361f3e 842 #define __WFI() __ASM volatile ("wfi")
Anna Bridge 180:96ed750bd169 843
Anna Bridge 180:96ed750bd169 844
Anna Bridge 180:96ed750bd169 845 /**
Anna Bridge 180:96ed750bd169 846 \brief Wait For Event
Anna Bridge 180:96ed750bd169 847 \details Wait For Event is a hint instruction that permits the processor to enter
Anna Bridge 180:96ed750bd169 848 a low-power state until one of a number of events occurs.
Anna Bridge 180:96ed750bd169 849 */
Anna Bridge 186:707f6e361f3e 850 #define __WFE() __ASM volatile ("wfe")
Anna Bridge 180:96ed750bd169 851
Anna Bridge 180:96ed750bd169 852
Anna Bridge 180:96ed750bd169 853 /**
Anna Bridge 180:96ed750bd169 854 \brief Send Event
Anna Bridge 180:96ed750bd169 855 \details Send Event is a hint instruction. It causes an event to be signaled to the CPU.
Anna Bridge 180:96ed750bd169 856 */
Anna Bridge 186:707f6e361f3e 857 #define __SEV() __ASM volatile ("sev")
Anna Bridge 180:96ed750bd169 858
Anna Bridge 180:96ed750bd169 859
Anna Bridge 180:96ed750bd169 860 /**
Anna Bridge 180:96ed750bd169 861 \brief Instruction Synchronization Barrier
Anna Bridge 180:96ed750bd169 862 \details Instruction Synchronization Barrier flushes the pipeline in the processor,
Anna Bridge 180:96ed750bd169 863 so that all instructions following the ISB are fetched from cache or memory,
Anna Bridge 180:96ed750bd169 864 after the instruction has been completed.
Anna Bridge 180:96ed750bd169 865 */
Anna Bridge 186:707f6e361f3e 866 __STATIC_FORCEINLINE void __ISB(void)
Anna Bridge 180:96ed750bd169 867 {
Anna Bridge 180:96ed750bd169 868 __ASM volatile ("isb 0xF":::"memory");
Anna Bridge 180:96ed750bd169 869 }
Anna Bridge 180:96ed750bd169 870
Anna Bridge 180:96ed750bd169 871
Anna Bridge 180:96ed750bd169 872 /**
Anna Bridge 180:96ed750bd169 873 \brief Data Synchronization Barrier
Anna Bridge 180:96ed750bd169 874 \details Acts as a special kind of Data Memory Barrier.
Anna Bridge 180:96ed750bd169 875 It completes when all explicit memory accesses before this instruction complete.
Anna Bridge 180:96ed750bd169 876 */
Anna Bridge 186:707f6e361f3e 877 __STATIC_FORCEINLINE void __DSB(void)
Anna Bridge 180:96ed750bd169 878 {
Anna Bridge 180:96ed750bd169 879 __ASM volatile ("dsb 0xF":::"memory");
Anna Bridge 180:96ed750bd169 880 }
Anna Bridge 180:96ed750bd169 881
Anna Bridge 180:96ed750bd169 882
Anna Bridge 180:96ed750bd169 883 /**
Anna Bridge 180:96ed750bd169 884 \brief Data Memory Barrier
Anna Bridge 180:96ed750bd169 885 \details Ensures the apparent order of the explicit memory operations before
Anna Bridge 180:96ed750bd169 886 and after the instruction, without ensuring their completion.
Anna Bridge 180:96ed750bd169 887 */
Anna Bridge 186:707f6e361f3e 888 __STATIC_FORCEINLINE void __DMB(void)
Anna Bridge 180:96ed750bd169 889 {
Anna Bridge 180:96ed750bd169 890 __ASM volatile ("dmb 0xF":::"memory");
Anna Bridge 180:96ed750bd169 891 }
Anna Bridge 180:96ed750bd169 892
Anna Bridge 180:96ed750bd169 893
Anna Bridge 180:96ed750bd169 894 /**
Anna Bridge 180:96ed750bd169 895 \brief Reverse byte order (32 bit)
Anna Bridge 186:707f6e361f3e 896 \details Reverses the byte order in unsigned integer value. For example, 0x12345678 becomes 0x78563412.
Anna Bridge 180:96ed750bd169 897 \param [in] value Value to reverse
Anna Bridge 180:96ed750bd169 898 \return Reversed value
Anna Bridge 180:96ed750bd169 899 */
Anna Bridge 186:707f6e361f3e 900 __STATIC_FORCEINLINE uint32_t __REV(uint32_t value)
Anna Bridge 180:96ed750bd169 901 {
Anna Bridge 180:96ed750bd169 902 #if (__GNUC__ > 4) || (__GNUC__ == 4 && __GNUC_MINOR__ >= 5)
Anna Bridge 180:96ed750bd169 903 return __builtin_bswap32(value);
Anna Bridge 180:96ed750bd169 904 #else
Anna Bridge 180:96ed750bd169 905 uint32_t result;
Anna Bridge 180:96ed750bd169 906
Anna Bridge 180:96ed750bd169 907 __ASM volatile ("rev %0, %1" : __CMSIS_GCC_OUT_REG (result) : __CMSIS_GCC_USE_REG (value) );
Anna Bridge 186:707f6e361f3e 908 return result;
Anna Bridge 180:96ed750bd169 909 #endif
Anna Bridge 180:96ed750bd169 910 }
Anna Bridge 180:96ed750bd169 911
Anna Bridge 180:96ed750bd169 912
Anna Bridge 180:96ed750bd169 913 /**
Anna Bridge 180:96ed750bd169 914 \brief Reverse byte order (16 bit)
Anna Bridge 186:707f6e361f3e 915 \details Reverses the byte order within each halfword of a word. For example, 0x12345678 becomes 0x34127856.
Anna Bridge 180:96ed750bd169 916 \param [in] value Value to reverse
Anna Bridge 180:96ed750bd169 917 \return Reversed value
Anna Bridge 180:96ed750bd169 918 */
Anna Bridge 186:707f6e361f3e 919 __STATIC_FORCEINLINE uint32_t __REV16(uint32_t value)
Anna Bridge 180:96ed750bd169 920 {
Anna Bridge 186:707f6e361f3e 921 uint32_t result;
Anna Bridge 180:96ed750bd169 922
Anna Bridge 180:96ed750bd169 923 __ASM volatile ("rev16 %0, %1" : __CMSIS_GCC_OUT_REG (result) : __CMSIS_GCC_USE_REG (value) );
Anna Bridge 186:707f6e361f3e 924 return result;
Anna Bridge 180:96ed750bd169 925 }
Anna Bridge 180:96ed750bd169 926
Anna Bridge 180:96ed750bd169 927
Anna Bridge 180:96ed750bd169 928 /**
Anna Bridge 186:707f6e361f3e 929 \brief Reverse byte order (16 bit)
Anna Bridge 186:707f6e361f3e 930 \details Reverses the byte order in a 16-bit value and returns the signed 16-bit result. For example, 0x0080 becomes 0x8000.
Anna Bridge 180:96ed750bd169 931 \param [in] value Value to reverse
Anna Bridge 180:96ed750bd169 932 \return Reversed value
Anna Bridge 180:96ed750bd169 933 */
Anna Bridge 186:707f6e361f3e 934 __STATIC_FORCEINLINE int16_t __REVSH(int16_t value)
Anna Bridge 180:96ed750bd169 935 {
Anna Bridge 180:96ed750bd169 936 #if (__GNUC__ > 4) || (__GNUC__ == 4 && __GNUC_MINOR__ >= 8)
Anna Bridge 180:96ed750bd169 937 return (int16_t)__builtin_bswap16(value);
Anna Bridge 180:96ed750bd169 938 #else
Anna Bridge 180:96ed750bd169 939 int16_t result;
Anna Bridge 180:96ed750bd169 940
Anna Bridge 180:96ed750bd169 941 __ASM volatile ("revsh %0, %1" : __CMSIS_GCC_OUT_REG (result) : __CMSIS_GCC_USE_REG (value) );
Anna Bridge 180:96ed750bd169 942 return result;
Anna Bridge 180:96ed750bd169 943 #endif
Anna Bridge 180:96ed750bd169 944 }
Anna Bridge 180:96ed750bd169 945
Anna Bridge 180:96ed750bd169 946
Anna Bridge 180:96ed750bd169 947 /**
Anna Bridge 180:96ed750bd169 948 \brief Rotate Right in unsigned value (32 bit)
Anna Bridge 180:96ed750bd169 949 \details Rotate Right (immediate) provides the value of the contents of a register rotated by a variable number of bits.
Anna Bridge 180:96ed750bd169 950 \param [in] op1 Value to rotate
Anna Bridge 180:96ed750bd169 951 \param [in] op2 Number of Bits to rotate
Anna Bridge 180:96ed750bd169 952 \return Rotated value
Anna Bridge 180:96ed750bd169 953 */
Anna Bridge 186:707f6e361f3e 954 __STATIC_FORCEINLINE uint32_t __ROR(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 955 {
Anna Bridge 186:707f6e361f3e 956 op2 %= 32U;
Anna Bridge 186:707f6e361f3e 957 if (op2 == 0U)
Anna Bridge 186:707f6e361f3e 958 {
Anna Bridge 186:707f6e361f3e 959 return op1;
Anna Bridge 186:707f6e361f3e 960 }
Anna Bridge 180:96ed750bd169 961 return (op1 >> op2) | (op1 << (32U - op2));
Anna Bridge 180:96ed750bd169 962 }
Anna Bridge 180:96ed750bd169 963
Anna Bridge 180:96ed750bd169 964
Anna Bridge 180:96ed750bd169 965 /**
Anna Bridge 180:96ed750bd169 966 \brief Breakpoint
Anna Bridge 180:96ed750bd169 967 \details Causes the processor to enter Debug state.
Anna Bridge 180:96ed750bd169 968 Debug tools can use this to investigate system state when the instruction at a particular address is reached.
Anna Bridge 180:96ed750bd169 969 \param [in] value is ignored by the processor.
Anna Bridge 180:96ed750bd169 970 If required, a debugger can use it to store additional information about the breakpoint.
Anna Bridge 180:96ed750bd169 971 */
Anna Bridge 180:96ed750bd169 972 #define __BKPT(value) __ASM volatile ("bkpt "#value)
Anna Bridge 180:96ed750bd169 973
Anna Bridge 180:96ed750bd169 974
Anna Bridge 180:96ed750bd169 975 /**
Anna Bridge 180:96ed750bd169 976 \brief Reverse bit order of value
Anna Bridge 180:96ed750bd169 977 \details Reverses the bit order of the given value.
Anna Bridge 180:96ed750bd169 978 \param [in] value Value to reverse
Anna Bridge 180:96ed750bd169 979 \return Reversed value
Anna Bridge 180:96ed750bd169 980 */
Anna Bridge 186:707f6e361f3e 981 __STATIC_FORCEINLINE uint32_t __RBIT(uint32_t value)
Anna Bridge 180:96ed750bd169 982 {
Anna Bridge 180:96ed750bd169 983 uint32_t result;
Anna Bridge 180:96ed750bd169 984
Anna Bridge 180:96ed750bd169 985 #if ((defined (__ARM_ARCH_7M__ ) && (__ARM_ARCH_7M__ == 1)) || \
Anna Bridge 180:96ed750bd169 986 (defined (__ARM_ARCH_7EM__ ) && (__ARM_ARCH_7EM__ == 1)) || \
Anna Bridge 180:96ed750bd169 987 (defined (__ARM_ARCH_8M_MAIN__ ) && (__ARM_ARCH_8M_MAIN__ == 1)) )
Anna Bridge 180:96ed750bd169 988 __ASM volatile ("rbit %0, %1" : "=r" (result) : "r" (value) );
Anna Bridge 180:96ed750bd169 989 #else
Anna Bridge 180:96ed750bd169 990 uint32_t s = (4U /*sizeof(v)*/ * 8U) - 1U; /* extra shift needed at end */
Anna Bridge 180:96ed750bd169 991
Anna Bridge 180:96ed750bd169 992 result = value; /* r will be reversed bits of v; first get LSB of v */
Anna Bridge 180:96ed750bd169 993 for (value >>= 1U; value != 0U; value >>= 1U)
Anna Bridge 180:96ed750bd169 994 {
Anna Bridge 180:96ed750bd169 995 result <<= 1U;
Anna Bridge 180:96ed750bd169 996 result |= value & 1U;
Anna Bridge 180:96ed750bd169 997 s--;
Anna Bridge 180:96ed750bd169 998 }
Anna Bridge 180:96ed750bd169 999 result <<= s; /* shift when v's highest bits are zero */
Anna Bridge 180:96ed750bd169 1000 #endif
Anna Bridge 180:96ed750bd169 1001 return result;
Anna Bridge 180:96ed750bd169 1002 }
Anna Bridge 180:96ed750bd169 1003
Anna Bridge 180:96ed750bd169 1004
Anna Bridge 180:96ed750bd169 1005 /**
Anna Bridge 180:96ed750bd169 1006 \brief Count leading zeros
Anna Bridge 180:96ed750bd169 1007 \details Counts the number of leading zeros of a data value.
Anna Bridge 180:96ed750bd169 1008 \param [in] value Value to count the leading zeros
Anna Bridge 180:96ed750bd169 1009 \return number of leading zeros in value
Anna Bridge 180:96ed750bd169 1010 */
Anna Bridge 186:707f6e361f3e 1011 #define __CLZ (uint8_t)__builtin_clz
Anna Bridge 180:96ed750bd169 1012
Anna Bridge 180:96ed750bd169 1013
Anna Bridge 180:96ed750bd169 1014 #if ((defined (__ARM_ARCH_7M__ ) && (__ARM_ARCH_7M__ == 1)) || \
Anna Bridge 180:96ed750bd169 1015 (defined (__ARM_ARCH_7EM__ ) && (__ARM_ARCH_7EM__ == 1)) || \
Anna Bridge 180:96ed750bd169 1016 (defined (__ARM_ARCH_8M_MAIN__ ) && (__ARM_ARCH_8M_MAIN__ == 1)) || \
Anna Bridge 180:96ed750bd169 1017 (defined (__ARM_ARCH_8M_BASE__ ) && (__ARM_ARCH_8M_BASE__ == 1)) )
Anna Bridge 180:96ed750bd169 1018 /**
Anna Bridge 180:96ed750bd169 1019 \brief LDR Exclusive (8 bit)
Anna Bridge 180:96ed750bd169 1020 \details Executes a exclusive LDR instruction for 8 bit value.
Anna Bridge 180:96ed750bd169 1021 \param [in] ptr Pointer to data
Anna Bridge 180:96ed750bd169 1022 \return value of type uint8_t at (*ptr)
Anna Bridge 180:96ed750bd169 1023 */
Anna Bridge 186:707f6e361f3e 1024 __STATIC_FORCEINLINE uint8_t __LDREXB(volatile uint8_t *addr)
Anna Bridge 180:96ed750bd169 1025 {
Anna Bridge 180:96ed750bd169 1026 uint32_t result;
Anna Bridge 180:96ed750bd169 1027
Anna Bridge 180:96ed750bd169 1028 #if (__GNUC__ > 4) || (__GNUC__ == 4 && __GNUC_MINOR__ >= 8)
Anna Bridge 180:96ed750bd169 1029 __ASM volatile ("ldrexb %0, %1" : "=r" (result) : "Q" (*addr) );
Anna Bridge 180:96ed750bd169 1030 #else
Anna Bridge 180:96ed750bd169 1031 /* Prior to GCC 4.8, "Q" will be expanded to [rx, #0] which is not
Anna Bridge 180:96ed750bd169 1032 accepted by assembler. So has to use following less efficient pattern.
Anna Bridge 180:96ed750bd169 1033 */
Anna Bridge 180:96ed750bd169 1034 __ASM volatile ("ldrexb %0, [%1]" : "=r" (result) : "r" (addr) : "memory" );
Anna Bridge 180:96ed750bd169 1035 #endif
Anna Bridge 180:96ed750bd169 1036 return ((uint8_t) result); /* Add explicit type cast here */
Anna Bridge 180:96ed750bd169 1037 }
Anna Bridge 180:96ed750bd169 1038
Anna Bridge 180:96ed750bd169 1039
Anna Bridge 180:96ed750bd169 1040 /**
Anna Bridge 180:96ed750bd169 1041 \brief LDR Exclusive (16 bit)
Anna Bridge 180:96ed750bd169 1042 \details Executes a exclusive LDR instruction for 16 bit values.
Anna Bridge 180:96ed750bd169 1043 \param [in] ptr Pointer to data
Anna Bridge 180:96ed750bd169 1044 \return value of type uint16_t at (*ptr)
Anna Bridge 180:96ed750bd169 1045 */
Anna Bridge 186:707f6e361f3e 1046 __STATIC_FORCEINLINE uint16_t __LDREXH(volatile uint16_t *addr)
Anna Bridge 180:96ed750bd169 1047 {
Anna Bridge 180:96ed750bd169 1048 uint32_t result;
Anna Bridge 180:96ed750bd169 1049
Anna Bridge 180:96ed750bd169 1050 #if (__GNUC__ > 4) || (__GNUC__ == 4 && __GNUC_MINOR__ >= 8)
Anna Bridge 180:96ed750bd169 1051 __ASM volatile ("ldrexh %0, %1" : "=r" (result) : "Q" (*addr) );
Anna Bridge 180:96ed750bd169 1052 #else
Anna Bridge 180:96ed750bd169 1053 /* Prior to GCC 4.8, "Q" will be expanded to [rx, #0] which is not
Anna Bridge 180:96ed750bd169 1054 accepted by assembler. So has to use following less efficient pattern.
Anna Bridge 180:96ed750bd169 1055 */
Anna Bridge 180:96ed750bd169 1056 __ASM volatile ("ldrexh %0, [%1]" : "=r" (result) : "r" (addr) : "memory" );
Anna Bridge 180:96ed750bd169 1057 #endif
Anna Bridge 180:96ed750bd169 1058 return ((uint16_t) result); /* Add explicit type cast here */
Anna Bridge 180:96ed750bd169 1059 }
Anna Bridge 180:96ed750bd169 1060
Anna Bridge 180:96ed750bd169 1061
Anna Bridge 180:96ed750bd169 1062 /**
Anna Bridge 180:96ed750bd169 1063 \brief LDR Exclusive (32 bit)
Anna Bridge 180:96ed750bd169 1064 \details Executes a exclusive LDR instruction for 32 bit values.
Anna Bridge 180:96ed750bd169 1065 \param [in] ptr Pointer to data
Anna Bridge 180:96ed750bd169 1066 \return value of type uint32_t at (*ptr)
Anna Bridge 180:96ed750bd169 1067 */
Anna Bridge 186:707f6e361f3e 1068 __STATIC_FORCEINLINE uint32_t __LDREXW(volatile uint32_t *addr)
Anna Bridge 180:96ed750bd169 1069 {
Anna Bridge 180:96ed750bd169 1070 uint32_t result;
Anna Bridge 180:96ed750bd169 1071
Anna Bridge 180:96ed750bd169 1072 __ASM volatile ("ldrex %0, %1" : "=r" (result) : "Q" (*addr) );
Anna Bridge 180:96ed750bd169 1073 return(result);
Anna Bridge 180:96ed750bd169 1074 }
Anna Bridge 180:96ed750bd169 1075
Anna Bridge 180:96ed750bd169 1076
Anna Bridge 180:96ed750bd169 1077 /**
Anna Bridge 180:96ed750bd169 1078 \brief STR Exclusive (8 bit)
Anna Bridge 180:96ed750bd169 1079 \details Executes a exclusive STR instruction for 8 bit values.
Anna Bridge 180:96ed750bd169 1080 \param [in] value Value to store
Anna Bridge 180:96ed750bd169 1081 \param [in] ptr Pointer to location
Anna Bridge 180:96ed750bd169 1082 \return 0 Function succeeded
Anna Bridge 180:96ed750bd169 1083 \return 1 Function failed
Anna Bridge 180:96ed750bd169 1084 */
Anna Bridge 186:707f6e361f3e 1085 __STATIC_FORCEINLINE uint32_t __STREXB(uint8_t value, volatile uint8_t *addr)
Anna Bridge 180:96ed750bd169 1086 {
Anna Bridge 180:96ed750bd169 1087 uint32_t result;
Anna Bridge 180:96ed750bd169 1088
Anna Bridge 180:96ed750bd169 1089 __ASM volatile ("strexb %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" ((uint32_t)value) );
Anna Bridge 180:96ed750bd169 1090 return(result);
Anna Bridge 180:96ed750bd169 1091 }
Anna Bridge 180:96ed750bd169 1092
Anna Bridge 180:96ed750bd169 1093
Anna Bridge 180:96ed750bd169 1094 /**
Anna Bridge 180:96ed750bd169 1095 \brief STR Exclusive (16 bit)
Anna Bridge 180:96ed750bd169 1096 \details Executes a exclusive STR instruction for 16 bit values.
Anna Bridge 180:96ed750bd169 1097 \param [in] value Value to store
Anna Bridge 180:96ed750bd169 1098 \param [in] ptr Pointer to location
Anna Bridge 180:96ed750bd169 1099 \return 0 Function succeeded
Anna Bridge 180:96ed750bd169 1100 \return 1 Function failed
Anna Bridge 180:96ed750bd169 1101 */
Anna Bridge 186:707f6e361f3e 1102 __STATIC_FORCEINLINE uint32_t __STREXH(uint16_t value, volatile uint16_t *addr)
Anna Bridge 180:96ed750bd169 1103 {
Anna Bridge 180:96ed750bd169 1104 uint32_t result;
Anna Bridge 180:96ed750bd169 1105
Anna Bridge 180:96ed750bd169 1106 __ASM volatile ("strexh %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" ((uint32_t)value) );
Anna Bridge 180:96ed750bd169 1107 return(result);
Anna Bridge 180:96ed750bd169 1108 }
Anna Bridge 180:96ed750bd169 1109
Anna Bridge 180:96ed750bd169 1110
Anna Bridge 180:96ed750bd169 1111 /**
Anna Bridge 180:96ed750bd169 1112 \brief STR Exclusive (32 bit)
Anna Bridge 180:96ed750bd169 1113 \details Executes a exclusive STR instruction for 32 bit values.
Anna Bridge 180:96ed750bd169 1114 \param [in] value Value to store
Anna Bridge 180:96ed750bd169 1115 \param [in] ptr Pointer to location
Anna Bridge 180:96ed750bd169 1116 \return 0 Function succeeded
Anna Bridge 180:96ed750bd169 1117 \return 1 Function failed
Anna Bridge 180:96ed750bd169 1118 */
Anna Bridge 186:707f6e361f3e 1119 __STATIC_FORCEINLINE uint32_t __STREXW(uint32_t value, volatile uint32_t *addr)
Anna Bridge 180:96ed750bd169 1120 {
Anna Bridge 180:96ed750bd169 1121 uint32_t result;
Anna Bridge 180:96ed750bd169 1122
Anna Bridge 180:96ed750bd169 1123 __ASM volatile ("strex %0, %2, %1" : "=&r" (result), "=Q" (*addr) : "r" (value) );
Anna Bridge 180:96ed750bd169 1124 return(result);
Anna Bridge 180:96ed750bd169 1125 }
Anna Bridge 180:96ed750bd169 1126
Anna Bridge 180:96ed750bd169 1127
Anna Bridge 180:96ed750bd169 1128 /**
Anna Bridge 180:96ed750bd169 1129 \brief Remove the exclusive lock
Anna Bridge 180:96ed750bd169 1130 \details Removes the exclusive lock which is created by LDREX.
Anna Bridge 180:96ed750bd169 1131 */
Anna Bridge 186:707f6e361f3e 1132 __STATIC_FORCEINLINE void __CLREX(void)
Anna Bridge 180:96ed750bd169 1133 {
Anna Bridge 180:96ed750bd169 1134 __ASM volatile ("clrex" ::: "memory");
Anna Bridge 180:96ed750bd169 1135 }
Anna Bridge 180:96ed750bd169 1136
Anna Bridge 180:96ed750bd169 1137 #endif /* ((defined (__ARM_ARCH_7M__ ) && (__ARM_ARCH_7M__ == 1)) || \
Anna Bridge 180:96ed750bd169 1138 (defined (__ARM_ARCH_7EM__ ) && (__ARM_ARCH_7EM__ == 1)) || \
Anna Bridge 180:96ed750bd169 1139 (defined (__ARM_ARCH_8M_MAIN__ ) && (__ARM_ARCH_8M_MAIN__ == 1)) || \
Anna Bridge 180:96ed750bd169 1140 (defined (__ARM_ARCH_8M_BASE__ ) && (__ARM_ARCH_8M_BASE__ == 1)) ) */
Anna Bridge 180:96ed750bd169 1141
Anna Bridge 180:96ed750bd169 1142
Anna Bridge 180:96ed750bd169 1143 #if ((defined (__ARM_ARCH_7M__ ) && (__ARM_ARCH_7M__ == 1)) || \
Anna Bridge 180:96ed750bd169 1144 (defined (__ARM_ARCH_7EM__ ) && (__ARM_ARCH_7EM__ == 1)) || \
Anna Bridge 180:96ed750bd169 1145 (defined (__ARM_ARCH_8M_MAIN__ ) && (__ARM_ARCH_8M_MAIN__ == 1)) )
Anna Bridge 180:96ed750bd169 1146 /**
Anna Bridge 180:96ed750bd169 1147 \brief Signed Saturate
Anna Bridge 180:96ed750bd169 1148 \details Saturates a signed value.
Anna Bridge 180:96ed750bd169 1149 \param [in] ARG1 Value to be saturated
Anna Bridge 180:96ed750bd169 1150 \param [in] ARG2 Bit position to saturate to (1..32)
Anna Bridge 180:96ed750bd169 1151 \return Saturated value
Anna Bridge 180:96ed750bd169 1152 */
Anna Bridge 180:96ed750bd169 1153 #define __SSAT(ARG1,ARG2) \
Anna Bridge 180:96ed750bd169 1154 __extension__ \
Anna Bridge 180:96ed750bd169 1155 ({ \
Anna Bridge 180:96ed750bd169 1156 int32_t __RES, __ARG1 = (ARG1); \
Anna Bridge 180:96ed750bd169 1157 __ASM ("ssat %0, %1, %2" : "=r" (__RES) : "I" (ARG2), "r" (__ARG1) ); \
Anna Bridge 180:96ed750bd169 1158 __RES; \
Anna Bridge 180:96ed750bd169 1159 })
Anna Bridge 180:96ed750bd169 1160
Anna Bridge 180:96ed750bd169 1161
Anna Bridge 180:96ed750bd169 1162 /**
Anna Bridge 180:96ed750bd169 1163 \brief Unsigned Saturate
Anna Bridge 180:96ed750bd169 1164 \details Saturates an unsigned value.
Anna Bridge 180:96ed750bd169 1165 \param [in] ARG1 Value to be saturated
Anna Bridge 180:96ed750bd169 1166 \param [in] ARG2 Bit position to saturate to (0..31)
Anna Bridge 180:96ed750bd169 1167 \return Saturated value
Anna Bridge 180:96ed750bd169 1168 */
Anna Bridge 180:96ed750bd169 1169 #define __USAT(ARG1,ARG2) \
Anna Bridge 180:96ed750bd169 1170 __extension__ \
Anna Bridge 180:96ed750bd169 1171 ({ \
Anna Bridge 180:96ed750bd169 1172 uint32_t __RES, __ARG1 = (ARG1); \
Anna Bridge 180:96ed750bd169 1173 __ASM ("usat %0, %1, %2" : "=r" (__RES) : "I" (ARG2), "r" (__ARG1) ); \
Anna Bridge 180:96ed750bd169 1174 __RES; \
Anna Bridge 180:96ed750bd169 1175 })
Anna Bridge 180:96ed750bd169 1176
Anna Bridge 180:96ed750bd169 1177
Anna Bridge 180:96ed750bd169 1178 /**
Anna Bridge 180:96ed750bd169 1179 \brief Rotate Right with Extend (32 bit)
Anna Bridge 180:96ed750bd169 1180 \details Moves each bit of a bitstring right by one bit.
Anna Bridge 180:96ed750bd169 1181 The carry input is shifted in at the left end of the bitstring.
Anna Bridge 180:96ed750bd169 1182 \param [in] value Value to rotate
Anna Bridge 180:96ed750bd169 1183 \return Rotated value
Anna Bridge 180:96ed750bd169 1184 */
Anna Bridge 186:707f6e361f3e 1185 __STATIC_FORCEINLINE uint32_t __RRX(uint32_t value)
Anna Bridge 180:96ed750bd169 1186 {
Anna Bridge 180:96ed750bd169 1187 uint32_t result;
Anna Bridge 180:96ed750bd169 1188
Anna Bridge 180:96ed750bd169 1189 __ASM volatile ("rrx %0, %1" : __CMSIS_GCC_OUT_REG (result) : __CMSIS_GCC_USE_REG (value) );
Anna Bridge 180:96ed750bd169 1190 return(result);
Anna Bridge 180:96ed750bd169 1191 }
Anna Bridge 180:96ed750bd169 1192
Anna Bridge 180:96ed750bd169 1193
Anna Bridge 180:96ed750bd169 1194 /**
Anna Bridge 180:96ed750bd169 1195 \brief LDRT Unprivileged (8 bit)
Anna Bridge 180:96ed750bd169 1196 \details Executes a Unprivileged LDRT instruction for 8 bit value.
Anna Bridge 180:96ed750bd169 1197 \param [in] ptr Pointer to data
Anna Bridge 180:96ed750bd169 1198 \return value of type uint8_t at (*ptr)
Anna Bridge 180:96ed750bd169 1199 */
Anna Bridge 186:707f6e361f3e 1200 __STATIC_FORCEINLINE uint8_t __LDRBT(volatile uint8_t *ptr)
Anna Bridge 180:96ed750bd169 1201 {
Anna Bridge 180:96ed750bd169 1202 uint32_t result;
Anna Bridge 180:96ed750bd169 1203
Anna Bridge 180:96ed750bd169 1204 #if (__GNUC__ > 4) || (__GNUC__ == 4 && __GNUC_MINOR__ >= 8)
Anna Bridge 180:96ed750bd169 1205 __ASM volatile ("ldrbt %0, %1" : "=r" (result) : "Q" (*ptr) );
Anna Bridge 180:96ed750bd169 1206 #else
Anna Bridge 180:96ed750bd169 1207 /* Prior to GCC 4.8, "Q" will be expanded to [rx, #0] which is not
Anna Bridge 180:96ed750bd169 1208 accepted by assembler. So has to use following less efficient pattern.
Anna Bridge 180:96ed750bd169 1209 */
Anna Bridge 180:96ed750bd169 1210 __ASM volatile ("ldrbt %0, [%1]" : "=r" (result) : "r" (ptr) : "memory" );
Anna Bridge 180:96ed750bd169 1211 #endif
Anna Bridge 180:96ed750bd169 1212 return ((uint8_t) result); /* Add explicit type cast here */
Anna Bridge 180:96ed750bd169 1213 }
Anna Bridge 180:96ed750bd169 1214
Anna Bridge 180:96ed750bd169 1215
Anna Bridge 180:96ed750bd169 1216 /**
Anna Bridge 180:96ed750bd169 1217 \brief LDRT Unprivileged (16 bit)
Anna Bridge 180:96ed750bd169 1218 \details Executes a Unprivileged LDRT instruction for 16 bit values.
Anna Bridge 180:96ed750bd169 1219 \param [in] ptr Pointer to data
Anna Bridge 180:96ed750bd169 1220 \return value of type uint16_t at (*ptr)
Anna Bridge 180:96ed750bd169 1221 */
Anna Bridge 186:707f6e361f3e 1222 __STATIC_FORCEINLINE uint16_t __LDRHT(volatile uint16_t *ptr)
Anna Bridge 180:96ed750bd169 1223 {
Anna Bridge 180:96ed750bd169 1224 uint32_t result;
Anna Bridge 180:96ed750bd169 1225
Anna Bridge 180:96ed750bd169 1226 #if (__GNUC__ > 4) || (__GNUC__ == 4 && __GNUC_MINOR__ >= 8)
Anna Bridge 180:96ed750bd169 1227 __ASM volatile ("ldrht %0, %1" : "=r" (result) : "Q" (*ptr) );
Anna Bridge 180:96ed750bd169 1228 #else
Anna Bridge 180:96ed750bd169 1229 /* Prior to GCC 4.8, "Q" will be expanded to [rx, #0] which is not
Anna Bridge 180:96ed750bd169 1230 accepted by assembler. So has to use following less efficient pattern.
Anna Bridge 180:96ed750bd169 1231 */
Anna Bridge 180:96ed750bd169 1232 __ASM volatile ("ldrht %0, [%1]" : "=r" (result) : "r" (ptr) : "memory" );
Anna Bridge 180:96ed750bd169 1233 #endif
Anna Bridge 180:96ed750bd169 1234 return ((uint16_t) result); /* Add explicit type cast here */
Anna Bridge 180:96ed750bd169 1235 }
Anna Bridge 180:96ed750bd169 1236
Anna Bridge 180:96ed750bd169 1237
Anna Bridge 180:96ed750bd169 1238 /**
Anna Bridge 180:96ed750bd169 1239 \brief LDRT Unprivileged (32 bit)
Anna Bridge 180:96ed750bd169 1240 \details Executes a Unprivileged LDRT instruction for 32 bit values.
Anna Bridge 180:96ed750bd169 1241 \param [in] ptr Pointer to data
Anna Bridge 180:96ed750bd169 1242 \return value of type uint32_t at (*ptr)
Anna Bridge 180:96ed750bd169 1243 */
Anna Bridge 186:707f6e361f3e 1244 __STATIC_FORCEINLINE uint32_t __LDRT(volatile uint32_t *ptr)
Anna Bridge 180:96ed750bd169 1245 {
Anna Bridge 180:96ed750bd169 1246 uint32_t result;
Anna Bridge 180:96ed750bd169 1247
Anna Bridge 180:96ed750bd169 1248 __ASM volatile ("ldrt %0, %1" : "=r" (result) : "Q" (*ptr) );
Anna Bridge 180:96ed750bd169 1249 return(result);
Anna Bridge 180:96ed750bd169 1250 }
Anna Bridge 180:96ed750bd169 1251
Anna Bridge 180:96ed750bd169 1252
Anna Bridge 180:96ed750bd169 1253 /**
Anna Bridge 180:96ed750bd169 1254 \brief STRT Unprivileged (8 bit)
Anna Bridge 180:96ed750bd169 1255 \details Executes a Unprivileged STRT instruction for 8 bit values.
Anna Bridge 180:96ed750bd169 1256 \param [in] value Value to store
Anna Bridge 180:96ed750bd169 1257 \param [in] ptr Pointer to location
Anna Bridge 180:96ed750bd169 1258 */
Anna Bridge 186:707f6e361f3e 1259 __STATIC_FORCEINLINE void __STRBT(uint8_t value, volatile uint8_t *ptr)
Anna Bridge 180:96ed750bd169 1260 {
Anna Bridge 180:96ed750bd169 1261 __ASM volatile ("strbt %1, %0" : "=Q" (*ptr) : "r" ((uint32_t)value) );
Anna Bridge 180:96ed750bd169 1262 }
Anna Bridge 180:96ed750bd169 1263
Anna Bridge 180:96ed750bd169 1264
Anna Bridge 180:96ed750bd169 1265 /**
Anna Bridge 180:96ed750bd169 1266 \brief STRT Unprivileged (16 bit)
Anna Bridge 180:96ed750bd169 1267 \details Executes a Unprivileged STRT instruction for 16 bit values.
Anna Bridge 180:96ed750bd169 1268 \param [in] value Value to store
Anna Bridge 180:96ed750bd169 1269 \param [in] ptr Pointer to location
Anna Bridge 180:96ed750bd169 1270 */
Anna Bridge 186:707f6e361f3e 1271 __STATIC_FORCEINLINE void __STRHT(uint16_t value, volatile uint16_t *ptr)
Anna Bridge 180:96ed750bd169 1272 {
Anna Bridge 180:96ed750bd169 1273 __ASM volatile ("strht %1, %0" : "=Q" (*ptr) : "r" ((uint32_t)value) );
Anna Bridge 180:96ed750bd169 1274 }
Anna Bridge 180:96ed750bd169 1275
Anna Bridge 180:96ed750bd169 1276
Anna Bridge 180:96ed750bd169 1277 /**
Anna Bridge 180:96ed750bd169 1278 \brief STRT Unprivileged (32 bit)
Anna Bridge 180:96ed750bd169 1279 \details Executes a Unprivileged STRT instruction for 32 bit values.
Anna Bridge 180:96ed750bd169 1280 \param [in] value Value to store
Anna Bridge 180:96ed750bd169 1281 \param [in] ptr Pointer to location
Anna Bridge 180:96ed750bd169 1282 */
Anna Bridge 186:707f6e361f3e 1283 __STATIC_FORCEINLINE void __STRT(uint32_t value, volatile uint32_t *ptr)
Anna Bridge 180:96ed750bd169 1284 {
Anna Bridge 180:96ed750bd169 1285 __ASM volatile ("strt %1, %0" : "=Q" (*ptr) : "r" (value) );
Anna Bridge 180:96ed750bd169 1286 }
Anna Bridge 180:96ed750bd169 1287
Anna Bridge 180:96ed750bd169 1288 #else /* ((defined (__ARM_ARCH_7M__ ) && (__ARM_ARCH_7M__ == 1)) || \
Anna Bridge 180:96ed750bd169 1289 (defined (__ARM_ARCH_7EM__ ) && (__ARM_ARCH_7EM__ == 1)) || \
Anna Bridge 180:96ed750bd169 1290 (defined (__ARM_ARCH_8M_MAIN__ ) && (__ARM_ARCH_8M_MAIN__ == 1)) ) */
Anna Bridge 180:96ed750bd169 1291
Anna Bridge 180:96ed750bd169 1292 /**
Anna Bridge 180:96ed750bd169 1293 \brief Signed Saturate
Anna Bridge 180:96ed750bd169 1294 \details Saturates a signed value.
Anna Bridge 180:96ed750bd169 1295 \param [in] value Value to be saturated
Anna Bridge 180:96ed750bd169 1296 \param [in] sat Bit position to saturate to (1..32)
Anna Bridge 180:96ed750bd169 1297 \return Saturated value
Anna Bridge 180:96ed750bd169 1298 */
Anna Bridge 186:707f6e361f3e 1299 __STATIC_FORCEINLINE int32_t __SSAT(int32_t val, uint32_t sat)
Anna Bridge 180:96ed750bd169 1300 {
Anna Bridge 186:707f6e361f3e 1301 if ((sat >= 1U) && (sat <= 32U))
Anna Bridge 186:707f6e361f3e 1302 {
Anna Bridge 180:96ed750bd169 1303 const int32_t max = (int32_t)((1U << (sat - 1U)) - 1U);
Anna Bridge 180:96ed750bd169 1304 const int32_t min = -1 - max ;
Anna Bridge 186:707f6e361f3e 1305 if (val > max)
Anna Bridge 186:707f6e361f3e 1306 {
Anna Bridge 180:96ed750bd169 1307 return max;
Anna Bridge 186:707f6e361f3e 1308 }
Anna Bridge 186:707f6e361f3e 1309 else if (val < min)
Anna Bridge 186:707f6e361f3e 1310 {
Anna Bridge 180:96ed750bd169 1311 return min;
Anna Bridge 180:96ed750bd169 1312 }
Anna Bridge 180:96ed750bd169 1313 }
Anna Bridge 180:96ed750bd169 1314 return val;
Anna Bridge 180:96ed750bd169 1315 }
Anna Bridge 180:96ed750bd169 1316
Anna Bridge 180:96ed750bd169 1317 /**
Anna Bridge 180:96ed750bd169 1318 \brief Unsigned Saturate
Anna Bridge 180:96ed750bd169 1319 \details Saturates an unsigned value.
Anna Bridge 180:96ed750bd169 1320 \param [in] value Value to be saturated
Anna Bridge 180:96ed750bd169 1321 \param [in] sat Bit position to saturate to (0..31)
Anna Bridge 180:96ed750bd169 1322 \return Saturated value
Anna Bridge 180:96ed750bd169 1323 */
Anna Bridge 186:707f6e361f3e 1324 __STATIC_FORCEINLINE uint32_t __USAT(int32_t val, uint32_t sat)
Anna Bridge 180:96ed750bd169 1325 {
Anna Bridge 186:707f6e361f3e 1326 if (sat <= 31U)
Anna Bridge 186:707f6e361f3e 1327 {
Anna Bridge 180:96ed750bd169 1328 const uint32_t max = ((1U << sat) - 1U);
Anna Bridge 186:707f6e361f3e 1329 if (val > (int32_t)max)
Anna Bridge 186:707f6e361f3e 1330 {
Anna Bridge 180:96ed750bd169 1331 return max;
Anna Bridge 186:707f6e361f3e 1332 }
Anna Bridge 186:707f6e361f3e 1333 else if (val < 0)
Anna Bridge 186:707f6e361f3e 1334 {
Anna Bridge 180:96ed750bd169 1335 return 0U;
Anna Bridge 180:96ed750bd169 1336 }
Anna Bridge 180:96ed750bd169 1337 }
Anna Bridge 180:96ed750bd169 1338 return (uint32_t)val;
Anna Bridge 180:96ed750bd169 1339 }
Anna Bridge 180:96ed750bd169 1340
Anna Bridge 180:96ed750bd169 1341 #endif /* ((defined (__ARM_ARCH_7M__ ) && (__ARM_ARCH_7M__ == 1)) || \
Anna Bridge 180:96ed750bd169 1342 (defined (__ARM_ARCH_7EM__ ) && (__ARM_ARCH_7EM__ == 1)) || \
Anna Bridge 180:96ed750bd169 1343 (defined (__ARM_ARCH_8M_MAIN__ ) && (__ARM_ARCH_8M_MAIN__ == 1)) ) */
Anna Bridge 180:96ed750bd169 1344
Anna Bridge 180:96ed750bd169 1345
Anna Bridge 180:96ed750bd169 1346 #if ((defined (__ARM_ARCH_8M_MAIN__ ) && (__ARM_ARCH_8M_MAIN__ == 1)) || \
Anna Bridge 180:96ed750bd169 1347 (defined (__ARM_ARCH_8M_BASE__ ) && (__ARM_ARCH_8M_BASE__ == 1)) )
Anna Bridge 180:96ed750bd169 1348 /**
Anna Bridge 180:96ed750bd169 1349 \brief Load-Acquire (8 bit)
Anna Bridge 180:96ed750bd169 1350 \details Executes a LDAB instruction for 8 bit value.
Anna Bridge 180:96ed750bd169 1351 \param [in] ptr Pointer to data
Anna Bridge 180:96ed750bd169 1352 \return value of type uint8_t at (*ptr)
Anna Bridge 180:96ed750bd169 1353 */
Anna Bridge 186:707f6e361f3e 1354 __STATIC_FORCEINLINE uint8_t __LDAB(volatile uint8_t *ptr)
Anna Bridge 180:96ed750bd169 1355 {
Anna Bridge 180:96ed750bd169 1356 uint32_t result;
Anna Bridge 180:96ed750bd169 1357
Anna Bridge 180:96ed750bd169 1358 __ASM volatile ("ldab %0, %1" : "=r" (result) : "Q" (*ptr) );
Anna Bridge 180:96ed750bd169 1359 return ((uint8_t) result);
Anna Bridge 180:96ed750bd169 1360 }
Anna Bridge 180:96ed750bd169 1361
Anna Bridge 180:96ed750bd169 1362
Anna Bridge 180:96ed750bd169 1363 /**
Anna Bridge 180:96ed750bd169 1364 \brief Load-Acquire (16 bit)
Anna Bridge 180:96ed750bd169 1365 \details Executes a LDAH instruction for 16 bit values.
Anna Bridge 180:96ed750bd169 1366 \param [in] ptr Pointer to data
Anna Bridge 180:96ed750bd169 1367 \return value of type uint16_t at (*ptr)
Anna Bridge 180:96ed750bd169 1368 */
Anna Bridge 186:707f6e361f3e 1369 __STATIC_FORCEINLINE uint16_t __LDAH(volatile uint16_t *ptr)
Anna Bridge 180:96ed750bd169 1370 {
Anna Bridge 180:96ed750bd169 1371 uint32_t result;
Anna Bridge 180:96ed750bd169 1372
Anna Bridge 180:96ed750bd169 1373 __ASM volatile ("ldah %0, %1" : "=r" (result) : "Q" (*ptr) );
Anna Bridge 180:96ed750bd169 1374 return ((uint16_t) result);
Anna Bridge 180:96ed750bd169 1375 }
Anna Bridge 180:96ed750bd169 1376
Anna Bridge 180:96ed750bd169 1377
Anna Bridge 180:96ed750bd169 1378 /**
Anna Bridge 180:96ed750bd169 1379 \brief Load-Acquire (32 bit)
Anna Bridge 180:96ed750bd169 1380 \details Executes a LDA instruction for 32 bit values.
Anna Bridge 180:96ed750bd169 1381 \param [in] ptr Pointer to data
Anna Bridge 180:96ed750bd169 1382 \return value of type uint32_t at (*ptr)
Anna Bridge 180:96ed750bd169 1383 */
Anna Bridge 186:707f6e361f3e 1384 __STATIC_FORCEINLINE uint32_t __LDA(volatile uint32_t *ptr)
Anna Bridge 180:96ed750bd169 1385 {
Anna Bridge 180:96ed750bd169 1386 uint32_t result;
Anna Bridge 180:96ed750bd169 1387
Anna Bridge 180:96ed750bd169 1388 __ASM volatile ("lda %0, %1" : "=r" (result) : "Q" (*ptr) );
Anna Bridge 180:96ed750bd169 1389 return(result);
Anna Bridge 180:96ed750bd169 1390 }
Anna Bridge 180:96ed750bd169 1391
Anna Bridge 180:96ed750bd169 1392
Anna Bridge 180:96ed750bd169 1393 /**
Anna Bridge 180:96ed750bd169 1394 \brief Store-Release (8 bit)
Anna Bridge 180:96ed750bd169 1395 \details Executes a STLB instruction for 8 bit values.
Anna Bridge 180:96ed750bd169 1396 \param [in] value Value to store
Anna Bridge 180:96ed750bd169 1397 \param [in] ptr Pointer to location
Anna Bridge 180:96ed750bd169 1398 */
Anna Bridge 186:707f6e361f3e 1399 __STATIC_FORCEINLINE void __STLB(uint8_t value, volatile uint8_t *ptr)
Anna Bridge 180:96ed750bd169 1400 {
Anna Bridge 180:96ed750bd169 1401 __ASM volatile ("stlb %1, %0" : "=Q" (*ptr) : "r" ((uint32_t)value) );
Anna Bridge 180:96ed750bd169 1402 }
Anna Bridge 180:96ed750bd169 1403
Anna Bridge 180:96ed750bd169 1404
Anna Bridge 180:96ed750bd169 1405 /**
Anna Bridge 180:96ed750bd169 1406 \brief Store-Release (16 bit)
Anna Bridge 180:96ed750bd169 1407 \details Executes a STLH instruction for 16 bit values.
Anna Bridge 180:96ed750bd169 1408 \param [in] value Value to store
Anna Bridge 180:96ed750bd169 1409 \param [in] ptr Pointer to location
Anna Bridge 180:96ed750bd169 1410 */
Anna Bridge 186:707f6e361f3e 1411 __STATIC_FORCEINLINE void __STLH(uint16_t value, volatile uint16_t *ptr)
Anna Bridge 180:96ed750bd169 1412 {
Anna Bridge 180:96ed750bd169 1413 __ASM volatile ("stlh %1, %0" : "=Q" (*ptr) : "r" ((uint32_t)value) );
Anna Bridge 180:96ed750bd169 1414 }
Anna Bridge 180:96ed750bd169 1415
Anna Bridge 180:96ed750bd169 1416
Anna Bridge 180:96ed750bd169 1417 /**
Anna Bridge 180:96ed750bd169 1418 \brief Store-Release (32 bit)
Anna Bridge 180:96ed750bd169 1419 \details Executes a STL instruction for 32 bit values.
Anna Bridge 180:96ed750bd169 1420 \param [in] value Value to store
Anna Bridge 180:96ed750bd169 1421 \param [in] ptr Pointer to location
Anna Bridge 180:96ed750bd169 1422 */
Anna Bridge 186:707f6e361f3e 1423 __STATIC_FORCEINLINE void __STL(uint32_t value, volatile uint32_t *ptr)
Anna Bridge 180:96ed750bd169 1424 {
Anna Bridge 180:96ed750bd169 1425 __ASM volatile ("stl %1, %0" : "=Q" (*ptr) : "r" ((uint32_t)value) );
Anna Bridge 180:96ed750bd169 1426 }
Anna Bridge 180:96ed750bd169 1427
Anna Bridge 180:96ed750bd169 1428
Anna Bridge 180:96ed750bd169 1429 /**
Anna Bridge 180:96ed750bd169 1430 \brief Load-Acquire Exclusive (8 bit)
Anna Bridge 180:96ed750bd169 1431 \details Executes a LDAB exclusive instruction for 8 bit value.
Anna Bridge 180:96ed750bd169 1432 \param [in] ptr Pointer to data
Anna Bridge 180:96ed750bd169 1433 \return value of type uint8_t at (*ptr)
Anna Bridge 180:96ed750bd169 1434 */
Anna Bridge 186:707f6e361f3e 1435 __STATIC_FORCEINLINE uint8_t __LDAEXB(volatile uint8_t *ptr)
Anna Bridge 180:96ed750bd169 1436 {
Anna Bridge 180:96ed750bd169 1437 uint32_t result;
Anna Bridge 180:96ed750bd169 1438
Anna Bridge 180:96ed750bd169 1439 __ASM volatile ("ldaexb %0, %1" : "=r" (result) : "Q" (*ptr) );
Anna Bridge 180:96ed750bd169 1440 return ((uint8_t) result);
Anna Bridge 180:96ed750bd169 1441 }
Anna Bridge 180:96ed750bd169 1442
Anna Bridge 180:96ed750bd169 1443
Anna Bridge 180:96ed750bd169 1444 /**
Anna Bridge 180:96ed750bd169 1445 \brief Load-Acquire Exclusive (16 bit)
Anna Bridge 180:96ed750bd169 1446 \details Executes a LDAH exclusive instruction for 16 bit values.
Anna Bridge 180:96ed750bd169 1447 \param [in] ptr Pointer to data
Anna Bridge 180:96ed750bd169 1448 \return value of type uint16_t at (*ptr)
Anna Bridge 180:96ed750bd169 1449 */
Anna Bridge 186:707f6e361f3e 1450 __STATIC_FORCEINLINE uint16_t __LDAEXH(volatile uint16_t *ptr)
Anna Bridge 180:96ed750bd169 1451 {
Anna Bridge 180:96ed750bd169 1452 uint32_t result;
Anna Bridge 180:96ed750bd169 1453
Anna Bridge 180:96ed750bd169 1454 __ASM volatile ("ldaexh %0, %1" : "=r" (result) : "Q" (*ptr) );
Anna Bridge 180:96ed750bd169 1455 return ((uint16_t) result);
Anna Bridge 180:96ed750bd169 1456 }
Anna Bridge 180:96ed750bd169 1457
Anna Bridge 180:96ed750bd169 1458
Anna Bridge 180:96ed750bd169 1459 /**
Anna Bridge 180:96ed750bd169 1460 \brief Load-Acquire Exclusive (32 bit)
Anna Bridge 180:96ed750bd169 1461 \details Executes a LDA exclusive instruction for 32 bit values.
Anna Bridge 180:96ed750bd169 1462 \param [in] ptr Pointer to data
Anna Bridge 180:96ed750bd169 1463 \return value of type uint32_t at (*ptr)
Anna Bridge 180:96ed750bd169 1464 */
Anna Bridge 186:707f6e361f3e 1465 __STATIC_FORCEINLINE uint32_t __LDAEX(volatile uint32_t *ptr)
Anna Bridge 180:96ed750bd169 1466 {
Anna Bridge 180:96ed750bd169 1467 uint32_t result;
Anna Bridge 180:96ed750bd169 1468
Anna Bridge 180:96ed750bd169 1469 __ASM volatile ("ldaex %0, %1" : "=r" (result) : "Q" (*ptr) );
Anna Bridge 180:96ed750bd169 1470 return(result);
Anna Bridge 180:96ed750bd169 1471 }
Anna Bridge 180:96ed750bd169 1472
Anna Bridge 180:96ed750bd169 1473
Anna Bridge 180:96ed750bd169 1474 /**
Anna Bridge 180:96ed750bd169 1475 \brief Store-Release Exclusive (8 bit)
Anna Bridge 180:96ed750bd169 1476 \details Executes a STLB exclusive instruction for 8 bit values.
Anna Bridge 180:96ed750bd169 1477 \param [in] value Value to store
Anna Bridge 180:96ed750bd169 1478 \param [in] ptr Pointer to location
Anna Bridge 180:96ed750bd169 1479 \return 0 Function succeeded
Anna Bridge 180:96ed750bd169 1480 \return 1 Function failed
Anna Bridge 180:96ed750bd169 1481 */
Anna Bridge 186:707f6e361f3e 1482 __STATIC_FORCEINLINE uint32_t __STLEXB(uint8_t value, volatile uint8_t *ptr)
Anna Bridge 180:96ed750bd169 1483 {
Anna Bridge 180:96ed750bd169 1484 uint32_t result;
Anna Bridge 180:96ed750bd169 1485
Anna Bridge 180:96ed750bd169 1486 __ASM volatile ("stlexb %0, %2, %1" : "=&r" (result), "=Q" (*ptr) : "r" ((uint32_t)value) );
Anna Bridge 180:96ed750bd169 1487 return(result);
Anna Bridge 180:96ed750bd169 1488 }
Anna Bridge 180:96ed750bd169 1489
Anna Bridge 180:96ed750bd169 1490
Anna Bridge 180:96ed750bd169 1491 /**
Anna Bridge 180:96ed750bd169 1492 \brief Store-Release Exclusive (16 bit)
Anna Bridge 180:96ed750bd169 1493 \details Executes a STLH exclusive instruction for 16 bit values.
Anna Bridge 180:96ed750bd169 1494 \param [in] value Value to store
Anna Bridge 180:96ed750bd169 1495 \param [in] ptr Pointer to location
Anna Bridge 180:96ed750bd169 1496 \return 0 Function succeeded
Anna Bridge 180:96ed750bd169 1497 \return 1 Function failed
Anna Bridge 180:96ed750bd169 1498 */
Anna Bridge 186:707f6e361f3e 1499 __STATIC_FORCEINLINE uint32_t __STLEXH(uint16_t value, volatile uint16_t *ptr)
Anna Bridge 180:96ed750bd169 1500 {
Anna Bridge 180:96ed750bd169 1501 uint32_t result;
Anna Bridge 180:96ed750bd169 1502
Anna Bridge 180:96ed750bd169 1503 __ASM volatile ("stlexh %0, %2, %1" : "=&r" (result), "=Q" (*ptr) : "r" ((uint32_t)value) );
Anna Bridge 180:96ed750bd169 1504 return(result);
Anna Bridge 180:96ed750bd169 1505 }
Anna Bridge 180:96ed750bd169 1506
Anna Bridge 180:96ed750bd169 1507
Anna Bridge 180:96ed750bd169 1508 /**
Anna Bridge 180:96ed750bd169 1509 \brief Store-Release Exclusive (32 bit)
Anna Bridge 180:96ed750bd169 1510 \details Executes a STL exclusive instruction for 32 bit values.
Anna Bridge 180:96ed750bd169 1511 \param [in] value Value to store
Anna Bridge 180:96ed750bd169 1512 \param [in] ptr Pointer to location
Anna Bridge 180:96ed750bd169 1513 \return 0 Function succeeded
Anna Bridge 180:96ed750bd169 1514 \return 1 Function failed
Anna Bridge 180:96ed750bd169 1515 */
Anna Bridge 186:707f6e361f3e 1516 __STATIC_FORCEINLINE uint32_t __STLEX(uint32_t value, volatile uint32_t *ptr)
Anna Bridge 180:96ed750bd169 1517 {
Anna Bridge 180:96ed750bd169 1518 uint32_t result;
Anna Bridge 180:96ed750bd169 1519
Anna Bridge 180:96ed750bd169 1520 __ASM volatile ("stlex %0, %2, %1" : "=&r" (result), "=Q" (*ptr) : "r" ((uint32_t)value) );
Anna Bridge 180:96ed750bd169 1521 return(result);
Anna Bridge 180:96ed750bd169 1522 }
Anna Bridge 180:96ed750bd169 1523
Anna Bridge 180:96ed750bd169 1524 #endif /* ((defined (__ARM_ARCH_8M_MAIN__ ) && (__ARM_ARCH_8M_MAIN__ == 1)) || \
Anna Bridge 180:96ed750bd169 1525 (defined (__ARM_ARCH_8M_BASE__ ) && (__ARM_ARCH_8M_BASE__ == 1)) ) */
Anna Bridge 180:96ed750bd169 1526
Anna Bridge 180:96ed750bd169 1527 /*@}*/ /* end of group CMSIS_Core_InstructionInterface */
Anna Bridge 180:96ed750bd169 1528
Anna Bridge 180:96ed750bd169 1529
Anna Bridge 180:96ed750bd169 1530 /* ################### Compiler specific Intrinsics ########################### */
Anna Bridge 180:96ed750bd169 1531 /** \defgroup CMSIS_SIMD_intrinsics CMSIS SIMD Intrinsics
Anna Bridge 180:96ed750bd169 1532 Access to dedicated SIMD instructions
Anna Bridge 180:96ed750bd169 1533 @{
Anna Bridge 180:96ed750bd169 1534 */
Anna Bridge 180:96ed750bd169 1535
Anna Bridge 186:707f6e361f3e 1536 #if (defined (__ARM_FEATURE_DSP) && (__ARM_FEATURE_DSP == 1))
Anna Bridge 180:96ed750bd169 1537
Anna Bridge 186:707f6e361f3e 1538 __STATIC_FORCEINLINE uint32_t __SADD8(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1539 {
Anna Bridge 180:96ed750bd169 1540 uint32_t result;
Anna Bridge 180:96ed750bd169 1541
Anna Bridge 180:96ed750bd169 1542 __ASM volatile ("sadd8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1543 return(result);
Anna Bridge 180:96ed750bd169 1544 }
Anna Bridge 180:96ed750bd169 1545
Anna Bridge 186:707f6e361f3e 1546 __STATIC_FORCEINLINE uint32_t __QADD8(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1547 {
Anna Bridge 180:96ed750bd169 1548 uint32_t result;
Anna Bridge 180:96ed750bd169 1549
Anna Bridge 180:96ed750bd169 1550 __ASM volatile ("qadd8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1551 return(result);
Anna Bridge 180:96ed750bd169 1552 }
Anna Bridge 180:96ed750bd169 1553
Anna Bridge 186:707f6e361f3e 1554 __STATIC_FORCEINLINE uint32_t __SHADD8(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1555 {
Anna Bridge 180:96ed750bd169 1556 uint32_t result;
Anna Bridge 180:96ed750bd169 1557
Anna Bridge 180:96ed750bd169 1558 __ASM volatile ("shadd8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1559 return(result);
Anna Bridge 180:96ed750bd169 1560 }
Anna Bridge 180:96ed750bd169 1561
Anna Bridge 186:707f6e361f3e 1562 __STATIC_FORCEINLINE uint32_t __UADD8(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1563 {
Anna Bridge 180:96ed750bd169 1564 uint32_t result;
Anna Bridge 180:96ed750bd169 1565
Anna Bridge 180:96ed750bd169 1566 __ASM volatile ("uadd8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1567 return(result);
Anna Bridge 180:96ed750bd169 1568 }
Anna Bridge 180:96ed750bd169 1569
Anna Bridge 186:707f6e361f3e 1570 __STATIC_FORCEINLINE uint32_t __UQADD8(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1571 {
Anna Bridge 180:96ed750bd169 1572 uint32_t result;
Anna Bridge 180:96ed750bd169 1573
Anna Bridge 180:96ed750bd169 1574 __ASM volatile ("uqadd8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1575 return(result);
Anna Bridge 180:96ed750bd169 1576 }
Anna Bridge 180:96ed750bd169 1577
Anna Bridge 186:707f6e361f3e 1578 __STATIC_FORCEINLINE uint32_t __UHADD8(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1579 {
Anna Bridge 180:96ed750bd169 1580 uint32_t result;
Anna Bridge 180:96ed750bd169 1581
Anna Bridge 180:96ed750bd169 1582 __ASM volatile ("uhadd8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1583 return(result);
Anna Bridge 180:96ed750bd169 1584 }
Anna Bridge 180:96ed750bd169 1585
Anna Bridge 180:96ed750bd169 1586
Anna Bridge 186:707f6e361f3e 1587 __STATIC_FORCEINLINE uint32_t __SSUB8(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1588 {
Anna Bridge 180:96ed750bd169 1589 uint32_t result;
Anna Bridge 180:96ed750bd169 1590
Anna Bridge 180:96ed750bd169 1591 __ASM volatile ("ssub8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1592 return(result);
Anna Bridge 180:96ed750bd169 1593 }
Anna Bridge 180:96ed750bd169 1594
Anna Bridge 186:707f6e361f3e 1595 __STATIC_FORCEINLINE uint32_t __QSUB8(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1596 {
Anna Bridge 180:96ed750bd169 1597 uint32_t result;
Anna Bridge 180:96ed750bd169 1598
Anna Bridge 180:96ed750bd169 1599 __ASM volatile ("qsub8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1600 return(result);
Anna Bridge 180:96ed750bd169 1601 }
Anna Bridge 180:96ed750bd169 1602
Anna Bridge 186:707f6e361f3e 1603 __STATIC_FORCEINLINE uint32_t __SHSUB8(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1604 {
Anna Bridge 180:96ed750bd169 1605 uint32_t result;
Anna Bridge 180:96ed750bd169 1606
Anna Bridge 180:96ed750bd169 1607 __ASM volatile ("shsub8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1608 return(result);
Anna Bridge 180:96ed750bd169 1609 }
Anna Bridge 180:96ed750bd169 1610
Anna Bridge 186:707f6e361f3e 1611 __STATIC_FORCEINLINE uint32_t __USUB8(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1612 {
Anna Bridge 180:96ed750bd169 1613 uint32_t result;
Anna Bridge 180:96ed750bd169 1614
Anna Bridge 180:96ed750bd169 1615 __ASM volatile ("usub8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1616 return(result);
Anna Bridge 180:96ed750bd169 1617 }
Anna Bridge 180:96ed750bd169 1618
Anna Bridge 186:707f6e361f3e 1619 __STATIC_FORCEINLINE uint32_t __UQSUB8(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1620 {
Anna Bridge 180:96ed750bd169 1621 uint32_t result;
Anna Bridge 180:96ed750bd169 1622
Anna Bridge 180:96ed750bd169 1623 __ASM volatile ("uqsub8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1624 return(result);
Anna Bridge 180:96ed750bd169 1625 }
Anna Bridge 180:96ed750bd169 1626
Anna Bridge 186:707f6e361f3e 1627 __STATIC_FORCEINLINE uint32_t __UHSUB8(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1628 {
Anna Bridge 180:96ed750bd169 1629 uint32_t result;
Anna Bridge 180:96ed750bd169 1630
Anna Bridge 180:96ed750bd169 1631 __ASM volatile ("uhsub8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1632 return(result);
Anna Bridge 180:96ed750bd169 1633 }
Anna Bridge 180:96ed750bd169 1634
Anna Bridge 180:96ed750bd169 1635
Anna Bridge 186:707f6e361f3e 1636 __STATIC_FORCEINLINE uint32_t __SADD16(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1637 {
Anna Bridge 180:96ed750bd169 1638 uint32_t result;
Anna Bridge 180:96ed750bd169 1639
Anna Bridge 180:96ed750bd169 1640 __ASM volatile ("sadd16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1641 return(result);
Anna Bridge 180:96ed750bd169 1642 }
Anna Bridge 180:96ed750bd169 1643
Anna Bridge 186:707f6e361f3e 1644 __STATIC_FORCEINLINE uint32_t __QADD16(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1645 {
Anna Bridge 180:96ed750bd169 1646 uint32_t result;
Anna Bridge 180:96ed750bd169 1647
Anna Bridge 180:96ed750bd169 1648 __ASM volatile ("qadd16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1649 return(result);
Anna Bridge 180:96ed750bd169 1650 }
Anna Bridge 180:96ed750bd169 1651
Anna Bridge 186:707f6e361f3e 1652 __STATIC_FORCEINLINE uint32_t __SHADD16(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1653 {
Anna Bridge 180:96ed750bd169 1654 uint32_t result;
Anna Bridge 180:96ed750bd169 1655
Anna Bridge 180:96ed750bd169 1656 __ASM volatile ("shadd16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1657 return(result);
Anna Bridge 180:96ed750bd169 1658 }
Anna Bridge 180:96ed750bd169 1659
Anna Bridge 186:707f6e361f3e 1660 __STATIC_FORCEINLINE uint32_t __UADD16(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1661 {
Anna Bridge 180:96ed750bd169 1662 uint32_t result;
Anna Bridge 180:96ed750bd169 1663
Anna Bridge 180:96ed750bd169 1664 __ASM volatile ("uadd16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1665 return(result);
Anna Bridge 180:96ed750bd169 1666 }
Anna Bridge 180:96ed750bd169 1667
Anna Bridge 186:707f6e361f3e 1668 __STATIC_FORCEINLINE uint32_t __UQADD16(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1669 {
Anna Bridge 180:96ed750bd169 1670 uint32_t result;
Anna Bridge 180:96ed750bd169 1671
Anna Bridge 180:96ed750bd169 1672 __ASM volatile ("uqadd16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1673 return(result);
Anna Bridge 180:96ed750bd169 1674 }
Anna Bridge 180:96ed750bd169 1675
Anna Bridge 186:707f6e361f3e 1676 __STATIC_FORCEINLINE uint32_t __UHADD16(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1677 {
Anna Bridge 180:96ed750bd169 1678 uint32_t result;
Anna Bridge 180:96ed750bd169 1679
Anna Bridge 180:96ed750bd169 1680 __ASM volatile ("uhadd16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1681 return(result);
Anna Bridge 180:96ed750bd169 1682 }
Anna Bridge 180:96ed750bd169 1683
Anna Bridge 186:707f6e361f3e 1684 __STATIC_FORCEINLINE uint32_t __SSUB16(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1685 {
Anna Bridge 180:96ed750bd169 1686 uint32_t result;
Anna Bridge 180:96ed750bd169 1687
Anna Bridge 180:96ed750bd169 1688 __ASM volatile ("ssub16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1689 return(result);
Anna Bridge 180:96ed750bd169 1690 }
Anna Bridge 180:96ed750bd169 1691
Anna Bridge 186:707f6e361f3e 1692 __STATIC_FORCEINLINE uint32_t __QSUB16(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1693 {
Anna Bridge 180:96ed750bd169 1694 uint32_t result;
Anna Bridge 180:96ed750bd169 1695
Anna Bridge 180:96ed750bd169 1696 __ASM volatile ("qsub16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1697 return(result);
Anna Bridge 180:96ed750bd169 1698 }
Anna Bridge 180:96ed750bd169 1699
Anna Bridge 186:707f6e361f3e 1700 __STATIC_FORCEINLINE uint32_t __SHSUB16(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1701 {
Anna Bridge 180:96ed750bd169 1702 uint32_t result;
Anna Bridge 180:96ed750bd169 1703
Anna Bridge 180:96ed750bd169 1704 __ASM volatile ("shsub16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1705 return(result);
Anna Bridge 180:96ed750bd169 1706 }
Anna Bridge 180:96ed750bd169 1707
Anna Bridge 186:707f6e361f3e 1708 __STATIC_FORCEINLINE uint32_t __USUB16(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1709 {
Anna Bridge 180:96ed750bd169 1710 uint32_t result;
Anna Bridge 180:96ed750bd169 1711
Anna Bridge 180:96ed750bd169 1712 __ASM volatile ("usub16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1713 return(result);
Anna Bridge 180:96ed750bd169 1714 }
Anna Bridge 180:96ed750bd169 1715
Anna Bridge 186:707f6e361f3e 1716 __STATIC_FORCEINLINE uint32_t __UQSUB16(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1717 {
Anna Bridge 180:96ed750bd169 1718 uint32_t result;
Anna Bridge 180:96ed750bd169 1719
Anna Bridge 180:96ed750bd169 1720 __ASM volatile ("uqsub16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1721 return(result);
Anna Bridge 180:96ed750bd169 1722 }
Anna Bridge 180:96ed750bd169 1723
Anna Bridge 186:707f6e361f3e 1724 __STATIC_FORCEINLINE uint32_t __UHSUB16(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1725 {
Anna Bridge 180:96ed750bd169 1726 uint32_t result;
Anna Bridge 180:96ed750bd169 1727
Anna Bridge 180:96ed750bd169 1728 __ASM volatile ("uhsub16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1729 return(result);
Anna Bridge 180:96ed750bd169 1730 }
Anna Bridge 180:96ed750bd169 1731
Anna Bridge 186:707f6e361f3e 1732 __STATIC_FORCEINLINE uint32_t __SASX(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1733 {
Anna Bridge 180:96ed750bd169 1734 uint32_t result;
Anna Bridge 180:96ed750bd169 1735
Anna Bridge 180:96ed750bd169 1736 __ASM volatile ("sasx %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1737 return(result);
Anna Bridge 180:96ed750bd169 1738 }
Anna Bridge 180:96ed750bd169 1739
Anna Bridge 186:707f6e361f3e 1740 __STATIC_FORCEINLINE uint32_t __QASX(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1741 {
Anna Bridge 180:96ed750bd169 1742 uint32_t result;
Anna Bridge 180:96ed750bd169 1743
Anna Bridge 180:96ed750bd169 1744 __ASM volatile ("qasx %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1745 return(result);
Anna Bridge 180:96ed750bd169 1746 }
Anna Bridge 180:96ed750bd169 1747
Anna Bridge 186:707f6e361f3e 1748 __STATIC_FORCEINLINE uint32_t __SHASX(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1749 {
Anna Bridge 180:96ed750bd169 1750 uint32_t result;
Anna Bridge 180:96ed750bd169 1751
Anna Bridge 180:96ed750bd169 1752 __ASM volatile ("shasx %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1753 return(result);
Anna Bridge 180:96ed750bd169 1754 }
Anna Bridge 180:96ed750bd169 1755
Anna Bridge 186:707f6e361f3e 1756 __STATIC_FORCEINLINE uint32_t __UASX(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1757 {
Anna Bridge 180:96ed750bd169 1758 uint32_t result;
Anna Bridge 180:96ed750bd169 1759
Anna Bridge 180:96ed750bd169 1760 __ASM volatile ("uasx %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1761 return(result);
Anna Bridge 180:96ed750bd169 1762 }
Anna Bridge 180:96ed750bd169 1763
Anna Bridge 186:707f6e361f3e 1764 __STATIC_FORCEINLINE uint32_t __UQASX(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1765 {
Anna Bridge 180:96ed750bd169 1766 uint32_t result;
Anna Bridge 180:96ed750bd169 1767
Anna Bridge 180:96ed750bd169 1768 __ASM volatile ("uqasx %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1769 return(result);
Anna Bridge 180:96ed750bd169 1770 }
Anna Bridge 180:96ed750bd169 1771
Anna Bridge 186:707f6e361f3e 1772 __STATIC_FORCEINLINE uint32_t __UHASX(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1773 {
Anna Bridge 180:96ed750bd169 1774 uint32_t result;
Anna Bridge 180:96ed750bd169 1775
Anna Bridge 180:96ed750bd169 1776 __ASM volatile ("uhasx %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1777 return(result);
Anna Bridge 180:96ed750bd169 1778 }
Anna Bridge 180:96ed750bd169 1779
Anna Bridge 186:707f6e361f3e 1780 __STATIC_FORCEINLINE uint32_t __SSAX(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1781 {
Anna Bridge 180:96ed750bd169 1782 uint32_t result;
Anna Bridge 180:96ed750bd169 1783
Anna Bridge 180:96ed750bd169 1784 __ASM volatile ("ssax %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1785 return(result);
Anna Bridge 180:96ed750bd169 1786 }
Anna Bridge 180:96ed750bd169 1787
Anna Bridge 186:707f6e361f3e 1788 __STATIC_FORCEINLINE uint32_t __QSAX(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1789 {
Anna Bridge 180:96ed750bd169 1790 uint32_t result;
Anna Bridge 180:96ed750bd169 1791
Anna Bridge 180:96ed750bd169 1792 __ASM volatile ("qsax %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1793 return(result);
Anna Bridge 180:96ed750bd169 1794 }
Anna Bridge 180:96ed750bd169 1795
Anna Bridge 186:707f6e361f3e 1796 __STATIC_FORCEINLINE uint32_t __SHSAX(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1797 {
Anna Bridge 180:96ed750bd169 1798 uint32_t result;
Anna Bridge 180:96ed750bd169 1799
Anna Bridge 180:96ed750bd169 1800 __ASM volatile ("shsax %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1801 return(result);
Anna Bridge 180:96ed750bd169 1802 }
Anna Bridge 180:96ed750bd169 1803
Anna Bridge 186:707f6e361f3e 1804 __STATIC_FORCEINLINE uint32_t __USAX(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1805 {
Anna Bridge 180:96ed750bd169 1806 uint32_t result;
Anna Bridge 180:96ed750bd169 1807
Anna Bridge 180:96ed750bd169 1808 __ASM volatile ("usax %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1809 return(result);
Anna Bridge 180:96ed750bd169 1810 }
Anna Bridge 180:96ed750bd169 1811
Anna Bridge 186:707f6e361f3e 1812 __STATIC_FORCEINLINE uint32_t __UQSAX(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1813 {
Anna Bridge 180:96ed750bd169 1814 uint32_t result;
Anna Bridge 180:96ed750bd169 1815
Anna Bridge 180:96ed750bd169 1816 __ASM volatile ("uqsax %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1817 return(result);
Anna Bridge 180:96ed750bd169 1818 }
Anna Bridge 180:96ed750bd169 1819
Anna Bridge 186:707f6e361f3e 1820 __STATIC_FORCEINLINE uint32_t __UHSAX(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1821 {
Anna Bridge 180:96ed750bd169 1822 uint32_t result;
Anna Bridge 180:96ed750bd169 1823
Anna Bridge 180:96ed750bd169 1824 __ASM volatile ("uhsax %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1825 return(result);
Anna Bridge 180:96ed750bd169 1826 }
Anna Bridge 180:96ed750bd169 1827
Anna Bridge 186:707f6e361f3e 1828 __STATIC_FORCEINLINE uint32_t __USAD8(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1829 {
Anna Bridge 180:96ed750bd169 1830 uint32_t result;
Anna Bridge 180:96ed750bd169 1831
Anna Bridge 180:96ed750bd169 1832 __ASM volatile ("usad8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1833 return(result);
Anna Bridge 180:96ed750bd169 1834 }
Anna Bridge 180:96ed750bd169 1835
Anna Bridge 186:707f6e361f3e 1836 __STATIC_FORCEINLINE uint32_t __USADA8(uint32_t op1, uint32_t op2, uint32_t op3)
Anna Bridge 180:96ed750bd169 1837 {
Anna Bridge 180:96ed750bd169 1838 uint32_t result;
Anna Bridge 180:96ed750bd169 1839
Anna Bridge 180:96ed750bd169 1840 __ASM volatile ("usada8 %0, %1, %2, %3" : "=r" (result) : "r" (op1), "r" (op2), "r" (op3) );
Anna Bridge 180:96ed750bd169 1841 return(result);
Anna Bridge 180:96ed750bd169 1842 }
Anna Bridge 180:96ed750bd169 1843
Anna Bridge 180:96ed750bd169 1844 #define __SSAT16(ARG1,ARG2) \
Anna Bridge 180:96ed750bd169 1845 ({ \
Anna Bridge 180:96ed750bd169 1846 int32_t __RES, __ARG1 = (ARG1); \
Anna Bridge 180:96ed750bd169 1847 __ASM ("ssat16 %0, %1, %2" : "=r" (__RES) : "I" (ARG2), "r" (__ARG1) ); \
Anna Bridge 180:96ed750bd169 1848 __RES; \
Anna Bridge 180:96ed750bd169 1849 })
Anna Bridge 180:96ed750bd169 1850
Anna Bridge 180:96ed750bd169 1851 #define __USAT16(ARG1,ARG2) \
Anna Bridge 180:96ed750bd169 1852 ({ \
Anna Bridge 180:96ed750bd169 1853 uint32_t __RES, __ARG1 = (ARG1); \
Anna Bridge 180:96ed750bd169 1854 __ASM ("usat16 %0, %1, %2" : "=r" (__RES) : "I" (ARG2), "r" (__ARG1) ); \
Anna Bridge 180:96ed750bd169 1855 __RES; \
Anna Bridge 180:96ed750bd169 1856 })
Anna Bridge 180:96ed750bd169 1857
Anna Bridge 186:707f6e361f3e 1858 __STATIC_FORCEINLINE uint32_t __UXTB16(uint32_t op1)
Anna Bridge 180:96ed750bd169 1859 {
Anna Bridge 180:96ed750bd169 1860 uint32_t result;
Anna Bridge 180:96ed750bd169 1861
Anna Bridge 180:96ed750bd169 1862 __ASM volatile ("uxtb16 %0, %1" : "=r" (result) : "r" (op1));
Anna Bridge 180:96ed750bd169 1863 return(result);
Anna Bridge 180:96ed750bd169 1864 }
Anna Bridge 180:96ed750bd169 1865
Anna Bridge 186:707f6e361f3e 1866 __STATIC_FORCEINLINE uint32_t __UXTAB16(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1867 {
Anna Bridge 180:96ed750bd169 1868 uint32_t result;
Anna Bridge 180:96ed750bd169 1869
Anna Bridge 180:96ed750bd169 1870 __ASM volatile ("uxtab16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1871 return(result);
Anna Bridge 180:96ed750bd169 1872 }
Anna Bridge 180:96ed750bd169 1873
Anna Bridge 186:707f6e361f3e 1874 __STATIC_FORCEINLINE uint32_t __SXTB16(uint32_t op1)
Anna Bridge 180:96ed750bd169 1875 {
Anna Bridge 180:96ed750bd169 1876 uint32_t result;
Anna Bridge 180:96ed750bd169 1877
Anna Bridge 180:96ed750bd169 1878 __ASM volatile ("sxtb16 %0, %1" : "=r" (result) : "r" (op1));
Anna Bridge 180:96ed750bd169 1879 return(result);
Anna Bridge 180:96ed750bd169 1880 }
Anna Bridge 180:96ed750bd169 1881
Anna Bridge 186:707f6e361f3e 1882 __STATIC_FORCEINLINE uint32_t __SXTAB16(uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1883 {
Anna Bridge 180:96ed750bd169 1884 uint32_t result;
Anna Bridge 180:96ed750bd169 1885
Anna Bridge 180:96ed750bd169 1886 __ASM volatile ("sxtab16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1887 return(result);
Anna Bridge 180:96ed750bd169 1888 }
Anna Bridge 180:96ed750bd169 1889
Anna Bridge 186:707f6e361f3e 1890 __STATIC_FORCEINLINE uint32_t __SMUAD (uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1891 {
Anna Bridge 180:96ed750bd169 1892 uint32_t result;
Anna Bridge 180:96ed750bd169 1893
Anna Bridge 180:96ed750bd169 1894 __ASM volatile ("smuad %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1895 return(result);
Anna Bridge 180:96ed750bd169 1896 }
Anna Bridge 180:96ed750bd169 1897
Anna Bridge 186:707f6e361f3e 1898 __STATIC_FORCEINLINE uint32_t __SMUADX (uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1899 {
Anna Bridge 180:96ed750bd169 1900 uint32_t result;
Anna Bridge 180:96ed750bd169 1901
Anna Bridge 180:96ed750bd169 1902 __ASM volatile ("smuadx %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1903 return(result);
Anna Bridge 180:96ed750bd169 1904 }
Anna Bridge 180:96ed750bd169 1905
Anna Bridge 186:707f6e361f3e 1906 __STATIC_FORCEINLINE uint32_t __SMLAD (uint32_t op1, uint32_t op2, uint32_t op3)
Anna Bridge 180:96ed750bd169 1907 {
Anna Bridge 180:96ed750bd169 1908 uint32_t result;
Anna Bridge 180:96ed750bd169 1909
Anna Bridge 180:96ed750bd169 1910 __ASM volatile ("smlad %0, %1, %2, %3" : "=r" (result) : "r" (op1), "r" (op2), "r" (op3) );
Anna Bridge 180:96ed750bd169 1911 return(result);
Anna Bridge 180:96ed750bd169 1912 }
Anna Bridge 180:96ed750bd169 1913
Anna Bridge 186:707f6e361f3e 1914 __STATIC_FORCEINLINE uint32_t __SMLADX (uint32_t op1, uint32_t op2, uint32_t op3)
Anna Bridge 180:96ed750bd169 1915 {
Anna Bridge 180:96ed750bd169 1916 uint32_t result;
Anna Bridge 180:96ed750bd169 1917
Anna Bridge 180:96ed750bd169 1918 __ASM volatile ("smladx %0, %1, %2, %3" : "=r" (result) : "r" (op1), "r" (op2), "r" (op3) );
Anna Bridge 180:96ed750bd169 1919 return(result);
Anna Bridge 180:96ed750bd169 1920 }
Anna Bridge 180:96ed750bd169 1921
Anna Bridge 186:707f6e361f3e 1922 __STATIC_FORCEINLINE uint64_t __SMLALD (uint32_t op1, uint32_t op2, uint64_t acc)
Anna Bridge 180:96ed750bd169 1923 {
Anna Bridge 180:96ed750bd169 1924 union llreg_u{
Anna Bridge 180:96ed750bd169 1925 uint32_t w32[2];
Anna Bridge 180:96ed750bd169 1926 uint64_t w64;
Anna Bridge 180:96ed750bd169 1927 } llr;
Anna Bridge 180:96ed750bd169 1928 llr.w64 = acc;
Anna Bridge 180:96ed750bd169 1929
Anna Bridge 180:96ed750bd169 1930 #ifndef __ARMEB__ /* Little endian */
Anna Bridge 180:96ed750bd169 1931 __ASM volatile ("smlald %0, %1, %2, %3" : "=r" (llr.w32[0]), "=r" (llr.w32[1]): "r" (op1), "r" (op2) , "0" (llr.w32[0]), "1" (llr.w32[1]) );
Anna Bridge 180:96ed750bd169 1932 #else /* Big endian */
Anna Bridge 180:96ed750bd169 1933 __ASM volatile ("smlald %0, %1, %2, %3" : "=r" (llr.w32[1]), "=r" (llr.w32[0]): "r" (op1), "r" (op2) , "0" (llr.w32[1]), "1" (llr.w32[0]) );
Anna Bridge 180:96ed750bd169 1934 #endif
Anna Bridge 180:96ed750bd169 1935
Anna Bridge 180:96ed750bd169 1936 return(llr.w64);
Anna Bridge 180:96ed750bd169 1937 }
Anna Bridge 180:96ed750bd169 1938
Anna Bridge 186:707f6e361f3e 1939 __STATIC_FORCEINLINE uint64_t __SMLALDX (uint32_t op1, uint32_t op2, uint64_t acc)
Anna Bridge 180:96ed750bd169 1940 {
Anna Bridge 180:96ed750bd169 1941 union llreg_u{
Anna Bridge 180:96ed750bd169 1942 uint32_t w32[2];
Anna Bridge 180:96ed750bd169 1943 uint64_t w64;
Anna Bridge 180:96ed750bd169 1944 } llr;
Anna Bridge 180:96ed750bd169 1945 llr.w64 = acc;
Anna Bridge 180:96ed750bd169 1946
Anna Bridge 180:96ed750bd169 1947 #ifndef __ARMEB__ /* Little endian */
Anna Bridge 180:96ed750bd169 1948 __ASM volatile ("smlaldx %0, %1, %2, %3" : "=r" (llr.w32[0]), "=r" (llr.w32[1]): "r" (op1), "r" (op2) , "0" (llr.w32[0]), "1" (llr.w32[1]) );
Anna Bridge 180:96ed750bd169 1949 #else /* Big endian */
Anna Bridge 180:96ed750bd169 1950 __ASM volatile ("smlaldx %0, %1, %2, %3" : "=r" (llr.w32[1]), "=r" (llr.w32[0]): "r" (op1), "r" (op2) , "0" (llr.w32[1]), "1" (llr.w32[0]) );
Anna Bridge 180:96ed750bd169 1951 #endif
Anna Bridge 180:96ed750bd169 1952
Anna Bridge 180:96ed750bd169 1953 return(llr.w64);
Anna Bridge 180:96ed750bd169 1954 }
Anna Bridge 180:96ed750bd169 1955
Anna Bridge 186:707f6e361f3e 1956 __STATIC_FORCEINLINE uint32_t __SMUSD (uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1957 {
Anna Bridge 180:96ed750bd169 1958 uint32_t result;
Anna Bridge 180:96ed750bd169 1959
Anna Bridge 180:96ed750bd169 1960 __ASM volatile ("smusd %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1961 return(result);
Anna Bridge 180:96ed750bd169 1962 }
Anna Bridge 180:96ed750bd169 1963
Anna Bridge 186:707f6e361f3e 1964 __STATIC_FORCEINLINE uint32_t __SMUSDX (uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 1965 {
Anna Bridge 180:96ed750bd169 1966 uint32_t result;
Anna Bridge 180:96ed750bd169 1967
Anna Bridge 180:96ed750bd169 1968 __ASM volatile ("smusdx %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 1969 return(result);
Anna Bridge 180:96ed750bd169 1970 }
Anna Bridge 180:96ed750bd169 1971
Anna Bridge 186:707f6e361f3e 1972 __STATIC_FORCEINLINE uint32_t __SMLSD (uint32_t op1, uint32_t op2, uint32_t op3)
Anna Bridge 180:96ed750bd169 1973 {
Anna Bridge 180:96ed750bd169 1974 uint32_t result;
Anna Bridge 180:96ed750bd169 1975
Anna Bridge 180:96ed750bd169 1976 __ASM volatile ("smlsd %0, %1, %2, %3" : "=r" (result) : "r" (op1), "r" (op2), "r" (op3) );
Anna Bridge 180:96ed750bd169 1977 return(result);
Anna Bridge 180:96ed750bd169 1978 }
Anna Bridge 180:96ed750bd169 1979
Anna Bridge 186:707f6e361f3e 1980 __STATIC_FORCEINLINE uint32_t __SMLSDX (uint32_t op1, uint32_t op2, uint32_t op3)
Anna Bridge 180:96ed750bd169 1981 {
Anna Bridge 180:96ed750bd169 1982 uint32_t result;
Anna Bridge 180:96ed750bd169 1983
Anna Bridge 180:96ed750bd169 1984 __ASM volatile ("smlsdx %0, %1, %2, %3" : "=r" (result) : "r" (op1), "r" (op2), "r" (op3) );
Anna Bridge 180:96ed750bd169 1985 return(result);
Anna Bridge 180:96ed750bd169 1986 }
Anna Bridge 180:96ed750bd169 1987
Anna Bridge 186:707f6e361f3e 1988 __STATIC_FORCEINLINE uint64_t __SMLSLD (uint32_t op1, uint32_t op2, uint64_t acc)
Anna Bridge 180:96ed750bd169 1989 {
Anna Bridge 180:96ed750bd169 1990 union llreg_u{
Anna Bridge 180:96ed750bd169 1991 uint32_t w32[2];
Anna Bridge 180:96ed750bd169 1992 uint64_t w64;
Anna Bridge 180:96ed750bd169 1993 } llr;
Anna Bridge 180:96ed750bd169 1994 llr.w64 = acc;
Anna Bridge 180:96ed750bd169 1995
Anna Bridge 180:96ed750bd169 1996 #ifndef __ARMEB__ /* Little endian */
Anna Bridge 180:96ed750bd169 1997 __ASM volatile ("smlsld %0, %1, %2, %3" : "=r" (llr.w32[0]), "=r" (llr.w32[1]): "r" (op1), "r" (op2) , "0" (llr.w32[0]), "1" (llr.w32[1]) );
Anna Bridge 180:96ed750bd169 1998 #else /* Big endian */
Anna Bridge 180:96ed750bd169 1999 __ASM volatile ("smlsld %0, %1, %2, %3" : "=r" (llr.w32[1]), "=r" (llr.w32[0]): "r" (op1), "r" (op2) , "0" (llr.w32[1]), "1" (llr.w32[0]) );
Anna Bridge 180:96ed750bd169 2000 #endif
Anna Bridge 180:96ed750bd169 2001
Anna Bridge 180:96ed750bd169 2002 return(llr.w64);
Anna Bridge 180:96ed750bd169 2003 }
Anna Bridge 180:96ed750bd169 2004
Anna Bridge 186:707f6e361f3e 2005 __STATIC_FORCEINLINE uint64_t __SMLSLDX (uint32_t op1, uint32_t op2, uint64_t acc)
Anna Bridge 180:96ed750bd169 2006 {
Anna Bridge 180:96ed750bd169 2007 union llreg_u{
Anna Bridge 180:96ed750bd169 2008 uint32_t w32[2];
Anna Bridge 180:96ed750bd169 2009 uint64_t w64;
Anna Bridge 180:96ed750bd169 2010 } llr;
Anna Bridge 180:96ed750bd169 2011 llr.w64 = acc;
Anna Bridge 180:96ed750bd169 2012
Anna Bridge 180:96ed750bd169 2013 #ifndef __ARMEB__ /* Little endian */
Anna Bridge 180:96ed750bd169 2014 __ASM volatile ("smlsldx %0, %1, %2, %3" : "=r" (llr.w32[0]), "=r" (llr.w32[1]): "r" (op1), "r" (op2) , "0" (llr.w32[0]), "1" (llr.w32[1]) );
Anna Bridge 180:96ed750bd169 2015 #else /* Big endian */
Anna Bridge 180:96ed750bd169 2016 __ASM volatile ("smlsldx %0, %1, %2, %3" : "=r" (llr.w32[1]), "=r" (llr.w32[0]): "r" (op1), "r" (op2) , "0" (llr.w32[1]), "1" (llr.w32[0]) );
Anna Bridge 180:96ed750bd169 2017 #endif
Anna Bridge 180:96ed750bd169 2018
Anna Bridge 180:96ed750bd169 2019 return(llr.w64);
Anna Bridge 180:96ed750bd169 2020 }
Anna Bridge 180:96ed750bd169 2021
Anna Bridge 186:707f6e361f3e 2022 __STATIC_FORCEINLINE uint32_t __SEL (uint32_t op1, uint32_t op2)
Anna Bridge 180:96ed750bd169 2023 {
Anna Bridge 180:96ed750bd169 2024 uint32_t result;
Anna Bridge 180:96ed750bd169 2025
Anna Bridge 180:96ed750bd169 2026 __ASM volatile ("sel %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 2027 return(result);
Anna Bridge 180:96ed750bd169 2028 }
Anna Bridge 180:96ed750bd169 2029
Anna Bridge 186:707f6e361f3e 2030 __STATIC_FORCEINLINE int32_t __QADD( int32_t op1, int32_t op2)
Anna Bridge 180:96ed750bd169 2031 {
Anna Bridge 180:96ed750bd169 2032 int32_t result;
Anna Bridge 180:96ed750bd169 2033
Anna Bridge 180:96ed750bd169 2034 __ASM volatile ("qadd %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 2035 return(result);
Anna Bridge 180:96ed750bd169 2036 }
Anna Bridge 180:96ed750bd169 2037
Anna Bridge 186:707f6e361f3e 2038 __STATIC_FORCEINLINE int32_t __QSUB( int32_t op1, int32_t op2)
Anna Bridge 180:96ed750bd169 2039 {
Anna Bridge 180:96ed750bd169 2040 int32_t result;
Anna Bridge 180:96ed750bd169 2041
Anna Bridge 180:96ed750bd169 2042 __ASM volatile ("qsub %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Anna Bridge 180:96ed750bd169 2043 return(result);
Anna Bridge 180:96ed750bd169 2044 }
Anna Bridge 180:96ed750bd169 2045
Anna Bridge 180:96ed750bd169 2046 #if 0
Anna Bridge 180:96ed750bd169 2047 #define __PKHBT(ARG1,ARG2,ARG3) \
Anna Bridge 180:96ed750bd169 2048 ({ \
Anna Bridge 180:96ed750bd169 2049 uint32_t __RES, __ARG1 = (ARG1), __ARG2 = (ARG2); \
Anna Bridge 180:96ed750bd169 2050 __ASM ("pkhbt %0, %1, %2, lsl %3" : "=r" (__RES) : "r" (__ARG1), "r" (__ARG2), "I" (ARG3) ); \
Anna Bridge 180:96ed750bd169 2051 __RES; \
Anna Bridge 180:96ed750bd169 2052 })
Anna Bridge 180:96ed750bd169 2053
Anna Bridge 180:96ed750bd169 2054 #define __PKHTB(ARG1,ARG2,ARG3) \
Anna Bridge 180:96ed750bd169 2055 ({ \
Anna Bridge 180:96ed750bd169 2056 uint32_t __RES, __ARG1 = (ARG1), __ARG2 = (ARG2); \
Anna Bridge 180:96ed750bd169 2057 if (ARG3 == 0) \
Anna Bridge 180:96ed750bd169 2058 __ASM ("pkhtb %0, %1, %2" : "=r" (__RES) : "r" (__ARG1), "r" (__ARG2) ); \
Anna Bridge 180:96ed750bd169 2059 else \
Anna Bridge 180:96ed750bd169 2060 __ASM ("pkhtb %0, %1, %2, asr %3" : "=r" (__RES) : "r" (__ARG1), "r" (__ARG2), "I" (ARG3) ); \
Anna Bridge 180:96ed750bd169 2061 __RES; \
Anna Bridge 180:96ed750bd169 2062 })
Anna Bridge 180:96ed750bd169 2063 #endif
Anna Bridge 180:96ed750bd169 2064
Anna Bridge 180:96ed750bd169 2065 #define __PKHBT(ARG1,ARG2,ARG3) ( ((((uint32_t)(ARG1)) ) & 0x0000FFFFUL) | \
Anna Bridge 180:96ed750bd169 2066 ((((uint32_t)(ARG2)) << (ARG3)) & 0xFFFF0000UL) )
Anna Bridge 180:96ed750bd169 2067
Anna Bridge 180:96ed750bd169 2068 #define __PKHTB(ARG1,ARG2,ARG3) ( ((((uint32_t)(ARG1)) ) & 0xFFFF0000UL) | \
Anna Bridge 180:96ed750bd169 2069 ((((uint32_t)(ARG2)) >> (ARG3)) & 0x0000FFFFUL) )
Anna Bridge 180:96ed750bd169 2070
Anna Bridge 186:707f6e361f3e 2071 __STATIC_FORCEINLINE int32_t __SMMLA (int32_t op1, int32_t op2, int32_t op3)
Anna Bridge 180:96ed750bd169 2072 {
Anna Bridge 180:96ed750bd169 2073 int32_t result;
Anna Bridge 180:96ed750bd169 2074
Anna Bridge 180:96ed750bd169 2075 __ASM volatile ("smmla %0, %1, %2, %3" : "=r" (result): "r" (op1), "r" (op2), "r" (op3) );
Anna Bridge 180:96ed750bd169 2076 return(result);
Anna Bridge 180:96ed750bd169 2077 }
Anna Bridge 180:96ed750bd169 2078
Anna Bridge 180:96ed750bd169 2079 #endif /* (__ARM_FEATURE_DSP == 1) */
Anna Bridge 180:96ed750bd169 2080 /*@} end of group CMSIS_SIMD_intrinsics */
Anna Bridge 180:96ed750bd169 2081
Anna Bridge 180:96ed750bd169 2082
Anna Bridge 180:96ed750bd169 2083 #pragma GCC diagnostic pop
Anna Bridge 180:96ed750bd169 2084
Anna Bridge 180:96ed750bd169 2085 #endif /* __CMSIS_GCC_H */