直接上代码,原理不做多解释了,基本原理就是利用发射一段脉冲出去,然后计算脉冲在空中的来回时间间接测出距离,不同模块的测距范围不一样,本文使用的模块范围在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; /