原创 STM32学习日志(23)----使用dsp库的FFT函数.rar

attachment download

/**
  ******************************************************************************
  * @file FFT_Demo/src/main.c
  * @author  MCD Application Team
  * @version  V2.0.0
  * @date  04/27/2009
  * @brief  Main program body
  ******************************************************************************
  * @copy
  *
  * THE PRESENT FIRMWARE WHICH IS FOR GUIDANCE ONLY AIMS AT PROVIDING CUSTOMERS
  * WITH CODING INFORMATION REGARDING THEIR PRODUCTS IN ORDER FOR THEM TO SAVE
  * TIME. AS A RESULT, STMICROELECTRONICS SHALL NOT BE HELD LIABLE FOR ANY
  * DIRECT, INDIRECT OR CONSEQUENTIAL DAMAGES WITH RESPECT TO ANY CLAIMS ARISING
  * FROM THE CONTENT OF SUCH FIRMWARE AND/OR THE USE MADE BY CUSTOMERS OF THE
  * CODING INFORMATION CONTAINED HEREIN IN CONNECTION WITH THEIR PRODUCTS.
  *
  * <h2><center>&copy; COPYRIGHT 2009 STMicroelectronics</center></h2>
  */
/* Includes ------------------------------------------------------------------*/
#include "stm32f10x.h"
#include <math.h>
#include "stm3210b_lcd.h"
#include "stm32_dsp.h"
#include "table_fft.h"   
//------------------------------------------------------------------------------

#define FreqSample    3200  // 50Hz*64=3200
#define ScalingFactor   20000  // 幅值系数,最大为32767
#define PERCENT_DC    0.06  // 直流分量对应的百分比,对应直流分量lBUFMAG[0]=1200
#define PI2  6.28318530717959     // 2*3.14
#define NPT 64               /* 采样点数，必须为64NPT = No of FFT point*/
//------------------------------------------------------------------------------
extern volatile uint32_t TimingDelay ;
long lBUFIN[NPT];         /* Complex input vector */
long lBUFOUT[NPT];        /* Complex output vector */
long lBUFMAG[NPT + NPT/2];/* Magnitude vector */

/* Private function prototypes -----------------------------------------------*/
void MyDualSweep(uint32_t freqinc1,uint32_t freqinc2);
void MygSin(long nfill, long Fs, long Freq1, long Freq2, long Ampli);
void powerMag(long nfill, char* strPara);
void DSPDemoInit(void);
//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
//------------------------------------------------------------------------------
int main(void)
{
  DSPDemoInit();

  while (1)
  {
  MyDualSweep(FreqSample/NPT,6*FreqSample/NPT);     // 测试fft
  }
}
//-----------------------------------------------------------------------------

/**
  * @brief  Produces a combination of two sinewaves as input signal
  * @param freq1: frequency increment for 1st sweep，频率步进值1
  *   Freq2: frequency increment for 2nd sweep，频率步进值2
  * @retval : None
  */
void MyDualSweep(uint32_t freqinc1,uint32_t freqinc2)
{
  uint32_t freq;
 
  //for (freq=FreqSample/NPT; freq <FreqSample/2; freq+=freqinc1)  // 40--4000，频率步进值为freqinc1
  for (freq=FreqSample/NPT; freq <FreqSample*6/NPT; freq+=freqinc1)  // 40--4000，频率步进值为freqinc1
  {
     MygSin(NPT, FreqSample, freq, 0, ScalingFactor);// 单独的频率，频率步进值2=0；
               
#if (NPT==64)
     cr4_fft_64_stm32(lBUFOUT, lBUFIN, NPT);
#elif (NPT==256)
     cr4_fft_256_stm32(lBUFOUT, lBUFIN, NPT);
#else
     cr4_fft_1024_stm32(lBUFOUT, lBUFIN, NPT);
#endif

     powerMag(NPT,"2SIDED");
  }

//-----------------------------------------------------------------------------

 for (freq=FreqSample/NPT; freq <FreqSample/2; freq+=freqinc2)
   {
     MygSin(NPT, FreqSample, freq, FreqSample*5/NPT, ScalingFactor);

#if (NPT==64)
     cr4_fft_64_stm32(lBUFOUT, lBUFIN, NPT);
#elif (NPT==256)
     cr4_fft_256_stm32(lBUFOUT, lBUFIN, NPT);
#else
     cr4_fft_1024_stm32(lBUFOUT, lBUFIN, NPT);
#endif
  
     powerMag(NPT,"2SIDED");
  }
}
//------------------------------------------------------------------------------
/**
  * @brief  Produces a combination of two sinewaves as input signal
  * @param ill: length of the array holding input signal
  *   Fs: sampling frequency
  *   Freq1: frequency of the 1st sinewave
  *   Freq2: frequency of the 2nd sinewave
  *   Ampli: scaling factor
  * @retval : None
  */
void MygSin(long nfill, long Fs, long Freq1, long Freq2, long Ampli)
{
  uint32_t i;
  float fFs, fFreq1, fFreq2, fAmpli;
  float fZ,fY;

  fFs = (float) Fs;
  fFreq1 = (float) Freq1;
  fFreq2 = (float) Freq2;
  fAmpli = (float) Ampli;

  for (i=0; i < nfill; i++)
  {
    fY =PERCENT_DC/2+sin(PI2 * i * (fFreq1/fFs)) + 0.2*sin(PI2 * i * (fFreq2/fFs));
    fZ = fAmpli * fY;
 
// lBUFIN数组中，每个单元数据高字(高16位)中存储采样数据的实部，低字(低16位)存储采样数据的虚部(总是为0)
    lBUFIN= ((short)fZ) << 16 ;  /* sine_cosine  (cos=0x0) */
         // 高16bit为实部，低16bit为虚部，没有的话，就用0代替
  }
}
//------------------------------------------------------------------------------
/**
  * @brief  Removes the aliased part of the spectrum (not tested)
  * @param ill: length of the array holding power mag
  * @retval : None
  */
void onesided(long nfill)
{
  uint32_t i;
 
  lBUFMAG[0] = lBUFMAG[0];
  lBUFMAG[nfill/2] = lBUFMAG[nfill/2];
  for (i=1; i < nfill/2; i++)
  {
    lBUFMAG = lBUFMAG + lBUFMAG[nfill-i];
    lBUFMAG[nfill-i] = 0x0;
  }
}
//------------------------------------------------------------------------------
/**
  * @brief  Compute power magnitude of the FFT transform  进行FFT变换，并计算各次谐波幅值
  * @param ill: length of the array holding power mag
  *   : strPara: if set to "1SIDED", removes aliases part of spectrum (not tested)
  * @retval : None
  */
void powerMag(long nfill, char* strPara)
{
  static int32_t lX,lY;
  uint32_t i;