STM32F1控制US-100串口超聲波測距源碼

ID:398656 · 發(fā)表于 2018-10-20 11:39

STM32F1控制US-100串口超聲波測距

單片機(jī)源程序如下:

#include "usart-ultrasonic.h"
#include "usart.h"
#include "SysTick.h"
//超聲波測距，獲取一次測量值
u16 Ultrasonic_ranging()
{
u16 range=0;
usart_r=256;
USART_SendData(USART1,'U');
while(usart_r==256);
range+=usart_r*256; usart_r=256;
while(usart_r==256);
range+=usart_r; usart_r=256;
return range;
}
//超聲波測距，多次測量濾波
//參數(shù)是測量次數(shù)
u16 Ultrasonic_ranging_s(u8 time)
{
u16 range=0,refer_range=0,sum_range=0,return_range=0;
u8 num=0;
range=Ultrasonic_ranging(); //先測一次得到參考值
if((range>19)&&(range<4000))//當(dāng)參考值大于19小于4000時正確
{
refer_range=range;
for(;time>0;time--) //多測幾次，矯正參考值
{
range=Ultrasonic_ranging();
if((range>19)&&(range<4000)&&((refer_range-range<10)||(range-refer_range<10)))//測量值在20到4000之間，且偏離參考值不超過10
{
sum_range+=range;
num++;
refer_range=(refer_range+range)/2;//用有效測量值矯正參考值
}
delay_ms(10);//消除余波的干擾
}
return_range=(sum_range+refer_range)/(num+1);//把參考值和多次測量得到的有效值取算數(shù)平均數(shù)，作為返回值；
return return_range;
}
else{ return 0; }//如果超出4000mm返回0
}