標題: stm32超聲波程序 通過定時器4計數(shù)器值推算距離Hcsr04GetLength [打印本頁]
作者: 542089130    時間: 2020-12-28 15:43
標題: stm32超聲波程序 通過定時器4計數(shù)器值推算距離Hcsr04GetLength
STM32F103C8T6超聲波程序
  1. #include "delay.h"
  2. #include "sys.h"
  3. #include "usart.h"         
  4. #include "led.h"        
  5. #include "key.h"        


  8. //超聲波硬件接口定義
  9. #define HCSR04_PORT     GPIOB
  10. #define HCSR04_CLK      RCC_APB2Periph_GPIOB
  11. #define HCSR04_TRIG     GPIO_Pin_11
  12. #define HCSR04_ECHO     GPIO_Pin_10



  16. //超聲波計數(shù)
  17. u16 msHcCount = 0;

  19. //定時器4設置
  20. void hcsr04_NVIC()
  21. {
  22.         NVIC_InitTypeDef NVIC_InitStructure;
  23.         NVIC_PriorityGroupConfig(NVIC_PriorityGroup_0);
  24.                         
  25.         NVIC_InitStructure.NVIC_IRQChannel = TIM4_IRQn;            
  26.         NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0;  
  27.         NVIC_InitStructure.NVIC_IRQChannelSubPriority = 3;         
  28.         NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;      
  29.         NVIC_Init(&NVIC_InitStructure);
  30. }

  32. //IO口初始化 及其他初始化
  33. void Hcsr04Init()
  34. {  
  35.     TIM_TimeBaseInitTypeDef  TIM_TimeBaseStructure;   
  36.     GPIO_InitTypeDef GPIO_InitStructure;
  37.     RCC_APB2PeriphClockCmd(HCSR04_CLK, ENABLE);
  38.    
  39.     GPIO_InitStructure.GPIO_Pin =HCSR04_TRIG;      
  40.     GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  41.     GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;
  42.     GPIO_Init(HCSR04_PORT, &GPIO_InitStructure);
  43.     GPIO_ResetBits(HCSR04_PORT,HCSR04_TRIG);
  44.      
  45.     GPIO_InitStructure.GPIO_Pin =   HCSR04_ECHO;     
  46.     GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IN_FLOATING;
  47.     GPIO_Init(HCSR04_PORT, &GPIO_InitStructure);  
  48.     GPIO_ResetBits(HCSR04_PORT,HCSR04_ECHO);   
  49.      
  50.          
  51.     RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM4, ENABLE);   
  52.      
  53.     TIM_DeInit(TIM4);
  54.     TIM_TimeBaseStructure.TIM_Period = (999);
  55.     TIM_TimeBaseStructure.TIM_Prescaler =(71);
  56.     TIM_TimeBaseStructure.TIM_ClockDivision=TIM_CKD_DIV1;
  57.     TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;  
  58.     TIM_TimeBaseInit(TIM4, &TIM_TimeBaseStructure);         
  59.         
  60.     TIM_ClearFlag(TIM4, TIM_FLAG_Update);  
  61.     TIM_ITConfig(TIM4,TIM_IT_Update,ENABLE);   
  62.     TIM_Cmd(TIM4,DISABLE);     
  63. }


  66. //打開定時器4
  67. static void OpenTimerForHc()  
  68. {
  69.    TIM_SetCounter(TIM4,0);
  70.    msHcCount = 0;
  71.    TIM_Cmd(TIM4, ENABLE);
  72. }

  74. //關閉定時器4
  75. static void CloseTimerForHc()   
  76. {
  77.    TIM_Cmd(TIM4, DISABLE);
  78. }

  80. //定時器4終中斷
  81. void TIM4_IRQHandler(void)  
  82. {
  83.    if (TIM_GetITStatus(TIM4, TIM_IT_Update) != RESET)  
  84.    {
  85.                    msHcCount++;
  86.        TIM_ClearITPendingBit(TIM4, TIM_IT_Update  );
  87.       
  88.    }
  89. }


  92. //獲取定時器4計數(shù)器值
  93. u32 GetEchoTimer(void)
  94. {
  95.    u32 t = 0;
  96.    t = msHcCount*1000;
  97.    t += TIM_GetCounter(TIM4);
  98.    TIM4->CNT = 0;  
  99.    delay_ms(50);
  100.    return t;
  101. }

  103. //通過定時器4計數(shù)器值推算距離
  104. float Hcsr04GetLength(void )
  105. {
  106.    u32 t = 0;
  107.    int i = 0;
  108.    float lengthTemp = 0;
  109.    float sum = 0;
  110.    while(i!=5)
  111.    {
  112.       TRIG_Send = 1;      
  113.       delay_us(20);
  114.       TRIG_Send = 0;
  115.       while(ECHO_Reci == 0);      
  116.       OpenTimerForHc();        
  117.       i = i + 1;
  118.       while(ECHO_Reci == 1);
  119.       CloseTimerForHc();        
  120.       t = GetEchoTimer();            
  121.                         lengthTemp = ((float)t*0.034/2);//cm
  122.       sum = lengthTemp + sum ;
  123.         
  124.     }
  125.     lengthTemp = sum/5.0;
  126.     return lengthTemp;
  127. }
  128.          
  129. //測試主函數(shù)
  130. int main(void)
  131. {         
  132.          float length;
  133.          delay_init();                     //延時函數(shù)初始化         
  134.          //NVIC_Configuration();          //設置NVIC中斷分組2:2位搶占優(yōu)先級，2位響應優(yōu)先級
  135.          hcsr04_NVIC();
  136.          uart_init(9600);                 //串口初始化為9600
  137.          Hcsr04Init();
  138.          LED_Init();
  139.    
  140.   // Hcsr04Init();   
  141.         
  142.    while(1)
  143.          {                                         
  144.      length = Hcsr04GetLength();
  145.      printf("距離為:%.3fcm\n",length);
  146.                  if(length<30)
  147.                  {
  148.                                  GPIO_ResetBits(GPIOB,GPIO_Pin_0);               
  149.                  }
  150.                  else
  151.                  {
  152.                          GPIO_SetBits(GPIOB,GPIO_Pin_0);               
  153.                  }
  154.                  delay_ms(50);   
  155.         }                        
  156. }

復制代碼

全部程序51hei下載地址：
超聲波(用).7z (219.34 KB, 下載次數(shù): 135)
作者: 1290153461    時間: 2021-3-12 10:41
網(wǎng)上很多不能用，謝謝樓主！
作者: wifingtta    時間: 2021-3-20 12:50
STM32F103C8T6核心板，可以直接用，程序很好，沒問題，容易移植。謝謝樓主。



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