设为首页收藏本站
开启辅助访问 切换到宽版

 找回密码
 立即注册

QQ登录

只需一步，快速开始

热门： 51单片机 | 24小时必答区 | 单片机教程 | 单片机DIY制作 | STM32 | Cortex M3 | 模数电子 | 电子DIY制作 | 音响/功放 | 拆机乐园 | Arduino | 嵌入式OS | 程序设计

搜索
»论坛 › 嵌入式/单片机论坛 › STM32/8 › stm32中用dsp做fft运算
返回列表 发新帖
查看: 2254|回复: 3
收起左侧

stm32中用dsp做fft运算

[复制链接]
ID:373362 发表于 2018-7-17 16:02 | 显示全部楼层 |阅读模式
stm32中用dsp做fft运算

单片机源程序如下:
  1. /**
  2.   ******************************************************************************
  3.   * @file FFT_Demo/src/main.c
  4.   * @author  MCD Application Team
  5.   * @version  V2.0.0
  6.   * @brief  Main program body

  8. /* Includes ------------------------------------------------------------------*/
  9. #include "stm32f10x.h"
  10. #include <math.h>
  11. #include "stm3210b_lcd.h"
  12. #include "stm32_dsp.h"
  13. #include "table_fft.h"


  16. /** @addtogroup FFT_Demo
  17.   * @{
  18.   */


  21. /* Private typedef -----------------------------------------------------------*/
  22. /* Private define ------------------------------------------------------------*/
  23. #define PI2  6.28318530717959

  25. #define NPT 64            /* NPT = No of FFT point*/
  26. #define DISPLAY_RIGHT 310 /* 224 for centered, 319 for right-aligned */
  27. #define DISPLAY_LEFT 150  /* 224 for centered, 319 for right-aligned */

  29. /* Private macro -------------------------------------------------------------*/
  30. /* Private variables ---------------------------------------------------------*/
  31. extern uint16_t TableFFT[];
  32. extern volatile uint32_t TimingDelay ;
  33. long lBUFIN[NPT];         /* Complex input vector */
  34. long lBUFOUT[NPT];        /* Complex output vector */
  35. long lBUFMAG[NPT + NPT/2];/* Magnitude vector */

  37. /* Private function prototypes -----------------------------------------------*/
  38. void MyDualSweep(uint32_t freqinc1,uint32_t freqinc2);
  39. void MygSin(long nfill, long Fs, long Freq1, long Freq2, long Ampli);
  40. void powerMag(long nfill, char* strPara);
  41. void In_displayWaveform(uint32_t DisplayPos);
  42. void Out_displayWaveform(uint32_t DisplayPos);
  43. void displayPowerMag(uint32_t DisplayPos, uint32_t scale);
  44. void DisplayTitle(void);
  45. void DSPDemoInit(void);

  47. /* Private functions ---------------------------------------------------------*/


  50. /**
  51.   * @brief  Main program.
  52.   * @param  None
  53.   * @retval : None
  54.   */
  55. int main(void)
  56. {

  58.   DSPDemoInit();
  59.   DisplayTitle();

  61.   while (1)
  62.   {
  63.     MyDualSweep(30,30);
  64.   }
  65. }



  69. /**
  70.   * @brief  Produces a combination of two sinewaves as input signal
  71.   * @param eq1: frequency increment for 1st sweep
  72.   *   Freq2: frequency increment for 2nd sweep
  73.   * @retval : None
  74.   */
  75. void MyDualSweep(uint32_t freqinc1,uint32_t freqinc2)
  76. {
  77.   uint32_t freq;

  79.   for (freq=40; freq <4000; freq+=freqinc1)
  80.   {
  81.     MygSin(NPT, 8000, freq, 0, 32767);
  82.     GPIOC->BSRR = GPIO_Pin_7;
  83.    
  84.     cr4_fft_64_stm32(lBUFOUT, lBUFIN, NPT);

  86.     GPIOC->BRR = GPIO_Pin_7;
  87.     powerMag(NPT,"2SIDED");
  88.     In_displayWaveform(DISPLAY_RIGHT);

  90.     displayPowerMag(DISPLAY_RIGHT, 9);

  92.     while (GPIO_ReadInputDataBit(GPIOB, GPIO_Pin_9) == 0x00);
  93.   }

  95.   for (freq=40; freq <4000; freq+=freqinc2)
  96.   {
  97.     MygSin(NPT, 8000, freq, 160, 32767/2);
  98.     GPIOC->BSRR = GPIO_Pin_7;
  99.    
  100.     cr4_fft_64_stm32(lBUFOUT, lBUFIN, NPT);
  101.    
  102.     GPIOC->BRR = GPIO_Pin_7;
  103.     powerMag(NPT,"2SIDED");
  104.     In_displayWaveform(DISPLAY_LEFT);
  105.     displayPowerMag(DISPLAY_LEFT, 8);

  107.     while (GPIO_ReadInputDataBit(GPIOB, GPIO_Pin_9) == 0x00);
  108.   }

  110. }



  114. /**
  115.   * @brief  Produces a combination of two sinewaves as input signal
  116.   * @param ill: length of the array holding input signal
  117.   *   Fs: sampling frequency
  118.   *   Freq1: frequency of the 1st sinewave
  119.   *   Freq2: frequency of the 2nd sinewave
  120.   *   Ampli: scaling factor
  121.   * @retval : None
  122.   */
  123. void MygSin(long nfill, long Fs, long Freq1, long Freq2, long Ampli)
  124. {

  126.   uint32_t i;
  127.   float fFs, fFreq1, fFreq2, fAmpli;
  128.   float fZ,fY;

  130.   fFs = (float) Fs;
  131.   fFreq1 = (float) Freq1;
  132.   fFreq2 = (float) Freq2;
  133.   fAmpli = (float) Ampli;

  135.   for (i=0; i < nfill; i++)
  136.   {
  137.     fY = sin(PI2 * i * (fFreq1/fFs)) + sin(PI2 * i * (fFreq2/fFs));
  138.     fZ = fAmpli * fY;
  139.     lBUFIN[i]= ((short)fZ) << 16 ;  /* sine_cosine  (cos=0x0) */
  140.   }
  141. }




  146. /**
  147.   * @brief  Removes the aliased part of the spectrum (not tested)
  148.   * @param ill: length of the array holding power mag
  149.   * @retval : None
  150.   */
  151. void onesided(long nfill)
  152. {
  153.   uint32_t i;
  154.   
  155.   lBUFMAG[0] = lBUFMAG[0];
  156.   lBUFMAG[nfill/2] = lBUFMAG[nfill/2];
  157.   for (i=1; i < nfill/2; i++)
  158.   {
  159.     lBUFMAG[i] = lBUFMAG[i] + lBUFMAG[nfill-i];
  160.     lBUFMAG[nfill-i] = 0x0;
  161.   }
  162. }




  167. /**
  168.   * @brief  Compute power magnitude of the FFT transform
  169.   * @param ill: length of the array holding power mag
  170.   *   : strPara: if set to "1SIDED", removes aliases part of spectrum (not tested)
  171.   * @retval : None
  172.   */
  173. void powerMag(long nfill, char* strPara)
  174. {
  175.   int32_t lX,lY;
  176.   uint32_t i;

  178.   for (i=0; i < nfill; i++)
  179.   {
  180.     lX= (lBUFOUT[i]<<16)>>16; /* sine_cosine --> cos */
  181.     lY= (lBUFOUT[i] >> 16);   /* sine_cosine --> sin */   
  182.     {
  183.       float X=  64*((float)lX)/32768;
  184.       float Y = 64*((float)lY)/32768;
  185.       float Mag = sqrt(X*X+ Y*Y)/nfill;
  186.       lBUFMAG[i] = (uint32_t)(Mag*65536);
  187.     }   
  188.   }
  189.   if (strPara == "1SIDED") onesided(nfill);
  190. }



  194. /**
  195.   * @brief  Displays the input array before filtering
  196.   * @param splayPos indicates the beginning Y address on LCD
  197.   * @retval : None
  198.   */
  199. void In_displayWaveform(uint32_t DisplayPos)
  200. {
  201.   uint8_t aScale;
  202.   uint16_t cln;

  204.   for (cln=0; cln < 64; cln++)       /* original upper limit was 60 */
  205.   {
  206.     /* Clear previous line */
  207.     LCD_SetTextColor(White);
  208.     LCD_DrawLine(48,DisplayPos-(2*cln),72,Vertical);
  209.     /* and go back to normal display mode */
  210.     LCD_SetTextColor(Black);
  211.     aScale = lBUFIN[cln]>>(10 + 16);  /* SINE IS LEFT ALIGNED */
  212.     if (aScale > 127)         /* Negative values */
  213.     {
  214.       aScale = (0xFF-aScale) + 1; /* Calc absolute value */
  215.       LCD_DrawLine(84-aScale,DisplayPos-(2*cln),aScale,Vertical);
  216.     }
  217.     else  /* Display positive values */
  218.     {
  219.       LCD_DrawLine(84,DisplayPos-(2*cln),aScale,Vertical);
  220.     }
  221.   }/* for */
  222. }




  227. /**
  228.   * @brief  Displays the output array after filtering
  229.   * @param splayPos indicates the beginning Y address on LCD
  230.   * @retval : None
  231.   */
  232. void Out_displayWaveform(uint32_t DisplayPos)
  233. {
  234.   uint8_t aScale;
  235.   uint16_t cln;

  237.   for (cln=0; cln < 64; cln++)    /* original upper limit was 60 */
  238.   {
  239.     aScale = lBUFOUT[cln]>>(10 + 16);  /* SINE IS LEFT ALIGNED */
  240.     if (aScale > 127)         /* Negative values */
  241.     {
  242.       aScale = (0xFF-aScale) + 1; /* Calc absolute value */
  243.       LCD_DrawLine(156-aScale,DisplayPos-(2*cln),aScale,Vertical);
  244.     }
  245.     else  /* Display positive values */
  246.     {
  247.       LCD_DrawLine(156,DisplayPos-(2*cln),aScale,Vertical);
  248.     }
  249.   }/* for */
  250. }



  254. /**
  255.   * @brief  Displays the power magnitude array following a FFT
  256.   * @param splayPos indicates the beginning Y address on LCD
  257.   *   : scale allows to normalize the result for optimal display
  258.   * @retval : None
  259.   */
  260. void displayPowerMag(uint32_t DisplayPos, uint32_t scale)
  261. {
  262.   uint16_t aScale;
  263.   uint16_t cln;

  265.   for (cln=0; cln < 64; cln++)
  266.   {
  267.     /* Clear previous line */
  268.     LCD_SetTextColor(White);
  269.     LCD_DrawLine(120,DisplayPos-(2*cln),72,Vertical);
  270.     /* and go back to normal display mode */
  271.     LCD_SetTextColor(Red);

  273.     aScale =lBUFMAG[cln]>>scale ; /* spectrum is always divided by two */
  274.     /* Power Mag contains only positive values */
  275.     LCD_DrawLine(192-aScale,DisplayPos-(2*cln),aScale,Vertical);
  276.   }/* for */
  277. }



  281. /**
  282.   * @brief  Displays the initial menu and then background frame
  283.   * @param  None
  284.   * @retval : None
  285.   */
  286. void DisplayTitle(void)
  287. {
  288.   uint8_t *ptr = "   STM32 DSP Demo   ";

  290.   LCD_DisplayStringLine(Line0, ptr);

  292.   ptr = " 64-pts Radix-4 FFT ";
  293.   LCD_DisplayStringLine(Line1, ptr);

  295.   ptr = "Press Key to freeze ";
  296.   LCD_DisplayStringLine(Line9, ptr);

  298.   {
  299.     unsigned long long Delay = 0x600000;
  300.     while (Delay--);
  301.     while (GPIO_ReadInputDataBit(GPIOB, GPIO_Pin_9) == 0x00);
  302.   }

  304.   ptr = "   Sine   Dual sine ";
  305.   LCD_DisplayStringLine(Line9, ptr);
  306. }






  313. /**
  314.   * @brief  Inserts a delay time.
  315.   * @param ount: specifies the delay time length (time base 10 ms).
  316.   * @retval : None
  317.   */
  318. void Delay(uint32_t nCount)
  319. {
  320.   /* Configure the systick */
  321.   __enable_irq();
  322.          
  323.      /* Setup SysTick Timer for 10 msec interrupts */
  324.   if (SysTick_Config(SystemFrequency /100)) /* SystemFrequency is defined in
  325.    搒ystem_stm32f10x.h?and equal to HCLK frequency */
  326.    {
  327.     /* Capture error */
  328.      while (1);
  329.     }     
  330.   /* Enable the SysTick Counter */
  331.   TimingDelay = nCount;
  332.    while (TimingDelay )  {}            
  333.    TimingDelay=0;
  334.    __disable_irq();

  336. }




  341. /**
  342.   * @brief  Initializes the DSP lib demo (clock, peripherals and LCD).
  343.   * @param  None
  344.   * @retval : None
  345.   */
  346. void DSPDemoInit(void)
  347. {
  348.   GPIO_InitTypeDef GPIO_InitStructure;
  349.   ErrorStatus HSEStartUpStatus = ERROR;

  351.   /* SYSCLK, HCLK, PCLK2 and PCLK1 configuration -----------------------------*/
  352.   /* RCC system reset(for debug purpose) */
  353.   RCC_DeInit();

  355.   /* Enable HSE */
  356.   RCC_HSEConfig(RCC_HSE_ON);

  358.   /* Wait till HSE is ready */
  359.   HSEStartUpStatus = RCC_WaitForHSEStartUp();

  361.   if(HSEStartUpStatus == SUCCESS)
  362.   {
  363.     /* Enable Prefetch Buffer */
  364.     FLASH_PrefetchBufferCmd(FLASH_PrefetchBuffer_Enable);

  366.     /* Flash 2 wait state */
  367.     FLASH_SetLatency(FLASH_Latency_2);

  369.     /* HCLK = SYSCLK */
  370.     RCC_HCLKConfig(RCC_SYSCLK_Div1);

  372.     /* PCLK2 = HCLK */
  373.     RCC_PCLK2Config(RCC_HCLK_Div1);

  375.     /* PCLK1 = HCLK/2 */
  376.     RCC_PCLK1Config(RCC_HCLK_Div2);

  378.     /* PLLCLK = 8MHz * 9 = 72 MHz */
  379.     RCC_PLLConfig(RCC_PLLSource_HSE_Div1, RCC_PLLMul_9);

  381.     /* Enable PLL */
  382.     RCC_PLLCmd(ENABLE);

  384.     /* Wait till PLL is ready */
  385.     while(RCC_GetFlagStatus(RCC_FLAG_PLLRDY) == RESET)
  386.     {
  387.     }

  389.     /* Select PLL as system clock source */
  390.     RCC_SYSCLKConfig(RCC_SYSCLKSource_PLLCLK);

  392.     /* Wait till PLL is used as system clock source */
  393.     while(RCC_GetSYSCLKSource() != 0x08)
  394.     {
  395.     }
  396.   }

  398.   /* Enable GPIOA, GPIOB, GPIOC, GPIOD, GPIOE and AFIO clocks */
  399.   RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA | RCC_APB2Periph_GPIOB |RCC_APB2Periph_GPIOC
  400.          | RCC_APB2Periph_GPIOD | RCC_APB2Periph_GPIOE | RCC_APB2Periph_AFIO, ENABLE);

  402.   /* TIM1 Periph clock enable */
  403.   RCC_APB2PeriphClockCmd(RCC_APB2Periph_TIM1, ENABLE);
  404.   RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOC, ENABLE);


  407.   /* SPI2 Periph clock enable */
  408.   RCC_APB1PeriphClockCmd(RCC_APB1Periph_SPI2, ENABLE);

  410.   /* TIM2  and TIM4 clocks enable */
  411.   RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2 | RCC_APB1Periph_TIM4, ENABLE);

  413.   /*------------------- Resources Initialization -----------------------------*/
  414.   /* GPIO Configuration */
  415. ……………………

  417. …………限于本文篇幅 余下代码请从51黑下载附件…………
复制代码

所有资料51hei提供下载:
STM32F10x_DSP_fft_V2.0.0.rar (1.48 MB, 下载次数: 37)

评分

参与人数 1黑币 +50 收起 理由
admin + 50 共享资料的黑币奖励！

查看全部评分

回复

使用道具 举报

ID:376076 发表于 2018-7-20 18:05 | 显示全部楼层
这个是用外部输入来进行fft的吗
回复

使用道具 举报

ID:95821 发表于 2018-8-13 09:55 | 显示全部楼层
學習了
回复

使用道具 举报

ID:374525 发表于 2018-8-13 10:24 | 显示全部楼层
学习了
回复

使用道具 举报

返回列表 发新帖
高级模式
B Color Image Link Quote Code Smilies
您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

手机版|小黑屋|51黑电子论坛 |51黑电子论坛6群 QQ 管理员QQ:125739409;技术交流QQ群281945664

Powered by 单片机教程网

快速回复 返回顶部 返回列表