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 #include "arm_math.h"
00031
00065 void arm_float_to_q15(
00066 float32_t * pSrc,
00067 q15_t * pDst,
00068 uint32_t blockSize)
00069 {
00070 float32_t *pIn = pSrc;
00071 uint32_t blkCnt;
00072
00073 #ifdef ARM_MATH_ROUNDING
00074
00075 float32_t in;
00076
00077 #endif
00078
00079 #ifndef ARM_MATH_CM0
00080
00081
00082
00083
00084 blkCnt = blockSize >> 2u;
00085
00086
00087
00088 while(blkCnt > 0u)
00089 {
00090
00091 #ifdef ARM_MATH_ROUNDING
00092
00093
00094 in = *pIn++;
00095 in = (in * 32768.0f);
00096 in += in > 0 ? 0.5 : -0.5;
00097 *pDst++ = (q15_t) (__SSAT((q31_t) (in), 16));
00098
00099 in = *pIn++;
00100 in = (in * 32768.0f);
00101 in += in > 0 ? 0.5 : -0.5;
00102 *pDst++ = (q15_t) (__SSAT((q31_t) (in), 16));
00103
00104 in = *pIn++;
00105 in = (in * 32768.0f);
00106 in += in > 0 ? 0.5 : -0.5;
00107 *pDst++ = (q15_t) (__SSAT((q31_t) (in), 16));
00108
00109 in = *pIn++;
00110 in = (in * 32768.0f);
00111 in += in > 0 ? 0.5 : -0.5;
00112 *pDst++ = (q15_t) (__SSAT((q31_t) (in), 16));
00113
00114 #else
00115
00116
00117
00118 *pDst++ = (q15_t) __SSAT((q31_t) (*pIn++ * 32768.0f), 16);
00119 *pDst++ = (q15_t) __SSAT((q31_t) (*pIn++ * 32768.0f), 16);
00120 *pDst++ = (q15_t) __SSAT((q31_t) (*pIn++ * 32768.0f), 16);
00121 *pDst++ = (q15_t) __SSAT((q31_t) (*pIn++ * 32768.0f), 16);
00122
00123 #endif
00124
00125
00126 blkCnt--;
00127 }
00128
00129
00130
00131 blkCnt = blockSize % 0x4u;
00132
00133 while(blkCnt > 0u)
00134 {
00135
00136 #ifdef ARM_MATH_ROUNDING
00137
00138
00139 in = *pIn++;
00140 in = (in * 32768.0f);
00141 in += in > 0 ? 0.5 : -0.5;
00142 *pDst++ = (q15_t) (__SSAT((q31_t) (in), 16));
00143
00144 #else
00145
00146
00147
00148 *pDst++ = (q15_t) __SSAT((q31_t) (*pIn++ * 32768.0f), 16);
00149
00150 #endif
00151
00152
00153 blkCnt--;
00154 }
00155
00156
00157 #else
00158
00159
00160
00161
00162 blkCnt = blockSize;
00163
00164 while(blkCnt > 0u)
00165 {
00166
00167 #ifdef ARM_MATH_ROUNDING
00168
00169
00170 in = *pIn++;
00171 in = (in * 32768.0f);
00172 in += in > 0 ? 0.5f : -0.5f;
00173 *pDst++ = (q15_t) (__SSAT((q31_t) (in), 16));
00174
00175 #else
00176
00177
00178
00179 *pDst++ = (q15_t) __SSAT((q31_t) (*pIn++ * 32768.0f), 16);
00180
00181 #endif
00182
00183
00184 blkCnt--;
00185 }
00186
00187 #endif
00188
00189 }
00190