超聲波測距

ID:436282 · 發(fā)表于 2018-11-30 09:14

#include<reg51.h>
#include<intrins.h>
#include"lcd.h"

sbit Trig = P2^1;
sbit Echo = P2^0;

unsigned char PuZh[]=" Pechin Science ";
unsigned char code ASCII[15] = {'0','1','2','3','4','5','6','7','8','9','.','-','M'};

static unsigned char DisNum = 0; //顯示用指針
   unsigned int  time=0;
   unsigned long S=0;
   bit    flag =0;
   unsigned char disbuff[4]    ={ 0,0,0,0,};
/*******************************************************************************
* 函數(shù) 名       : main
* 函數(shù)功能          : 主函數(shù)
* 輸入       : 無
* 輸出       : 無
*******************************************************************************/
void Conut(void)
{
   time=TH0*256+TL0;
   TH0=0;
   TL0=0;

   S=(time*1.7)/100;    //算出來是CM
   if((S>=700)||flag==1) //超出測量范圍顯示“-”
   {
   flag=0;

   DisplayOneChar(0, 1, ASCII[11]);
   DisplayOneChar(1, 1, ASCII[10]); //顯示點(diǎn)
   DisplayOneChar(2, 1, ASCII[11]);
   DisplayOneChar(3, 1, ASCII[11]);
   DisplayOneChar(4, 1, ASCII[12]); //顯示M
   }
   else
   {
   disbuff[0]=S%1000/100;
   disbuff[1]=S%1000%100/10;
   disbuff[2]=S%1000%10 %10;
   DisplayOneChar(0, 1, ASCII[disbuff[0]]);
   DisplayOneChar(1, 1, ASCII[10]); //顯示點(diǎn)
   DisplayOneChar(2, 1, ASCII[disbuff[1]]);
   DisplayOneChar(3, 1, ASCII[disbuff[2]]);
   DisplayOneChar(4, 1, ASCII[12]); //顯示M
   }
}

void zd0() interrupt 1       //T0中斷用來計(jì)數(shù)器溢出,超過測距范圍
  {
flag=1;                            //中斷溢出標(biāo)志
  }

void  StartModule()                //啟動(dòng)模塊
  {
   Trig=1;                               //啟動(dòng)一次模塊
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   _nop_();
   Trig=0;
  }

void delayms(unsigned int ms)
{
unsigned char i=100,j;
for(;ms;ms--)
{
      while(--i)
      {
         j=10;
         while(--j);
      }
}
}

void main(void)
{

   TMOD=0x01;          //設(shè)T0為方式1，GATE=1；
   TH0=0;
   TL0=0;
   ET0=1;          //允許T0中斷
   EA=1;             //開啟總中斷

InitLcd1602();
LcdShowStr(0,0,PuZh);
while(1)
{
      StartModule();
      while(!Echo);       //當(dāng)RX為零時(shí)等待
      TR0=1;             //開啟計(jì)數(shù)
      while(Echo);          //當(dāng)RX為1計(jì)數(shù)并等待
      TR0=0;             //關(guān)閉計(jì)數(shù)
      Conut();          //計(jì)算
      delayms(80);
}

}

帳號(hào)		自動(dòng)登錄	找回密碼
密碼			立即注冊(cè)