cc y / mbed

ads1115 only

Fork of mbed by mbed official

TARGET_KL05Z/core_cmSimd.h@102:da0ca467f8b5, 2015-07-08 (annotated)

Committer:
Kojto
Date:
Wed Jul 08 11:22:30 2015 +0100
Revision:
102:da0ca467f8b5
Release 102 of the mbed library



Changes:

- new platform: MPS2

- K64f - mac address fix

- Freescale Kinetis - Serial NC handling fix

- Asynch constnes fixes

- startup files .s - change extension to .S

- APPNEARME_MICRONFCBOARD rename to MICRONFCBOARD

Who changed what in which revision?

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