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 #include "arm_math.h"
00028
00062 void arm_float_to_q15(
00063 float32_t * pSrc,
00064 q15_t * pDst,
00065 uint32_t blockSize)
00066 {
00067 float32_t *pIn = pSrc;
00068 uint32_t blkCnt;
00069
00070 #ifdef ARM_MATH_ROUNDING
00071
00072 float32_t in;
00073
00074 #endif
00075
00076
00077 blkCnt = blockSize >> 2u;
00078
00079
00080
00081 while(blkCnt > 0u)
00082 {
00083
00084 #ifdef ARM_MATH_ROUNDING
00085
00086
00087 in = *pIn++;
00088 in = (in * 32768.0f);
00089 in += in > 0 ? 0.5 : -0.5;
00090 *pDst++ = (q15_t) (__SSAT((q31_t) (in), 16));
00091
00092 in = *pIn++;
00093 in = (in * 32768.0f);
00094 in += in > 0 ? 0.5 : -0.5;
00095 *pDst++ = (q15_t) (__SSAT((q31_t) (in), 16));
00096
00097 in = *pIn++;
00098 in = (in * 32768.0f);
00099 in += in > 0 ? 0.5 : -0.5;
00100 *pDst++ = (q15_t) (__SSAT((q31_t) (in), 16));
00101
00102 in = *pIn++;
00103 in = (in * 32768.0f);
00104 in += in > 0 ? 0.5 : -0.5;
00105 *pDst++ = (q15_t) (__SSAT((q31_t) (in), 16));
00106
00107 #else
00108
00109
00110
00111 *pDst++ = (q15_t) __SSAT((q31_t) (*pIn++ * 32768.0f), 16);
00112 *pDst++ = (q15_t) __SSAT((q31_t) (*pIn++ * 32768.0f), 16);
00113 *pDst++ = (q15_t) __SSAT((q31_t) (*pIn++ * 32768.0f), 16);
00114 *pDst++ = (q15_t) __SSAT((q31_t) (*pIn++ * 32768.0f), 16);
00115
00116 #endif
00117
00118
00119 blkCnt--;
00120 }
00121
00122
00123
00124 blkCnt = blockSize % 0x4u;
00125
00126 while(blkCnt > 0u)
00127 {
00128
00129 #ifdef ARM_MATH_ROUNDING
00130
00131
00132 in = *pIn++;
00133 in = (in * 32768LL);
00134 in += in > 0 ? 0.5 : -0.5;
00135 *pDst++ = (q15_t) (__SSAT((q31_t) (in), 16));
00136
00137 #else
00138
00139
00140
00141 *pDst++ = (q15_t) __SSAT((q31_t) (*pIn++ * 32768.0f), 16);
00142
00143 #endif
00144
00145
00146 blkCnt--;
00147 }
00148 }
00149