面是具体的实现代码:[url=] [/url]
1 /****************************************************************** 2 函数名称:InitBufInArray() 3 函数功能:模拟采样数据,采样数据中包含3种频率正弦波(350Hz,8400Hz,18725Hz) 4 参数说明: 5 备 注:在lBufInArray数组中,每个数据的高16位存储采样数据的实部, 6 低16位存储采样数据的虚部(总是为0) 7 作 者:博客园 依旧淡然(http://www.cnblogs.com/menlsh/) 8 *******************************************************************/ 9 void InitBufInArray()10 {11 unsigned short i;12 float fx;13 for(i=0; i<NPT; i++)14 {15 fx = 1500 * sin(PI2 * i * 350.0 / Fs) +16 2700 * sin(PI2 * i * 8400.0 / Fs) +17 4000 * sin(PI2 * i * 18725.0 / Fs);18 lBufInArray = ((signed short)fx) << 16;19 }20 }[url=] [/url]
其中,NPT是采样点数256,PI2是2π(即6.28318530717959),Fs是采样频率44800。可以看到采样数据中包含了3种频率的正弦波,分别为350Hz,8400Hz和18725Hz。
2.4调用DSP库函数进行FFT
进行256点的FFT,只需要调用STM32 DSP库函数中的cr4_fft_256_stm32()函数即可。该函数的原型为:
void cr4_fft_256_stm32(void *pssOUT, void *pssIN, uint16_t Nbin);
其中,参数pssOUT表示FFT输出数组指针,参数pssIN表示要进行FFT运算的输入数组指针,参数Nbin表示了点数。至于该函数的具体实现,因为是用汇编语言编写的,我也不懂,这里就不妄谈了。
下面是具体的调用实例:
cr4_fft_256_stm32(lBufOutArray, lBufInArray, NPT);
其中,参数lBufOutArray同样是一个long类型的数组,参数lBufInArray就是存放模拟采样数据的采样数组,NPT为采样点数256。
调用该函数之后,在lBufOutArray数组中就存放了进行FFT运算之后的结果数据。该数组中每个元素的数据格式为;高16位存储虚部,低16位存储实部。
2.5计算各次谐波幅值
得到FFT运算之后的结果数据之后,就可以计算各次谐波的幅值了。
下面是具体的实现代码:
[url=] [/url]
1 /****************************************************************** 2 函数名称:GetPowerMag() 3 函数功能:计算各次谐波幅值 4 参数说明: 5 备 注:先将lBufOutArray分解成实部(X)和虚部(Y),然后计算幅值(sqrt(X*X+Y*Y) 6 作 者:博客园 依旧淡然(http://www.cnblogs.com/menlsh/) 7 *******************************************************************/ 8 void GetPowerMag() 9 {10 signed short lX,lY;11 float X,Y,Mag;12 unsigned short i;13 for(i=0; i<NPT/2; i++)14 {15 lX = (lBufOutArray << 16) >> 16;16 lY = (lBufOutArray >> 16);17 X = NPT * ((float)lX) / 32768;18 Y = NPT * ((float)lY) / 32768;19 Mag = sqrt(X * X + Y * Y) / NPT;20 if(i == 0)21 lBufMagArray = (unsigned long)(Mag * 32768);22 else23 lBufMagArray = (unsigned long)(Mag * 65536);24 }25 }[url=] [/url]
其中,数组lBufMagArray存储了各次谐波的幅值。 |