STM32超聲波測(cè)距，溫度補(bǔ)償，近距離報(bào)警源程序

使用STM32F103ZET6芯片，HC-SR04超聲波傳感器。通過(guò)內(nèi)部溫度傳感器測(cè)量出實(shí)際室溫溫度，從而確定在該室溫溫度下聲音的傳播的實(shí)際速度。使測(cè)量的結(jié)果更加的準(zhǔn)確。通過(guò)usart1將數(shù)據(jù)發(fā)送到串口調(diào)試助手上面，部分代碼如下

#include "wave.h"
#include "sys.h"
#include "delay.h"
#include "usart.h"
#include "sensor.h"
#define Trig GPIO_Pin_4
#define Echo GPIO_Pin_6
float Distance;
u8 i=0;
float b;
  u16 adcx;
float temp;
float temperate;
  float c;
void Wave_SRD_Init(void)
{
GPIO_InitTypeDef  GPIO_InitSture;
EXTI_InitTypeDef  EXTI_InitSture;
NVIC_InitTypeDef  NVIC_InitSture;
//如果外部中斷的話則一定使能AFIO復(fù)用功能
RCC_APB2PeriphClockCmd(RCC_APB2Periph_AFIO|RCC_APB2Periph_GPIOA,ENABLE);


//配置IO端口
GPIO_InitSture.GPIO_Mode=GPIO_Mode_Out_PP;   //推挽輸出模式
GPIO_InitSture.GPIO_Pin=Trig;                //將PE4于Trig相連
GPIO_InitSture.GPIO_Speed=GPIO_Speed_50MHz;  
GPIO_Init(GPIOE,&GPIO_InitSture);

GPIO_InitSture.GPIO_Mode=GPIO_Mode_IPD;      //拉輸入模式
GPIO_InitSture.GPIO_Pin=Echo;                //將PE6于Echo相連
GPIO_InitSture.GPIO_Speed=GPIO_Speed_50MHz;  
GPIO_Init(GPIOE,&GPIO_InitSture);

//中斷和6端口映射一起
GPIO_EXTILineConfig(GPIO_PortSourceGPIOE,GPIO_PinSource6);

//外部中斷配置
EXTI_InitSture.EXTI_Line=EXTI_Line6;
EXTI_InitSture.EXTI_LineCmd=ENABLE;
EXTI_InitSture.EXTI_Mode=EXTI_Mode_Interrupt;
EXTI_InitSture.EXTI_Trigger=EXTI_Trigger_Rising;
EXTI_Init(&EXTI_InitSture);


//中斷優(yōu)先級(jí)管理
NVIC_InitSture.NVIC_IRQChannel=EXTI9_5_IRQn;
NVIC_InitSture.NVIC_IRQChannelCmd=ENABLE;
NVIC_InitSture.NVIC_IRQChannelPreemptionPriority=2;
NVIC_InitSture.NVIC_IRQChannelSubPriority=2;
NVIC_Init(&NVIC_InitSture);
}
   
void EXTI9_5_IRQHandler(void)
{
delay_us(10);

  

if(EXTI_GetITStatus(EXTI_Line6)!=RESET)
{
  
  TIM_SetCounter(TIM3,0);
  TIM_Cmd(TIM3,ENABLE);
  
  while(GPIO_ReadInputDataBit(GPIOE,Echo));  //等待低電平
  
  TIM_Cmd(TIM3,DISABLE);
  

  adcx=T_Get_Adc_Average(ADC_CH_TEMP,5);
  temp=(float)adcx*(3.3/4096);
  temperate=(1.43-temp)/0.0043+25;    //計(jì)算出當(dāng)前溫度值
    c=331.45+0.61*temperate;        //計(jì)算出當(dāng)前溫度下得聲速
  Distance=TIM_GetCounter(TIM3)*c/200.0; //溫度補(bǔ)償后的超聲波距離
  if(Distance>0)
  {
   i++;
   b=b+Distance;
   while(i==40)
   {
    b=b/40;
    printf("Distance:%.1f cm\r\n",b);
    printf("Temperature:%.1f ℃\r\n",temperate);
    i=0;
    b=0;
   
   }
   
   
  
  }
   
  EXTI_ClearITPendingBit(EXTI_Line6);
}
}
void Wave_SRD_Strat(void)
{
GPIO_SetBits(GPIOE,Trig);   //將Trig設(shè)置為高電平
delay_us(20);               //持續(xù)大于10us觸發(fā)，觸發(fā)超聲波模塊工作
GPIO_ResetBits(GPIOE,Trig);

}


超聲波測(cè)距，報(bào)警，溫度補(bǔ)償.7z (200.25 KB, 下載次數(shù): 105)

2020-2-1 17:44 上傳

點(diǎn)擊文件名下載附件
下載積分: 黑幣 -5