Jasper Lee / mbed_helloworld

Dependents:   twr_helloworld

Committer:
Jasper_lee
Date:
Tue Dec 23 03:35:08 2014 +0000
Revision:
0:b16d94660a33
change some io setting used in TWR-K22F120M

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Jasper_lee 0:b16d94660a33 1 /**************************************************************************//**
Jasper_lee 0:b16d94660a33 2 * @file core_cm4_simd.h
Jasper_lee 0:b16d94660a33 3 * @brief CMSIS Cortex-M4 SIMD Header File
Jasper_lee 0:b16d94660a33 4 * @version V3.20
Jasper_lee 0:b16d94660a33 5 * @date 25. February 2013
Jasper_lee 0:b16d94660a33 6 *
Jasper_lee 0:b16d94660a33 7 * @note
Jasper_lee 0:b16d94660a33 8 *
Jasper_lee 0:b16d94660a33 9 ******************************************************************************/
Jasper_lee 0:b16d94660a33 10 /* Copyright (c) 2009 - 2013 ARM LIMITED
Jasper_lee 0:b16d94660a33 11
Jasper_lee 0:b16d94660a33 12 All rights reserved.
Jasper_lee 0:b16d94660a33 13 Redistribution and use in source and binary forms, with or without
Jasper_lee 0:b16d94660a33 14 modification, are permitted provided that the following conditions are met:
Jasper_lee 0:b16d94660a33 15 - Redistributions of source code must retain the above copyright
Jasper_lee 0:b16d94660a33 16 notice, this list of conditions and the following disclaimer.
Jasper_lee 0:b16d94660a33 17 - Redistributions in binary form must reproduce the above copyright
Jasper_lee 0:b16d94660a33 18 notice, this list of conditions and the following disclaimer in the
Jasper_lee 0:b16d94660a33 19 documentation and/or other materials provided with the distribution.
Jasper_lee 0:b16d94660a33 20 - Neither the name of ARM nor the names of its contributors may be used
Jasper_lee 0:b16d94660a33 21 to endorse or promote products derived from this software without
Jasper_lee 0:b16d94660a33 22 specific prior written permission.
Jasper_lee 0:b16d94660a33 23 *
Jasper_lee 0:b16d94660a33 24 THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
Jasper_lee 0:b16d94660a33 25 AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
Jasper_lee 0:b16d94660a33 26 IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
Jasper_lee 0:b16d94660a33 27 ARE DISCLAIMED. IN NO EVENT SHALL COPYRIGHT HOLDERS AND CONTRIBUTORS BE
Jasper_lee 0:b16d94660a33 28 LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
Jasper_lee 0:b16d94660a33 29 CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
Jasper_lee 0:b16d94660a33 30 SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
Jasper_lee 0:b16d94660a33 31 INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
Jasper_lee 0:b16d94660a33 32 CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
Jasper_lee 0:b16d94660a33 33 ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
Jasper_lee 0:b16d94660a33 34 POSSIBILITY OF SUCH DAMAGE.
Jasper_lee 0:b16d94660a33 35 ---------------------------------------------------------------------------*/
Jasper_lee 0:b16d94660a33 36
Jasper_lee 0:b16d94660a33 37
Jasper_lee 0:b16d94660a33 38 #ifdef __cplusplus
Jasper_lee 0:b16d94660a33 39 extern "C" {
Jasper_lee 0:b16d94660a33 40 #endif
Jasper_lee 0:b16d94660a33 41
Jasper_lee 0:b16d94660a33 42 #ifndef __CORE_CM4_SIMD_H
Jasper_lee 0:b16d94660a33 43 #define __CORE_CM4_SIMD_H
Jasper_lee 0:b16d94660a33 44
Jasper_lee 0:b16d94660a33 45
Jasper_lee 0:b16d94660a33 46 /*******************************************************************************
Jasper_lee 0:b16d94660a33 47 * Hardware Abstraction Layer
Jasper_lee 0:b16d94660a33 48 ******************************************************************************/
Jasper_lee 0:b16d94660a33 49
Jasper_lee 0:b16d94660a33 50
Jasper_lee 0:b16d94660a33 51 /* ################### Compiler specific Intrinsics ########################### */
Jasper_lee 0:b16d94660a33 52 /** \defgroup CMSIS_SIMD_intrinsics CMSIS SIMD Intrinsics
Jasper_lee 0:b16d94660a33 53 Access to dedicated SIMD instructions
Jasper_lee 0:b16d94660a33 54 @{
Jasper_lee 0:b16d94660a33 55 */
Jasper_lee 0:b16d94660a33 56
Jasper_lee 0:b16d94660a33 57 #if defined ( __CC_ARM ) /*------------------RealView Compiler -----------------*/
Jasper_lee 0:b16d94660a33 58 /* ARM armcc specific functions */
Jasper_lee 0:b16d94660a33 59
Jasper_lee 0:b16d94660a33 60 /*------ CM4 SIMD Intrinsics -----------------------------------------------------*/
Jasper_lee 0:b16d94660a33 61 #define __SADD8 __sadd8
Jasper_lee 0:b16d94660a33 62 #define __QADD8 __qadd8
Jasper_lee 0:b16d94660a33 63 #define __SHADD8 __shadd8
Jasper_lee 0:b16d94660a33 64 #define __UADD8 __uadd8
Jasper_lee 0:b16d94660a33 65 #define __UQADD8 __uqadd8
Jasper_lee 0:b16d94660a33 66 #define __UHADD8 __uhadd8
Jasper_lee 0:b16d94660a33 67 #define __SSUB8 __ssub8
Jasper_lee 0:b16d94660a33 68 #define __QSUB8 __qsub8
Jasper_lee 0:b16d94660a33 69 #define __SHSUB8 __shsub8
Jasper_lee 0:b16d94660a33 70 #define __USUB8 __usub8
Jasper_lee 0:b16d94660a33 71 #define __UQSUB8 __uqsub8
Jasper_lee 0:b16d94660a33 72 #define __UHSUB8 __uhsub8
Jasper_lee 0:b16d94660a33 73 #define __SADD16 __sadd16
Jasper_lee 0:b16d94660a33 74 #define __QADD16 __qadd16
Jasper_lee 0:b16d94660a33 75 #define __SHADD16 __shadd16
Jasper_lee 0:b16d94660a33 76 #define __UADD16 __uadd16
Jasper_lee 0:b16d94660a33 77 #define __UQADD16 __uqadd16
Jasper_lee 0:b16d94660a33 78 #define __UHADD16 __uhadd16
Jasper_lee 0:b16d94660a33 79 #define __SSUB16 __ssub16
Jasper_lee 0:b16d94660a33 80 #define __QSUB16 __qsub16
Jasper_lee 0:b16d94660a33 81 #define __SHSUB16 __shsub16
Jasper_lee 0:b16d94660a33 82 #define __USUB16 __usub16
Jasper_lee 0:b16d94660a33 83 #define __UQSUB16 __uqsub16
Jasper_lee 0:b16d94660a33 84 #define __UHSUB16 __uhsub16
Jasper_lee 0:b16d94660a33 85 #define __SASX __sasx
Jasper_lee 0:b16d94660a33 86 #define __QASX __qasx
Jasper_lee 0:b16d94660a33 87 #define __SHASX __shasx
Jasper_lee 0:b16d94660a33 88 #define __UASX __uasx
Jasper_lee 0:b16d94660a33 89 #define __UQASX __uqasx
Jasper_lee 0:b16d94660a33 90 #define __UHASX __uhasx
Jasper_lee 0:b16d94660a33 91 #define __SSAX __ssax
Jasper_lee 0:b16d94660a33 92 #define __QSAX __qsax
Jasper_lee 0:b16d94660a33 93 #define __SHSAX __shsax
Jasper_lee 0:b16d94660a33 94 #define __USAX __usax
Jasper_lee 0:b16d94660a33 95 #define __UQSAX __uqsax
Jasper_lee 0:b16d94660a33 96 #define __UHSAX __uhsax
Jasper_lee 0:b16d94660a33 97 #define __USAD8 __usad8
Jasper_lee 0:b16d94660a33 98 #define __USADA8 __usada8
Jasper_lee 0:b16d94660a33 99 #define __SSAT16 __ssat16
Jasper_lee 0:b16d94660a33 100 #define __USAT16 __usat16
Jasper_lee 0:b16d94660a33 101 #define __UXTB16 __uxtb16
Jasper_lee 0:b16d94660a33 102 #define __UXTAB16 __uxtab16
Jasper_lee 0:b16d94660a33 103 #define __SXTB16 __sxtb16
Jasper_lee 0:b16d94660a33 104 #define __SXTAB16 __sxtab16
Jasper_lee 0:b16d94660a33 105 #define __SMUAD __smuad
Jasper_lee 0:b16d94660a33 106 #define __SMUADX __smuadx
Jasper_lee 0:b16d94660a33 107 #define __SMLAD __smlad
Jasper_lee 0:b16d94660a33 108 #define __SMLADX __smladx
Jasper_lee 0:b16d94660a33 109 #define __SMLALD __smlald
Jasper_lee 0:b16d94660a33 110 #define __SMLALDX __smlaldx
Jasper_lee 0:b16d94660a33 111 #define __SMUSD __smusd
Jasper_lee 0:b16d94660a33 112 #define __SMUSDX __smusdx
Jasper_lee 0:b16d94660a33 113 #define __SMLSD __smlsd
Jasper_lee 0:b16d94660a33 114 #define __SMLSDX __smlsdx
Jasper_lee 0:b16d94660a33 115 #define __SMLSLD __smlsld
Jasper_lee 0:b16d94660a33 116 #define __SMLSLDX __smlsldx
Jasper_lee 0:b16d94660a33 117 #define __SEL __sel
Jasper_lee 0:b16d94660a33 118 #define __QADD __qadd
Jasper_lee 0:b16d94660a33 119 #define __QSUB __qsub
Jasper_lee 0:b16d94660a33 120
Jasper_lee 0:b16d94660a33 121 #define __PKHBT(ARG1,ARG2,ARG3) ( ((((uint32_t)(ARG1)) ) & 0x0000FFFFUL) | \
Jasper_lee 0:b16d94660a33 122 ((((uint32_t)(ARG2)) << (ARG3)) & 0xFFFF0000UL) )
Jasper_lee 0:b16d94660a33 123
Jasper_lee 0:b16d94660a33 124 #define __PKHTB(ARG1,ARG2,ARG3) ( ((((uint32_t)(ARG1)) ) & 0xFFFF0000UL) | \
Jasper_lee 0:b16d94660a33 125 ((((uint32_t)(ARG2)) >> (ARG3)) & 0x0000FFFFUL) )
Jasper_lee 0:b16d94660a33 126
Jasper_lee 0:b16d94660a33 127 #define __SMMLA(ARG1,ARG2,ARG3) ( (int32_t)((((int64_t)(ARG1) * (ARG2)) + \
Jasper_lee 0:b16d94660a33 128 ((int64_t)(ARG3) << 32) ) >> 32))
Jasper_lee 0:b16d94660a33 129
Jasper_lee 0:b16d94660a33 130 /*-- End CM4 SIMD Intrinsics -----------------------------------------------------*/
Jasper_lee 0:b16d94660a33 131
Jasper_lee 0:b16d94660a33 132
Jasper_lee 0:b16d94660a33 133
Jasper_lee 0:b16d94660a33 134 #elif defined ( __ICCARM__ ) /*------------------ ICC Compiler -------------------*/
Jasper_lee 0:b16d94660a33 135 /* IAR iccarm specific functions */
Jasper_lee 0:b16d94660a33 136
Jasper_lee 0:b16d94660a33 137 /*------ CM4 SIMD Intrinsics -----------------------------------------------------*/
Jasper_lee 0:b16d94660a33 138 #include <cmsis_iar.h>
Jasper_lee 0:b16d94660a33 139
Jasper_lee 0:b16d94660a33 140 /*-- End CM4 SIMD Intrinsics -----------------------------------------------------*/
Jasper_lee 0:b16d94660a33 141
Jasper_lee 0:b16d94660a33 142
Jasper_lee 0:b16d94660a33 143
Jasper_lee 0:b16d94660a33 144 #elif defined ( __TMS470__ ) /*---------------- TI CCS Compiler ------------------*/
Jasper_lee 0:b16d94660a33 145 /* TI CCS specific functions */
Jasper_lee 0:b16d94660a33 146
Jasper_lee 0:b16d94660a33 147 /*------ CM4 SIMD Intrinsics -----------------------------------------------------*/
Jasper_lee 0:b16d94660a33 148 #include <cmsis_ccs.h>
Jasper_lee 0:b16d94660a33 149
Jasper_lee 0:b16d94660a33 150 /*-- End CM4 SIMD Intrinsics -----------------------------------------------------*/
Jasper_lee 0:b16d94660a33 151
Jasper_lee 0:b16d94660a33 152
Jasper_lee 0:b16d94660a33 153
Jasper_lee 0:b16d94660a33 154 #elif defined ( __GNUC__ ) /*------------------ GNU Compiler ---------------------*/
Jasper_lee 0:b16d94660a33 155 /* GNU gcc specific functions */
Jasper_lee 0:b16d94660a33 156
Jasper_lee 0:b16d94660a33 157 /*------ CM4 SIMD Intrinsics -----------------------------------------------------*/
Jasper_lee 0:b16d94660a33 158 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __SADD8(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 159 {
Jasper_lee 0:b16d94660a33 160 uint32_t result;
Jasper_lee 0:b16d94660a33 161
Jasper_lee 0:b16d94660a33 162 __ASM volatile ("sadd8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 163 return(result);
Jasper_lee 0:b16d94660a33 164 }
Jasper_lee 0:b16d94660a33 165
Jasper_lee 0:b16d94660a33 166 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __QADD8(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 167 {
Jasper_lee 0:b16d94660a33 168 uint32_t result;
Jasper_lee 0:b16d94660a33 169
Jasper_lee 0:b16d94660a33 170 __ASM volatile ("qadd8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 171 return(result);
Jasper_lee 0:b16d94660a33 172 }
Jasper_lee 0:b16d94660a33 173
Jasper_lee 0:b16d94660a33 174 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __SHADD8(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 175 {
Jasper_lee 0:b16d94660a33 176 uint32_t result;
Jasper_lee 0:b16d94660a33 177
Jasper_lee 0:b16d94660a33 178 __ASM volatile ("shadd8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 179 return(result);
Jasper_lee 0:b16d94660a33 180 }
Jasper_lee 0:b16d94660a33 181
Jasper_lee 0:b16d94660a33 182 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __UADD8(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 183 {
Jasper_lee 0:b16d94660a33 184 uint32_t result;
Jasper_lee 0:b16d94660a33 185
Jasper_lee 0:b16d94660a33 186 __ASM volatile ("uadd8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 187 return(result);
Jasper_lee 0:b16d94660a33 188 }
Jasper_lee 0:b16d94660a33 189
Jasper_lee 0:b16d94660a33 190 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __UQADD8(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 191 {
Jasper_lee 0:b16d94660a33 192 uint32_t result;
Jasper_lee 0:b16d94660a33 193
Jasper_lee 0:b16d94660a33 194 __ASM volatile ("uqadd8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 195 return(result);
Jasper_lee 0:b16d94660a33 196 }
Jasper_lee 0:b16d94660a33 197
Jasper_lee 0:b16d94660a33 198 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __UHADD8(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 199 {
Jasper_lee 0:b16d94660a33 200 uint32_t result;
Jasper_lee 0:b16d94660a33 201
Jasper_lee 0:b16d94660a33 202 __ASM volatile ("uhadd8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 203 return(result);
Jasper_lee 0:b16d94660a33 204 }
Jasper_lee 0:b16d94660a33 205
Jasper_lee 0:b16d94660a33 206
Jasper_lee 0:b16d94660a33 207 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __SSUB8(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 208 {
Jasper_lee 0:b16d94660a33 209 uint32_t result;
Jasper_lee 0:b16d94660a33 210
Jasper_lee 0:b16d94660a33 211 __ASM volatile ("ssub8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 212 return(result);
Jasper_lee 0:b16d94660a33 213 }
Jasper_lee 0:b16d94660a33 214
Jasper_lee 0:b16d94660a33 215 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __QSUB8(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 216 {
Jasper_lee 0:b16d94660a33 217 uint32_t result;
Jasper_lee 0:b16d94660a33 218
Jasper_lee 0:b16d94660a33 219 __ASM volatile ("qsub8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 220 return(result);
Jasper_lee 0:b16d94660a33 221 }
Jasper_lee 0:b16d94660a33 222
Jasper_lee 0:b16d94660a33 223 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __SHSUB8(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 224 {
Jasper_lee 0:b16d94660a33 225 uint32_t result;
Jasper_lee 0:b16d94660a33 226
Jasper_lee 0:b16d94660a33 227 __ASM volatile ("shsub8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 228 return(result);
Jasper_lee 0:b16d94660a33 229 }
Jasper_lee 0:b16d94660a33 230
Jasper_lee 0:b16d94660a33 231 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __USUB8(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 232 {
Jasper_lee 0:b16d94660a33 233 uint32_t result;
Jasper_lee 0:b16d94660a33 234
Jasper_lee 0:b16d94660a33 235 __ASM volatile ("usub8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 236 return(result);
Jasper_lee 0:b16d94660a33 237 }
Jasper_lee 0:b16d94660a33 238
Jasper_lee 0:b16d94660a33 239 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __UQSUB8(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 240 {
Jasper_lee 0:b16d94660a33 241 uint32_t result;
Jasper_lee 0:b16d94660a33 242
Jasper_lee 0:b16d94660a33 243 __ASM volatile ("uqsub8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 244 return(result);
Jasper_lee 0:b16d94660a33 245 }
Jasper_lee 0:b16d94660a33 246
Jasper_lee 0:b16d94660a33 247 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __UHSUB8(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 248 {
Jasper_lee 0:b16d94660a33 249 uint32_t result;
Jasper_lee 0:b16d94660a33 250
Jasper_lee 0:b16d94660a33 251 __ASM volatile ("uhsub8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 252 return(result);
Jasper_lee 0:b16d94660a33 253 }
Jasper_lee 0:b16d94660a33 254
Jasper_lee 0:b16d94660a33 255
Jasper_lee 0:b16d94660a33 256 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __SADD16(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 257 {
Jasper_lee 0:b16d94660a33 258 uint32_t result;
Jasper_lee 0:b16d94660a33 259
Jasper_lee 0:b16d94660a33 260 __ASM volatile ("sadd16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 261 return(result);
Jasper_lee 0:b16d94660a33 262 }
Jasper_lee 0:b16d94660a33 263
Jasper_lee 0:b16d94660a33 264 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __QADD16(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 265 {
Jasper_lee 0:b16d94660a33 266 uint32_t result;
Jasper_lee 0:b16d94660a33 267
Jasper_lee 0:b16d94660a33 268 __ASM volatile ("qadd16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 269 return(result);
Jasper_lee 0:b16d94660a33 270 }
Jasper_lee 0:b16d94660a33 271
Jasper_lee 0:b16d94660a33 272 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __SHADD16(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 273 {
Jasper_lee 0:b16d94660a33 274 uint32_t result;
Jasper_lee 0:b16d94660a33 275
Jasper_lee 0:b16d94660a33 276 __ASM volatile ("shadd16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 277 return(result);
Jasper_lee 0:b16d94660a33 278 }
Jasper_lee 0:b16d94660a33 279
Jasper_lee 0:b16d94660a33 280 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __UADD16(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 281 {
Jasper_lee 0:b16d94660a33 282 uint32_t result;
Jasper_lee 0:b16d94660a33 283
Jasper_lee 0:b16d94660a33 284 __ASM volatile ("uadd16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 285 return(result);
Jasper_lee 0:b16d94660a33 286 }
Jasper_lee 0:b16d94660a33 287
Jasper_lee 0:b16d94660a33 288 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __UQADD16(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 289 {
Jasper_lee 0:b16d94660a33 290 uint32_t result;
Jasper_lee 0:b16d94660a33 291
Jasper_lee 0:b16d94660a33 292 __ASM volatile ("uqadd16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 293 return(result);
Jasper_lee 0:b16d94660a33 294 }
Jasper_lee 0:b16d94660a33 295
Jasper_lee 0:b16d94660a33 296 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __UHADD16(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 297 {
Jasper_lee 0:b16d94660a33 298 uint32_t result;
Jasper_lee 0:b16d94660a33 299
Jasper_lee 0:b16d94660a33 300 __ASM volatile ("uhadd16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 301 return(result);
Jasper_lee 0:b16d94660a33 302 }
Jasper_lee 0:b16d94660a33 303
Jasper_lee 0:b16d94660a33 304 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __SSUB16(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 305 {
Jasper_lee 0:b16d94660a33 306 uint32_t result;
Jasper_lee 0:b16d94660a33 307
Jasper_lee 0:b16d94660a33 308 __ASM volatile ("ssub16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 309 return(result);
Jasper_lee 0:b16d94660a33 310 }
Jasper_lee 0:b16d94660a33 311
Jasper_lee 0:b16d94660a33 312 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __QSUB16(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 313 {
Jasper_lee 0:b16d94660a33 314 uint32_t result;
Jasper_lee 0:b16d94660a33 315
Jasper_lee 0:b16d94660a33 316 __ASM volatile ("qsub16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 317 return(result);
Jasper_lee 0:b16d94660a33 318 }
Jasper_lee 0:b16d94660a33 319
Jasper_lee 0:b16d94660a33 320 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __SHSUB16(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 321 {
Jasper_lee 0:b16d94660a33 322 uint32_t result;
Jasper_lee 0:b16d94660a33 323
Jasper_lee 0:b16d94660a33 324 __ASM volatile ("shsub16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 325 return(result);
Jasper_lee 0:b16d94660a33 326 }
Jasper_lee 0:b16d94660a33 327
Jasper_lee 0:b16d94660a33 328 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __USUB16(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 329 {
Jasper_lee 0:b16d94660a33 330 uint32_t result;
Jasper_lee 0:b16d94660a33 331
Jasper_lee 0:b16d94660a33 332 __ASM volatile ("usub16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 333 return(result);
Jasper_lee 0:b16d94660a33 334 }
Jasper_lee 0:b16d94660a33 335
Jasper_lee 0:b16d94660a33 336 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __UQSUB16(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 337 {
Jasper_lee 0:b16d94660a33 338 uint32_t result;
Jasper_lee 0:b16d94660a33 339
Jasper_lee 0:b16d94660a33 340 __ASM volatile ("uqsub16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 341 return(result);
Jasper_lee 0:b16d94660a33 342 }
Jasper_lee 0:b16d94660a33 343
Jasper_lee 0:b16d94660a33 344 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __UHSUB16(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 345 {
Jasper_lee 0:b16d94660a33 346 uint32_t result;
Jasper_lee 0:b16d94660a33 347
Jasper_lee 0:b16d94660a33 348 __ASM volatile ("uhsub16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 349 return(result);
Jasper_lee 0:b16d94660a33 350 }
Jasper_lee 0:b16d94660a33 351
Jasper_lee 0:b16d94660a33 352 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __SASX(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 353 {
Jasper_lee 0:b16d94660a33 354 uint32_t result;
Jasper_lee 0:b16d94660a33 355
Jasper_lee 0:b16d94660a33 356 __ASM volatile ("sasx %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 357 return(result);
Jasper_lee 0:b16d94660a33 358 }
Jasper_lee 0:b16d94660a33 359
Jasper_lee 0:b16d94660a33 360 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __QASX(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 361 {
Jasper_lee 0:b16d94660a33 362 uint32_t result;
Jasper_lee 0:b16d94660a33 363
Jasper_lee 0:b16d94660a33 364 __ASM volatile ("qasx %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 365 return(result);
Jasper_lee 0:b16d94660a33 366 }
Jasper_lee 0:b16d94660a33 367
Jasper_lee 0:b16d94660a33 368 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __SHASX(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 369 {
Jasper_lee 0:b16d94660a33 370 uint32_t result;
Jasper_lee 0:b16d94660a33 371
Jasper_lee 0:b16d94660a33 372 __ASM volatile ("shasx %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 373 return(result);
Jasper_lee 0:b16d94660a33 374 }
Jasper_lee 0:b16d94660a33 375
Jasper_lee 0:b16d94660a33 376 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __UASX(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 377 {
Jasper_lee 0:b16d94660a33 378 uint32_t result;
Jasper_lee 0:b16d94660a33 379
Jasper_lee 0:b16d94660a33 380 __ASM volatile ("uasx %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 381 return(result);
Jasper_lee 0:b16d94660a33 382 }
Jasper_lee 0:b16d94660a33 383
Jasper_lee 0:b16d94660a33 384 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __UQASX(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 385 {
Jasper_lee 0:b16d94660a33 386 uint32_t result;
Jasper_lee 0:b16d94660a33 387
Jasper_lee 0:b16d94660a33 388 __ASM volatile ("uqasx %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 389 return(result);
Jasper_lee 0:b16d94660a33 390 }
Jasper_lee 0:b16d94660a33 391
Jasper_lee 0:b16d94660a33 392 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __UHASX(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 393 {
Jasper_lee 0:b16d94660a33 394 uint32_t result;
Jasper_lee 0:b16d94660a33 395
Jasper_lee 0:b16d94660a33 396 __ASM volatile ("uhasx %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 397 return(result);
Jasper_lee 0:b16d94660a33 398 }
Jasper_lee 0:b16d94660a33 399
Jasper_lee 0:b16d94660a33 400 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __SSAX(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 401 {
Jasper_lee 0:b16d94660a33 402 uint32_t result;
Jasper_lee 0:b16d94660a33 403
Jasper_lee 0:b16d94660a33 404 __ASM volatile ("ssax %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 405 return(result);
Jasper_lee 0:b16d94660a33 406 }
Jasper_lee 0:b16d94660a33 407
Jasper_lee 0:b16d94660a33 408 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __QSAX(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 409 {
Jasper_lee 0:b16d94660a33 410 uint32_t result;
Jasper_lee 0:b16d94660a33 411
Jasper_lee 0:b16d94660a33 412 __ASM volatile ("qsax %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 413 return(result);
Jasper_lee 0:b16d94660a33 414 }
Jasper_lee 0:b16d94660a33 415
Jasper_lee 0:b16d94660a33 416 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __SHSAX(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 417 {
Jasper_lee 0:b16d94660a33 418 uint32_t result;
Jasper_lee 0:b16d94660a33 419
Jasper_lee 0:b16d94660a33 420 __ASM volatile ("shsax %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 421 return(result);
Jasper_lee 0:b16d94660a33 422 }
Jasper_lee 0:b16d94660a33 423
Jasper_lee 0:b16d94660a33 424 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __USAX(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 425 {
Jasper_lee 0:b16d94660a33 426 uint32_t result;
Jasper_lee 0:b16d94660a33 427
Jasper_lee 0:b16d94660a33 428 __ASM volatile ("usax %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 429 return(result);
Jasper_lee 0:b16d94660a33 430 }
Jasper_lee 0:b16d94660a33 431
Jasper_lee 0:b16d94660a33 432 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __UQSAX(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 433 {
Jasper_lee 0:b16d94660a33 434 uint32_t result;
Jasper_lee 0:b16d94660a33 435
Jasper_lee 0:b16d94660a33 436 __ASM volatile ("uqsax %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 437 return(result);
Jasper_lee 0:b16d94660a33 438 }
Jasper_lee 0:b16d94660a33 439
Jasper_lee 0:b16d94660a33 440 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __UHSAX(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 441 {
Jasper_lee 0:b16d94660a33 442 uint32_t result;
Jasper_lee 0:b16d94660a33 443
Jasper_lee 0:b16d94660a33 444 __ASM volatile ("uhsax %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 445 return(result);
Jasper_lee 0:b16d94660a33 446 }
Jasper_lee 0:b16d94660a33 447
Jasper_lee 0:b16d94660a33 448 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __USAD8(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 449 {
Jasper_lee 0:b16d94660a33 450 uint32_t result;
Jasper_lee 0:b16d94660a33 451
Jasper_lee 0:b16d94660a33 452 __ASM volatile ("usad8 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 453 return(result);
Jasper_lee 0:b16d94660a33 454 }
Jasper_lee 0:b16d94660a33 455
Jasper_lee 0:b16d94660a33 456 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __USADA8(uint32_t op1, uint32_t op2, uint32_t op3)
Jasper_lee 0:b16d94660a33 457 {
Jasper_lee 0:b16d94660a33 458 uint32_t result;
Jasper_lee 0:b16d94660a33 459
Jasper_lee 0:b16d94660a33 460 __ASM volatile ("usada8 %0, %1, %2, %3" : "=r" (result) : "r" (op1), "r" (op2), "r" (op3) );
Jasper_lee 0:b16d94660a33 461 return(result);
Jasper_lee 0:b16d94660a33 462 }
Jasper_lee 0:b16d94660a33 463
Jasper_lee 0:b16d94660a33 464 #define __SSAT16(ARG1,ARG2) \
Jasper_lee 0:b16d94660a33 465 ({ \
Jasper_lee 0:b16d94660a33 466 uint32_t __RES, __ARG1 = (ARG1); \
Jasper_lee 0:b16d94660a33 467 __ASM ("ssat16 %0, %1, %2" : "=r" (__RES) : "I" (ARG2), "r" (__ARG1) ); \
Jasper_lee 0:b16d94660a33 468 __RES; \
Jasper_lee 0:b16d94660a33 469 })
Jasper_lee 0:b16d94660a33 470
Jasper_lee 0:b16d94660a33 471 #define __USAT16(ARG1,ARG2) \
Jasper_lee 0:b16d94660a33 472 ({ \
Jasper_lee 0:b16d94660a33 473 uint32_t __RES, __ARG1 = (ARG1); \
Jasper_lee 0:b16d94660a33 474 __ASM ("usat16 %0, %1, %2" : "=r" (__RES) : "I" (ARG2), "r" (__ARG1) ); \
Jasper_lee 0:b16d94660a33 475 __RES; \
Jasper_lee 0:b16d94660a33 476 })
Jasper_lee 0:b16d94660a33 477
Jasper_lee 0:b16d94660a33 478 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __UXTB16(uint32_t op1)
Jasper_lee 0:b16d94660a33 479 {
Jasper_lee 0:b16d94660a33 480 uint32_t result;
Jasper_lee 0:b16d94660a33 481
Jasper_lee 0:b16d94660a33 482 __ASM volatile ("uxtb16 %0, %1" : "=r" (result) : "r" (op1));
Jasper_lee 0:b16d94660a33 483 return(result);
Jasper_lee 0:b16d94660a33 484 }
Jasper_lee 0:b16d94660a33 485
Jasper_lee 0:b16d94660a33 486 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __UXTAB16(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 487 {
Jasper_lee 0:b16d94660a33 488 uint32_t result;
Jasper_lee 0:b16d94660a33 489
Jasper_lee 0:b16d94660a33 490 __ASM volatile ("uxtab16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 491 return(result);
Jasper_lee 0:b16d94660a33 492 }
Jasper_lee 0:b16d94660a33 493
Jasper_lee 0:b16d94660a33 494 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __SXTB16(uint32_t op1)
Jasper_lee 0:b16d94660a33 495 {
Jasper_lee 0:b16d94660a33 496 uint32_t result;
Jasper_lee 0:b16d94660a33 497
Jasper_lee 0:b16d94660a33 498 __ASM volatile ("sxtb16 %0, %1" : "=r" (result) : "r" (op1));
Jasper_lee 0:b16d94660a33 499 return(result);
Jasper_lee 0:b16d94660a33 500 }
Jasper_lee 0:b16d94660a33 501
Jasper_lee 0:b16d94660a33 502 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __SXTAB16(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 503 {
Jasper_lee 0:b16d94660a33 504 uint32_t result;
Jasper_lee 0:b16d94660a33 505
Jasper_lee 0:b16d94660a33 506 __ASM volatile ("sxtab16 %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 507 return(result);
Jasper_lee 0:b16d94660a33 508 }
Jasper_lee 0:b16d94660a33 509
Jasper_lee 0:b16d94660a33 510 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __SMUAD (uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 511 {
Jasper_lee 0:b16d94660a33 512 uint32_t result;
Jasper_lee 0:b16d94660a33 513
Jasper_lee 0:b16d94660a33 514 __ASM volatile ("smuad %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 515 return(result);
Jasper_lee 0:b16d94660a33 516 }
Jasper_lee 0:b16d94660a33 517
Jasper_lee 0:b16d94660a33 518 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __SMUADX (uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 519 {
Jasper_lee 0:b16d94660a33 520 uint32_t result;
Jasper_lee 0:b16d94660a33 521
Jasper_lee 0:b16d94660a33 522 __ASM volatile ("smuadx %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 523 return(result);
Jasper_lee 0:b16d94660a33 524 }
Jasper_lee 0:b16d94660a33 525
Jasper_lee 0:b16d94660a33 526 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __SMLAD (uint32_t op1, uint32_t op2, uint32_t op3)
Jasper_lee 0:b16d94660a33 527 {
Jasper_lee 0:b16d94660a33 528 uint32_t result;
Jasper_lee 0:b16d94660a33 529
Jasper_lee 0:b16d94660a33 530 __ASM volatile ("smlad %0, %1, %2, %3" : "=r" (result) : "r" (op1), "r" (op2), "r" (op3) );
Jasper_lee 0:b16d94660a33 531 return(result);
Jasper_lee 0:b16d94660a33 532 }
Jasper_lee 0:b16d94660a33 533
Jasper_lee 0:b16d94660a33 534 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __SMLADX (uint32_t op1, uint32_t op2, uint32_t op3)
Jasper_lee 0:b16d94660a33 535 {
Jasper_lee 0:b16d94660a33 536 uint32_t result;
Jasper_lee 0:b16d94660a33 537
Jasper_lee 0:b16d94660a33 538 __ASM volatile ("smladx %0, %1, %2, %3" : "=r" (result) : "r" (op1), "r" (op2), "r" (op3) );
Jasper_lee 0:b16d94660a33 539 return(result);
Jasper_lee 0:b16d94660a33 540 }
Jasper_lee 0:b16d94660a33 541
Jasper_lee 0:b16d94660a33 542 #define __SMLALD(ARG1,ARG2,ARG3) \
Jasper_lee 0:b16d94660a33 543 ({ \
Jasper_lee 0:b16d94660a33 544 uint32_t __ARG1 = (ARG1), __ARG2 = (ARG2), __ARG3_H = (uint32_t)((uint64_t)(ARG3) >> 32), __ARG3_L = (uint32_t)((uint64_t)(ARG3) & 0xFFFFFFFFUL); \
Jasper_lee 0:b16d94660a33 545 __ASM volatile ("smlald %0, %1, %2, %3" : "=r" (__ARG3_L), "=r" (__ARG3_H) : "r" (__ARG1), "r" (__ARG2), "0" (__ARG3_L), "1" (__ARG3_H) ); \
Jasper_lee 0:b16d94660a33 546 (uint64_t)(((uint64_t)__ARG3_H << 32) | __ARG3_L); \
Jasper_lee 0:b16d94660a33 547 })
Jasper_lee 0:b16d94660a33 548
Jasper_lee 0:b16d94660a33 549 #define __SMLALDX(ARG1,ARG2,ARG3) \
Jasper_lee 0:b16d94660a33 550 ({ \
Jasper_lee 0:b16d94660a33 551 uint32_t __ARG1 = (ARG1), __ARG2 = (ARG2), __ARG3_H = (uint32_t)((uint64_t)(ARG3) >> 32), __ARG3_L = (uint32_t)((uint64_t)(ARG3) & 0xFFFFFFFFUL); \
Jasper_lee 0:b16d94660a33 552 __ASM volatile ("smlaldx %0, %1, %2, %3" : "=r" (__ARG3_L), "=r" (__ARG3_H) : "r" (__ARG1), "r" (__ARG2), "0" (__ARG3_L), "1" (__ARG3_H) ); \
Jasper_lee 0:b16d94660a33 553 (uint64_t)(((uint64_t)__ARG3_H << 32) | __ARG3_L); \
Jasper_lee 0:b16d94660a33 554 })
Jasper_lee 0:b16d94660a33 555
Jasper_lee 0:b16d94660a33 556 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __SMUSD (uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 557 {
Jasper_lee 0:b16d94660a33 558 uint32_t result;
Jasper_lee 0:b16d94660a33 559
Jasper_lee 0:b16d94660a33 560 __ASM volatile ("smusd %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 561 return(result);
Jasper_lee 0:b16d94660a33 562 }
Jasper_lee 0:b16d94660a33 563
Jasper_lee 0:b16d94660a33 564 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __SMUSDX (uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 565 {
Jasper_lee 0:b16d94660a33 566 uint32_t result;
Jasper_lee 0:b16d94660a33 567
Jasper_lee 0:b16d94660a33 568 __ASM volatile ("smusdx %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 569 return(result);
Jasper_lee 0:b16d94660a33 570 }
Jasper_lee 0:b16d94660a33 571
Jasper_lee 0:b16d94660a33 572 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __SMLSD (uint32_t op1, uint32_t op2, uint32_t op3)
Jasper_lee 0:b16d94660a33 573 {
Jasper_lee 0:b16d94660a33 574 uint32_t result;
Jasper_lee 0:b16d94660a33 575
Jasper_lee 0:b16d94660a33 576 __ASM volatile ("smlsd %0, %1, %2, %3" : "=r" (result) : "r" (op1), "r" (op2), "r" (op3) );
Jasper_lee 0:b16d94660a33 577 return(result);
Jasper_lee 0:b16d94660a33 578 }
Jasper_lee 0:b16d94660a33 579
Jasper_lee 0:b16d94660a33 580 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __SMLSDX (uint32_t op1, uint32_t op2, uint32_t op3)
Jasper_lee 0:b16d94660a33 581 {
Jasper_lee 0:b16d94660a33 582 uint32_t result;
Jasper_lee 0:b16d94660a33 583
Jasper_lee 0:b16d94660a33 584 __ASM volatile ("smlsdx %0, %1, %2, %3" : "=r" (result) : "r" (op1), "r" (op2), "r" (op3) );
Jasper_lee 0:b16d94660a33 585 return(result);
Jasper_lee 0:b16d94660a33 586 }
Jasper_lee 0:b16d94660a33 587
Jasper_lee 0:b16d94660a33 588 #define __SMLSLD(ARG1,ARG2,ARG3) \
Jasper_lee 0:b16d94660a33 589 ({ \
Jasper_lee 0:b16d94660a33 590 uint32_t __ARG1 = (ARG1), __ARG2 = (ARG2), __ARG3_H = (uint32_t)((ARG3) >> 32), __ARG3_L = (uint32_t)((ARG3) & 0xFFFFFFFFUL); \
Jasper_lee 0:b16d94660a33 591 __ASM volatile ("smlsld %0, %1, %2, %3" : "=r" (__ARG3_L), "=r" (__ARG3_H) : "r" (__ARG1), "r" (__ARG2), "0" (__ARG3_L), "1" (__ARG3_H) ); \
Jasper_lee 0:b16d94660a33 592 (uint64_t)(((uint64_t)__ARG3_H << 32) | __ARG3_L); \
Jasper_lee 0:b16d94660a33 593 })
Jasper_lee 0:b16d94660a33 594
Jasper_lee 0:b16d94660a33 595 #define __SMLSLDX(ARG1,ARG2,ARG3) \
Jasper_lee 0:b16d94660a33 596 ({ \
Jasper_lee 0:b16d94660a33 597 uint32_t __ARG1 = (ARG1), __ARG2 = (ARG2), __ARG3_H = (uint32_t)((ARG3) >> 32), __ARG3_L = (uint32_t)((ARG3) & 0xFFFFFFFFUL); \
Jasper_lee 0:b16d94660a33 598 __ASM volatile ("smlsldx %0, %1, %2, %3" : "=r" (__ARG3_L), "=r" (__ARG3_H) : "r" (__ARG1), "r" (__ARG2), "0" (__ARG3_L), "1" (__ARG3_H) ); \
Jasper_lee 0:b16d94660a33 599 (uint64_t)(((uint64_t)__ARG3_H << 32) | __ARG3_L); \
Jasper_lee 0:b16d94660a33 600 })
Jasper_lee 0:b16d94660a33 601
Jasper_lee 0:b16d94660a33 602 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __SEL (uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 603 {
Jasper_lee 0:b16d94660a33 604 uint32_t result;
Jasper_lee 0:b16d94660a33 605
Jasper_lee 0:b16d94660a33 606 __ASM volatile ("sel %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 607 return(result);
Jasper_lee 0:b16d94660a33 608 }
Jasper_lee 0:b16d94660a33 609
Jasper_lee 0:b16d94660a33 610 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __QADD(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 611 {
Jasper_lee 0:b16d94660a33 612 uint32_t result;
Jasper_lee 0:b16d94660a33 613
Jasper_lee 0:b16d94660a33 614 __ASM volatile ("qadd %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 615 return(result);
Jasper_lee 0:b16d94660a33 616 }
Jasper_lee 0:b16d94660a33 617
Jasper_lee 0:b16d94660a33 618 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __QSUB(uint32_t op1, uint32_t op2)
Jasper_lee 0:b16d94660a33 619 {
Jasper_lee 0:b16d94660a33 620 uint32_t result;
Jasper_lee 0:b16d94660a33 621
Jasper_lee 0:b16d94660a33 622 __ASM volatile ("qsub %0, %1, %2" : "=r" (result) : "r" (op1), "r" (op2) );
Jasper_lee 0:b16d94660a33 623 return(result);
Jasper_lee 0:b16d94660a33 624 }
Jasper_lee 0:b16d94660a33 625
Jasper_lee 0:b16d94660a33 626 #define __PKHBT(ARG1,ARG2,ARG3) \
Jasper_lee 0:b16d94660a33 627 ({ \
Jasper_lee 0:b16d94660a33 628 uint32_t __RES, __ARG1 = (ARG1), __ARG2 = (ARG2); \
Jasper_lee 0:b16d94660a33 629 __ASM ("pkhbt %0, %1, %2, lsl %3" : "=r" (__RES) : "r" (__ARG1), "r" (__ARG2), "I" (ARG3) ); \
Jasper_lee 0:b16d94660a33 630 __RES; \
Jasper_lee 0:b16d94660a33 631 })
Jasper_lee 0:b16d94660a33 632
Jasper_lee 0:b16d94660a33 633 #define __PKHTB(ARG1,ARG2,ARG3) \
Jasper_lee 0:b16d94660a33 634 ({ \
Jasper_lee 0:b16d94660a33 635 uint32_t __RES, __ARG1 = (ARG1), __ARG2 = (ARG2); \
Jasper_lee 0:b16d94660a33 636 if (ARG3 == 0) \
Jasper_lee 0:b16d94660a33 637 __ASM ("pkhtb %0, %1, %2" : "=r" (__RES) : "r" (__ARG1), "r" (__ARG2) ); \
Jasper_lee 0:b16d94660a33 638 else \
Jasper_lee 0:b16d94660a33 639 __ASM ("pkhtb %0, %1, %2, asr %3" : "=r" (__RES) : "r" (__ARG1), "r" (__ARG2), "I" (ARG3) ); \
Jasper_lee 0:b16d94660a33 640 __RES; \
Jasper_lee 0:b16d94660a33 641 })
Jasper_lee 0:b16d94660a33 642
Jasper_lee 0:b16d94660a33 643 __attribute__( ( always_inline ) ) __STATIC_INLINE uint32_t __SMMLA (int32_t op1, int32_t op2, int32_t op3)
Jasper_lee 0:b16d94660a33 644 {
Jasper_lee 0:b16d94660a33 645 int32_t result;
Jasper_lee 0:b16d94660a33 646
Jasper_lee 0:b16d94660a33 647 __ASM volatile ("smmla %0, %1, %2, %3" : "=r" (result): "r" (op1), "r" (op2), "r" (op3) );
Jasper_lee 0:b16d94660a33 648 return(result);
Jasper_lee 0:b16d94660a33 649 }
Jasper_lee 0:b16d94660a33 650
Jasper_lee 0:b16d94660a33 651 /*-- End CM4 SIMD Intrinsics -----------------------------------------------------*/
Jasper_lee 0:b16d94660a33 652
Jasper_lee 0:b16d94660a33 653
Jasper_lee 0:b16d94660a33 654
Jasper_lee 0:b16d94660a33 655 #elif defined ( __TASKING__ ) /*------------------ TASKING Compiler --------------*/
Jasper_lee 0:b16d94660a33 656 /* TASKING carm specific functions */
Jasper_lee 0:b16d94660a33 657
Jasper_lee 0:b16d94660a33 658
Jasper_lee 0:b16d94660a33 659 /*------ CM4 SIMD Intrinsics -----------------------------------------------------*/
Jasper_lee 0:b16d94660a33 660 /* not yet supported */
Jasper_lee 0:b16d94660a33 661 /*-- End CM4 SIMD Intrinsics -----------------------------------------------------*/
Jasper_lee 0:b16d94660a33 662
Jasper_lee 0:b16d94660a33 663
Jasper_lee 0:b16d94660a33 664 #endif
Jasper_lee 0:b16d94660a33 665
Jasper_lee 0:b16d94660a33 666 /*@} end of group CMSIS_SIMD_intrinsics */
Jasper_lee 0:b16d94660a33 667
Jasper_lee 0:b16d94660a33 668
Jasper_lee 0:b16d94660a33 669 #endif /* __CORE_CM4_SIMD_H */
Jasper_lee 0:b16d94660a33 670
Jasper_lee 0:b16d94660a33 671 #ifdef __cplusplus
Jasper_lee 0:b16d94660a33 672 }
Jasper_lee 0:b16d94660a33 673 #endif