超聲波原理簡單測距準確，應用廣泛下面貼一個自己寫的數碼管程序，顯示部分需要改，寫的是我使用的是慧凈開發板，共陰數碼管。

//超聲波模塊程序

//Trig = P2^0

//Echo = P3^2

#include

#define uchar unsigned char

#define uint unsigned int

unsigned char code table［］={0x3f，0x06，0x5b，0x4f，0x66，

0x6d，0x7d，0x07，0x7f，0x6f}; //0-9的碼表

uinttime = 0;

uintTImeH = 0;

uintTImeL = 0;

uint succeed_flag;

sbit dula=P2^0; //段選信號的鎖存器控制

sbit wela=P2^1; //位選信號的鎖存器控制

sbit Trig = P2^2;

sbit Echo = P3^2;

//

void delay（uint z）

{

uint x，y;

for（x=z;x》0;x--）

for（y=125;y》0;y--）;

}

//

void delay_20us（）

{

uchar a ;

for（a=0;a《100;a++）;

}

//***************************************************************

//顯示數據轉換程序

void display（uinttemp）

{

uchar qian，ge，shi，bai;

qian = temp/1000;

bai=temp/100%10;

shi=temp%100/10;

ge=temp%10;

wela=1;

//P0=0xf7;

P0 = 0xfe;

wela=0;

dula=1;

P0=table［qian］;

dula=0;

delay（5）;

wela=1;

//P0=0xf7;

P0 = 0xfd;

wela=0;

dula=1;

P0=table［bai］;

dula=0;

delay（5）;

dula=1;

P0=0x00; //關位碼

dula=0;

wela=1;

//P0=0xef;

P0 = 0xfb;

wela=0;

dula=1;

P0=table［shi］;

dula=0;

delay（5）;

dula=1;

P0=0x00; //關位碼

dula=0;

dula=1;

P0=table［ge］;

dula=0;

wela=1;

//P0=0xdf;

P0 = 0xf7;

wela=0;

delay（5）;

dula=1;

P0=0x00; //關位碼

dula=0;

}

//***************************************************************

void main（）

{

uint distance;

uint test =0;

Trig=0; //首先拉低脈沖輸入引腳

EA=1; //打開總中斷0

TMOD=0x10; //定時器1，16位工作方式

while（1）

{

EA=0; //關總中斷

Trig=1; //超聲波輸入端

delay_20us（）; //延時20us

Trig=0; //產生一個20us的脈沖

while（Echo==0）; //等待Echo回波引腳變高電平

succeed_flag=0; //清測量成功標志

EA=1;

EX0=1; //打開外部中斷0

TH1=0; //定時器1清零

TL1=0; //定時器1清零

TF1=0; //計數溢出標志

TR1=1; //啟動定時器1

delay（20）; //等待測量的結果

TR1=0; //關閉定時器1

EX0=0; //關閉外部中斷0

if（succeed_flag==1）

{

TIme=TImeH*256+timeL;

distance=time*0.172; //厘米

display（distance）;

}

if（succeed_flag==0）

{

distance=0; //沒有回波則清零

test = ！test; //測試燈變化

}

}

}

//***************************************************************

//外部中斷0，用做判斷回波電平

void exter（） interrupt 0 // 外部中斷0是0號

{

timeH =TH1; //取出定時器的值

timeL =TL1; //取出定時器的值

succeed_flag=1;//至成功測量的標志

EX0=0; //關閉外部中斷

}

//****************************************************************

//定時器1中斷，用做超聲波測距計時

void timer1（） interrupt 3 //

{

TH1=0;

TL1=0;

}