標(biāo)題: 超聲波測距程序（keil 4) [打印本頁]
作者: zybcays123...    時(shí)間: 2017-7-15 20:54
標(biāo)題: 超聲波測距程序（keil 4)
#include "reg52.h"
typedef unsigned char u8;
typedef unsigned int u16;
//3-8譯碼器控制數(shù)碼管段選
sbit LSA=P2^2;
sbit LSB=P2^3;
sbit LSC=P2^4;
//超聲波模塊激勵(lì)和響應(yīng)
sbit Trig=P1^0;
sbit Echo=P3^2;
//數(shù)碼管顯示
u8 smgduan[]={0x3f,0x06,0x5b,0x4f,0x66,0x6d,0x7d,0x07,0x7f,0x6f};
u8 Disp[4];
u16 dat=0;

//延時(shí)函數(shù)
void delay(u16 i)
{
      while(i--);
}

//定時(shí)器初始化
void TimeInit()
{
    EA=1;
    ET0=1;
    TR0=1;
    TMOD=0x09;
    TH0=0;
    TL0=0;
}

//外部中斷初始化
void ExInit()
{
       EA=1;
    EX0=1;
    IT0=1;
}

//數(shù)據(jù)處理函數(shù)
void DataPros()
{
    Disp[0]=smgduan[dat/1000]|0x80;
    Disp[1]=smgduan[dat%1000/100];
    Disp[2]=smgduan[dat%100/10];
    Disp[3]=smgduan[dat%10];
}

//數(shù)碼管顯示函數(shù)
void DataDisp()
{
   u8 i;
   for(i=0;i<4;i++)
   {
        switch(i)
     {
            case(0):
          LSA=0;LSB=0;LSC=0;break;
      case(1):
          LSA=1;LSB=0;LSC=0;break;
      case(2):
          LSA=0;LSB=1;LSC=0;break;
      case(3):
          LSA=1;LSB=1;LSC=0;break;
     }
     P0=Disp[i];
     delay(100);
     P0=0x00;
   }
}

//主函數(shù)
void main()
{
     TimeInit();
    ExInit();
    while(1)
    {
          Echo=0;
    Trig=1;
    delay(1);
    Trig=0;
    DataPros();
    DataDisp();
    }  
}

//定時(shí)器中斷
void Inter1() interrupt 1
{      
}

//外部中斷0
void Inter0() interrupt 0
{
     u8 dat1,dat2;
  dat1=TH0;
  dat2=TL0;
  dat=dat1;
  dat<<=8;
  dat=dat|dat2;
  TH0=0;
  TL0=0;
  dat=(dat*0.34)/2+0.5;
}




歡迎光臨 (http://www.torrancerestoration.com/bbs/) Powered by Discuz! X3.1