直接上代码,原理不做多解释了,基本原理就是利用发射一段脉冲出去,然后计算脉冲在空中的来回时间间接测出距离,不同模块的测距范围不一样,本文使用的模块范围在2cm~450cm左右,其他的都在代码里,暂时还没做过多的测试。
SRF05.c
// 超声波测距模块:HY-SRF05
// 精度:3mm→17.6us 62.5us→10.6mm
// 最小测距:2cm→117.6us
// 最大测距:4.5m→26.47ms
// Trig脚触发发射8个40khz的方波,
// us/58=cm或us/148=inch
// 或者距离=高电平时间*声速(340m/s)/2
// 周期60ms
#include "SRF005.h"
sbit Pin_trigger = P3^2;
sbit Pin_echo = P3^4;
static unsigned int EchoTmCount;
static unsigned int setRchoTmDelay;
static unsigned int EchoTmCountBackUp;
/*
33MHz--0.03us
不确定的需要用逻辑分析仪或示波器抓取,
确保>10us
*/
static void SRF005_delay10us()
{
int i=0;
for(i=0; i<1*100/3; i++){ //~14us
}
}
/*
触发信号,10us以上的高电平信号
*/
void SRF005_trigger(void)
{
Pin_trigger = 1;
SRF005_delay10us();
Pin_trigger = 0;
EchoTmCount = 0; //计数清零重新开始
setRchoTmDelay = 85/2; //85ms后再去读echo的高电平时间
}
/*
echo高电平时间计时,放在周期为62,5us的定时器中
*/
void SRF005_EchoCountTm(void)
{
if(Pin_echo){
EchoTmCount++;
}
}
/*
初始化超声波模块
*/
void Initialize_SRF005(void)
{
GPIO_InitTypeDef GPIOinitStruct;
//触发脚
GPIOinitStruct.Mode = GPIO_PullUp; //
GPIOinitStruct.Pin = GPIO_Pin_2 | GPIO_Pin_4;
GPIO_Inilize(GPIO_P3,&GPIOinitStruct);
Pin_trigger = 0;
}
/*
获取超声波测距距离,返回长度,单位cm
*/
unsigned int getEchoTm(void)
{
return (unsigned long)EchoTmCountBackUp*625/580; //us/58=cm
}
/*
获取echo高电平时间计数,延时时间到再赋值
放在2ms计时
*/
void setRchoTm(void)
{
if(setRchoTmDelay){
setRchoTmDelay--;
if(setRchoTmDelay == 0){
EchoTmCountBackUp = EchoTmCount;
}
}
}
SRF05.h
#ifndef _SRF005_H
#define _SRF005_H
#include "stc15w.h"
#include "intrins.h"
#include "GPIO.h"
void SRF005_trigger(void);
void Initialize_SRF005(void);
void SRF005_EchoCountTm(void);
unsigned int getEchoTm(void);
void setRchoTm(void);
#endif