The official Mbed 2 C/C++ SDK provides the software platform and libraries to build your applications.

Dependents:   hello SerialTestv11 SerialTestv12 Sierpinski ... more

mbed 2

This is the mbed 2 library. If you'd like to learn about Mbed OS please see the mbed-os docs.

Committer:
Anna Bridge
Date:
Fri Jun 22 15:38:59 2018 +0100
Revision:
169:a7c7b631e539
mbed library. Release version 162

Who changed what in which revision?

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