超声波测距

模块型号HC-RS04

代码如下：

/*Echo接P20，Trig接P21*/
#include<reg52.h>
#include<intrins.h >
typedef unsigned char uchar;
typedef unsigned int uint;
sbit we=P2^7;
sbit du=P2^6;
sbit Re=P2^0;	 //接收信号
sbit Se=P2^1;	 //发射信号

uchar code SMGwe[]={0xfe,0xfd,0xfb};
uchar code SMGdu[]={0x3f,0x06,0x5b,0x4f,0x66,0x6d,0x7d,0x07,0x7f,0x6f,0x40}; 
uchar wat[4]={0,0,0,0};
uint flag=0,t=0,k=0,time;
unsigned long S=0;
/*显示函数，显示三位（米. 秒 毫秒）*/
void display()
{
	du=0;
	if(k==0)
		P0=SMGdu[wat[0]]|0x80; //第一位显示加上小数点
	else
		P0=SMGdu[wat[k]];
	du=1;
	du=0;
	we=0;
	P0=SMGwe[k];
	we=1;
	we=0;
	if(++k>=3)     //三位循环显示，定时器1中断执行显示函数
		k=0;		
}
void timer0() interrupt 1
{
	flag=1;		   //定时器0时间溢出
}
void timer1() interrupt 3
{
	TH1=0xf8 ;	//2ms
	TL1=0xcb;
	display();
	t++;
	if(t>=400)	 //发送间隔800ms
	{
		t=0;
		Se=1;	   //信号发射持续10微秒以上
		_nop_();
		_nop_();
		_nop_();
		_nop_();
		_nop_();
		_nop_();
		_nop_();
		_nop_();
		_nop_();
		_nop_();
		_nop_();
		_nop_();
		_nop_();
		_nop_();
		_nop_();
		_nop_();
		_nop_();
		_nop_();
		_nop_();
		_nop_();
		_nop_();
		Se=0;	  //提供一个10微秒以上的脉冲触发信号
	}
}
/*计算距离*/
void count()
{
	time=TH0*256+TL0; //计算周期 
	TH0=0;//定时器0定时时间清零
	TL0=0;
	S=(float)(time*1.085)*0.017; //计算距离（时间*速度）
	if(S>=700||flag==1)
	{
		flag=0;
		wat[0]=10;
		wat[1]=10;
		wat[2]=10;
	}
	else
	{
		wat[0]=S%1000/100;
		wat[1]=S%100/10;
		wat[2]=S%10;
	}
}
void main()
{
	TMOD=0x11;	//打开定时器1,2 16位工作模式
	TR1=1;
	TH0=0;
	TL0=0;
	TH1=0xf8 ;	//2ms
	TL1=0xcb;
	ET1=1;
	ET0=1;
	EA=1;
	while(1)
	{
		while(!Re);	//接收到信号后开始执行
		TR0=1;		//定时器0开始计数
		while(Re);	//信号接收停止后结束
		TR0=0;		//定时器0结束计数
		count();	//距离计算	
	}	
}

可实现短距离测距