Go to the documentation of this file.00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00030
00031
00032
00033 #include "arm_math.h"
00034
00060 void arm_scale_q15(
00061 q15_t * pSrc,
00062 q15_t scaleFract,
00063 int8_t shift,
00064 q15_t * pDst,
00065 uint32_t blockSize)
00066 {
00067 int8_t kShift = 15 - shift;
00068 uint32_t blkCnt;
00069
00070 #ifndef ARM_MATH_CM0
00071
00072
00073
00074 q15_t in1, in2;
00075
00076
00077
00078 blkCnt = blockSize >> 2u;
00079
00080
00081
00082 while(blkCnt > 0u)
00083 {
00084
00085 in1 = *pSrc++;
00086 in2 = *pSrc++;
00087
00088
00089
00090 #ifndef ARM_MATH_BIG_ENDIAN
00091
00092 *__SIMD32(pDst)++ =
00093 __PKHBT(__SSAT((in1 * scaleFract) >> kShift, 16),
00094 __SSAT((in2 * scaleFract) >> kShift, 16), 16);
00095
00096 #else
00097
00098 *__SIMD32(pDst)++ =
00099 __PKHBT(__SSAT((in2 * scaleFract) >> kShift, 16),
00100 __SSAT((in1 * scaleFract) >> kShift, 16), 16);
00101
00102 #endif
00103
00104 in1 = *pSrc++;
00105 in2 = *pSrc++;
00106
00107 #ifndef ARM_MATH_BIG_ENDIAN
00108
00109 *__SIMD32(pDst)++ =
00110 __PKHBT(__SSAT((in1 * scaleFract) >> kShift, 16),
00111 __SSAT((in2 * scaleFract) >> kShift, 16), 16);
00112
00113 #else
00114
00115 *__SIMD32(pDst)++ =
00116 __PKHBT(__SSAT((in2 * scaleFract) >> kShift, 16),
00117 __SSAT((in1 * scaleFract) >> kShift, 16), 16);
00118
00119 #endif
00120
00121
00122 blkCnt--;
00123 }
00124
00125
00126
00127 blkCnt = blockSize % 0x4u;
00128
00129 while(blkCnt > 0u)
00130 {
00131
00132
00133 *pDst++ = (q15_t) (__SSAT(((*pSrc++) * scaleFract) >> kShift, 16));
00134
00135
00136 blkCnt--;
00137 }
00138
00139 #else
00140
00141
00142
00143
00144 blkCnt = blockSize;
00145
00146 while(blkCnt > 0u)
00147 {
00148
00149
00150 *pDst++ = (q15_t) (__SSAT(((q31_t) * pSrc++ * scaleFract) >> kShift, 16));
00151
00152
00153 blkCnt--;
00154 }
00155
00156 #endif
00157
00158 }
00159