SR04超声波测距不准确怎么破~~~~(>_<)~~~~

#include

#define LCD P0

***it E = P2^7;

***it RS = P2^6;

***it RW = P2^5;

***it Trig=P1^7;

***it Echo=P3^2;//外部中断0

unsigned char code display_1[] = "  Measuring...  ";

unsigned char code display_2[] ="Distance:   . cm";

unsigned char code display_3[] =">4m    ";

unsigned char code display_4[] =">4mTEST";

float l=0;//长度设为全局变量

unsigned char A1=48,B1=48,C1=48,D1=48;

unsigned int a,b,c,d;

void display_dian();

void display_cm();

void LCD_Com(unsigned char x);

void LCD_Data(unsigned char x);

void delay(unsigned int x);

void Init1();

void timer();

void measure();

void Int_0();

void display_toolong();

void Cal_abcd();

void display_a();

void display_b();

void display_c();

void display_d();

void main()

{       

        unsigned char i;

       

        Init1();

       

        EA=1;         //打开总中断

        Int_0();

        Timer();

        //固定的显示

        LCD_Com (0x80);//设置数据指针起点

        for(i=0;i<16;i++)

                LCD_Data(display_1[i]);

        LCD_Com (0xc0);//设置数据指针起点

        for(i=0;i<16;i++)

                LCD_Data(display_2[i]);

       

        //显示初始000.0cm

        LCD_Com (0xc9);//设置数据指针起点

        LCD_Data(A1),LCD_Data(B1),LCD_Data(C1);

        LCD_Com (0xcd);//设置数据指针起点

        LCD_Data(D1);

  

  //测量开始

        while(1){

                measure();

                A1=a;

                B1=b;

                C1=c;

                D1=d;

                delay(60);

        }

       

       

}

void LCD_Com(unsigned char x)//写命令

{

        RS = 0;

        RW = 0;

        LCD = x;

        delay(10);

        E = 1;

        delay(10);

        E = 0;

}

void LCD_Data(unsigned char x)//写数据

{

        RS = 1;

        RW = 0;

        LCD = x;

        delay(10);

        E = 1;

        delay(10);

        E = 0;

}

void Init1()

{

        LCD_Com (0x38);//设置显示模式

        LCD_Com (0x0c);//开显示不显示光标，光标不闪烁

        LCD_Com (0x06);//写一个指针加1

        LCD_Com (0x01);//清屏

        LCD_Com (0x80);//设置数据指针起点

}

void delay(unsigned int x)

{

   unsigned int i, j;

            for(i = x; i > 0; i--)

            for(j = 110; j > 0; j--)

                        ;

}

void measure()

{

        TH0=0X00;//设置初始值

        TL0=0X00;

        Trig=1;

        delay(1);

        Trig=0;

        while(Echo==1)

                ;

        TR0=1;         //打开定时器0

}

//外部中断设置

void Int_0()

{

        IT0=1;//外部中断0跳变沿触发方式（下降沿）

        EX0=1;//打开INT0的中断允许

}

//定时器设置

void Timer()

{

        TMOD=0X01;//定时器0选择工作方式1

        ET0=1;         //打开定时器0中断

        TR0=0;         //关闭定时器0

}

//外部中断0(计算长度)

void Cal_1() interrupt 0

{

        l=(TH0*256+TL0)*1.0851/58;

        l=l*10;

        TR0=0;//关闭定时器

        if(l<4000)

        {        Cal_abcd();

                        display_a();

                if(b!=B1)

                        display_b();

                if(c!=C1)

                        display_c();

                display_dian();

                if(d!=D1)

                        display_d();

                display_cm();

        }

        else  display_toolong();//显示超量程

}

//定时器中断0

void Timer_0() interrupt 1

{

        unsigned char k;

        LCD_Com (0xc9);//设置数据指针起点

        for(k=0;k<7;k++)

                LCD_Data(display_4[k]);//显示超量程

        TR0=0;         //关闭定时器0

}

//在量程范围内,计算a,b,c,d

void Cal_abcd()

{

        a=(unsigned char)((l/1000)+48);

        b=(unsigned char)((l-(a-48)*1000)/100+48);

        c=(unsigned char)((l-(a-48)*1000-(b-48)*100)/10+48);

        d=(unsigned char)((l-(a-48)*1000-(b-48)*100-(c-48)*10)+48);

}

//超出量程

void display_toolong()  

{

        unsigned char j;

        LCD_Com (0xc9);//设置数据指针起点

        for(j=0;j<7;j++)

                LCD_Data(display_3[j]);

}

void display_a()

{

        LCD_Com (0xc9);//设置数据指针起点

        LCD_Data(a);

}

void display_b()

{

        LCD_Com (0xca);//设置数据指针起点

        LCD_Data(b);

}

void display_c()

{

        LCD_Com (0xcb);//设置数据指针起点

        LCD_Data(c);

}

void display_d()

{

        LCD_Com (0xcd);//设置数据指针起点

        LCD_Data(d);

}

void display_cm()

{

        LCD_Com (0xce);//设置数据指针起点

        LCD_Data('c');

        LCD_Data('m');

}

void display_dian()

{

        LCD_Com (0xcc);//设置数据指针起点

        LCD_Data('.');

}