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