53 #ifndef INCLUDED_volk_32fc_s32f_power_spectrum_32f_a_H 54 #define INCLUDED_volk_32fc_s32f_power_spectrum_32f_a_H 61 #include <pmmintrin.h> 63 #ifdef LV_HAVE_LIB_SIMDMATH 69 const float normalizationFactor,
unsigned int num_points)
71 const float* inputPtr = (
const float*)complexFFTInput;
72 float* destPtr = logPowerOutput;
74 const float iNormalizationFactor = 1.0 / normalizationFactor;
75 #ifdef LV_HAVE_LIB_SIMDMATH 76 __m128 magScalar = _mm_set_ps1(10.0);
77 magScalar = _mm_div_ps(magScalar, logf4(magScalar));
79 __m128 invNormalizationFactor = _mm_set_ps1(iNormalizationFactor);
82 __m128 input1, input2;
83 const uint64_t quarterPoints = num_points / 4;
84 for(;number < quarterPoints; number++){
86 input1 =_mm_load_ps(inputPtr);
88 input2 =_mm_load_ps(inputPtr);
92 input1 = _mm_mul_ps(input1, invNormalizationFactor);
93 input2 = _mm_mul_ps(input2, invNormalizationFactor);
97 input1 = _mm_mul_ps(input1, input1);
99 input2 = _mm_mul_ps(input2, input2);
103 power = _mm_hadd_ps(input1, input2);
106 power = logf4(power);
109 power = _mm_mul_ps(power, magScalar);
112 _mm_store_ps(destPtr, power);
117 number = quarterPoints*4;
121 for(; number < num_points; number++){
128 const float real = *inputPtr++ * iNormalizationFactor;
129 const float imag = *inputPtr++ * iNormalizationFactor;
131 *destPtr = 10.0*log10f(((real * real) + (imag * imag)) + 1e-20);
140 #ifdef LV_HAVE_GENERIC 144 const float normalizationFactor,
unsigned int num_points)
147 const float* inputPtr = (
float*)complexFFTInput;
148 float* realFFTDataPointsPtr = logPowerOutput;
149 const float iNormalizationFactor = 1.0 / normalizationFactor;
151 for(point = 0; point < num_points; point++){
158 const float real = *inputPtr++ * iNormalizationFactor;
159 const float imag = *inputPtr++ * iNormalizationFactor;
161 *realFFTDataPointsPtr = 10.0*log10f(((real * real) + (imag * imag)) + 1e-20);
162 realFFTDataPointsPtr++;
static void volk_32fc_s32f_power_spectrum_32f_a_sse3(float *logPowerOutput, const lv_32fc_t *complexFFTInput, const float normalizationFactor, unsigned int num_points)
Definition: volk_32fc_s32f_power_spectrum_32f.h:68
static void volk_32fc_s32f_power_spectrum_32f_generic(float *logPowerOutput, const lv_32fc_t *complexFFTInput, const float normalizationFactor, unsigned int num_points)
Definition: volk_32fc_s32f_power_spectrum_32f.h:143
float complex lv_32fc_t
Definition: volk_complex.h:61