Pokitto Community Team / Pokitto_

PokittoLib with changes to lcd refresh etc.

Dependents:   Pokittris

Fork of Pokitto by Pokitto Community Team

This is a fork by user @Spinal, and is used in Pokittris for testing. Do not import this to your own program.

mbed-pokitto/targets/cmsis/core_cmSimd.h@11:02ad9c807a21, 2017-10-15 (annotated)

Committer:
spinal
Date:
Sun Oct 15 18:03:02 2017 +0000
Revision:
11:02ad9c807a21
Parent:
5:7e5c566b1760 
fixed 4color refreshRegion code

Who changed what in which revision?

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