標題: STM32f103的超聲波控制無刷電機源碼 [打印本頁]
作者: 楓葉獨眠    時間: 2018-8-3 20:41
標題: STM32f103的超聲波控制無刷電機源碼
我設置的是離地10cm，電機轉動。

單片機源程序如下:
  1. #include "led.h"
  2. #include "delay.h"
  3. #include "sys.h"
  4. #include "timer.h"
  5. #include "usart.h"
  6. #include "ceju.h"


  9. //接線說明echo-PA0；trig-PA1；vcc接5v
  10. //TM3使超聲波每隔一秒發(fā)送，TM2輸入捕獲。

  12. float Distance;
  13. extern u8  TIM2CH1_CAPTURE_STA;                //輸入捕獲狀態(tài)                                                   
  14. extern u16        TIM2CH1_CAPTURE_VAL;        //輸入捕獲值
  15. int main(void)
  16. {       

  18.         u32 temp=0;
  19.         //NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);// 設置中斷優(yōu)先級分組2
  20.         delay_init();                     //延時函數(shù)初始化       
  21.         uart_init(115200);                                 //9600         
  22.         LED_Init();                          //初始化與LED連接的硬件接口
  23.         GPIO_Config() ;
  24.         TIM3_Int_Init(1999,719);                //一秒發(fā)送一次。4999*2,7199       
  25.         TIM3_Config(1999,719);
  26.         TIM2_Cap_Init(0XFFFF,7199);                //以10khz的頻率計數(shù)  
  27.         ceju_Init();
  28.          TIM_SetCompare1(TIM3,80);       
  29.       TIM_SetCompare2(TIM3,80);
  30.          delay_ms(1500);
  31.          delay_ms(1500);
  32.          delay_ms(1500);
  33.          delay_ms(1500);
  34.   while(1)
  35.         {         
  36.                
  37.                 if(TIM2CH1_CAPTURE_STA&0X80)//成功捕獲到了一次高電平
  38.                 {
  39.                         temp=TIM2CH1_CAPTURE_STA&0X3F;
  40.                         temp*=65536;                                        //溢出時間總和
  41.                         temp+=TIM2CH1_CAPTURE_VAL;                //得到總的高電平時間
  42.                         Distance=temp*5*34*2/200.0;
  43.                         if(Distance>10)
  44.                         {
  45.                                  TIM_SetCompare1(TIM3,135);       
  46.          TIM_SetCompare2(TIM3,135);
  47.                         }
  48.                         else
  49.                         {
  50.                         TIM_SetCompare1(TIM3,88);       
  51.       TIM_SetCompare2(TIM3,88);
  52.                         }
  53.                         //printf("distance:%f cm\r\n",Distance);
  54.                         TIM2CH1_CAPTURE_STA=0;                        //開啟下一次捕獲
  55.                 }
  56.         }
  57. }


復制代碼

所有資料51hei提供下載:
超聲波捕獲測距實驗.rar (292.18 KB, 下載次數(shù): 28)






歡迎光臨 (http://www.torrancerestoration.com/bbs/) Powered by Discuz! X3.1