单片机超声波测距，用的HC-SR04 下面程序显示的三位测距结果，我想显示四位该怎么... -

#include <reg52.h>
#include <intrins.h>
#include "eepom52.h"
#define uchar unsigned char
#define uint unsigned int</div><div>//数码管段选定义 0 1 2 3 4 5 6 7 8 9
uchar code smg_du[]={0xc0,0xf9,0xa4,0xb0,0x99,0x92,0x82,0xf8,0x80,0x90,
0x88,0x83,0xc6,0xa1,0x86,0x8e,0xff}; //断码
//数码管位选定义
uchar code smg_we[]={0xe0,0xd0,0xb0,0x70};
uchar dis_smg[8] ={0xc0,0xf9,0xa4,0xb0,0x99,0x92,0x82,0xf8};</div><div>sbit smg_we1 = P3^4; //数码管位选定义
sbit smg_we2 = P3^5;
sbit smg_we3 = P3^6;
sbit smg_we4 = P3^7;</div><div>sbit c_send = P3^2; //超声波发射
sbit c_recive = P3^3; //超声波接收
uchar flag_hc_value; //超声波中间变量</div><div>sbit beep = P2^3; //蜂鸣器IO口定义
bit flag_key_b_en,flag_key_set_en; //按键蜂鸣器使能</div><div>
uchar smg_i = 3; //显示数码管的个位数
bit flag_300ms ;</div><div>bit key_500ms ;</div><div>
long distance; //距离
uint set_d; //距离
bit flag_csb_juli; //超声波超出量程
uint flag_time0; //用来保存定时器0的时候的</div><div>// 按键的IO变量的定义
uchar key_can; //按键值的变量
uchar zd_break_en,zd_break_value; //自动退出设置界面
uchar menu_shudu = 10; //用来控制连加的速度
bit flag_lj_en; //按键连加使能
bit flag_lj_3_en; //按键连3次连加后使能加的数就越大了
uchar key_time,flag_value; //用做连加的中间变量
uchar menu_1; //菜单设计的变量
uchar a_a;</div><div>
/***********************1ms延时函数*****************************/
void delay_1ms(uint q)
{
uint i,j;
for(i=0;i<q;i++)
for(j=0;j<120;j++);
}</div><div>/***********************处理距离函数****************************/
void smg_display()
{
dis_smg[0] = smg_du[distance % 10];
dis_smg[1] = smg_du[distance / 10 % 10];
dis_smg[2] = smg_du[distance / 100 % 10] & 0x7f;
}</div><div>/******************把数据保存到单片机内部eepom中******************/
void write_eepom()
{
SectorErase(0x2000);
byte_write(0x2000, set_d % 256);
byte_write(0x2001, set_d / 256);
byte_write(0x2058, a_a);
}</div><div>/******************把数据从单片机内部eepom中读出来*****************/
void read_eepom()
{
set_d = byte_read(0x2001);
set_d <<= 8;
set_d |= byte_read(0x2000);
a_a = byte_read(0x2058);
}</div><div>/**************开机自检eepom初始化*****************/
void init_eepom()
{
read_eepom(); //先读
if(a_a != 1) //新的单片机初始单片机内问EEPOM
{
set_d = 100;
a_a = 1;
write_eepom();
}
}
/****************独立按键处理函数********************/
void key()
{
static uchar key_new = 0,key_old = 0,key_value = 0;
if(key_new == 0)
{ //按键松开的时候做松手检测
if((P2 & 0x07) == 0x07)
key_value ++;
else
key_value = 0;
if(key_value >= 5)
{
key_value = 0;
key_new = 1;
flag_lj_en = 0; //关闭连加使能
flag_lj_3_en = 0; //关闭3秒后使能
flag_value = 0; //清零
key_time = 0;
write_eepom();
}
}
else
{
if((P2 & 0x07) != 0x07)
key_value ++; //按键按下的时候
else
key_value = 0;
if(key_value >= 5)
{
key_value = 0;
key_new = 0;
flag_lj_en = 1; //连加使能
zd_break_en = 1; //自动退出设置界使能
zd_break_value = 0; //自动退出设置界变量清零
flag_key_b_en = 1; //按键蜂鸣器使能
}
}
key_can = 20;
if(key_500ms == 1) //连加
{
key_500ms = 0;
key_new = 0;
key_old = 1;
zd_break_value = 0;
}
if((key_new == 0) && (key_old == 1))
{
switch(P2 & 0x07)
{
case 0x06: key_can = 3; break; //得到k2键值
case 0x05: key_can = 2; break; //得到k3键值
case 0x03: key_can = 1; break; //得到k4键值
}
// dis_smg[3] = smg_du[key_can % 10];</div><div> }
key_old = key_new;
}</div><div>
void smg_we_switch(uchar i)
{
switch(i)
{
case 0: smg_we1 = 0; smg_we2 = 1; smg_we3 = 1; smg_we4 = 1; break;
case 1: smg_we1 = 1; smg_we2 = 0; smg_we3 = 1; smg_we4 = 1; break;
case 2: smg_we1 = 1; smg_we2 = 1; smg_we3 = 0; smg_we4 = 1; break;
case 3: smg_we1 = 1; smg_we2 = 1; smg_we3 = 1; smg_we4 = 0; break;
}
}</div><div>/***********************数码显示函数*****************************/
void display()
{
static uchar i;
i++;
if(i >= smg_i)
i = 0;
// P1 = 0xff; //段选
// P3 = 0xf0 | (P3 & 0x0f); //位选
// P3 = smg_we[i] | (P3 & 0x0f); //位选
smg_we_switch(i);
P1 = dis_smg[i]; //段选 </div><div>}</div><div>void delay()
{
_nop_(); //执行一条_nop_()指令就是1us
_nop_();
_nop_();
_nop_();
_nop_();
_nop_();
_nop_();
}</div><div>
/*********************超声波测距程序*****************************/
void send_wave()
{
c_send = 1; //10us的高电平触发
delay();
c_send = 0;
TH0 = 0; //给定时器0清零
TL0 = 0;
TR0 = 0; //关定时器0定时
flag_hc_value = 0;
while(!c_recive); //当c_recive为零时等待
TR0=1;
while(c_recive) //当c_recive为1计数并等待
{
flag_time0 = TH0 * 256 + TL0;
if((flag_hc_value > 1) || (flag_time0 > 65000)) //当超声波超过测量范围时，显示3个888
{
TR0 = 0;
flag_csb_juli = 2;
distance = 888;
flag_hc_value = 0;
break ;
}
else
{
flag_csb_juli = 1;
}
}
if(flag_csb_juli == 1)
{
TR0=0; //关定时器0定时
distance = TH0; //读出定时器0的时间
distance = distance * 256 + TL0;
distance +=( flag_hc_value * 65536);//算出超声波测距的时间得到单位是ms
distance *= 0.017; // 0.017 = 340M / 2 = 170M = 0.017M 算出来是米
if(distance > 350) //距离 = 速度 * 时间
{
distance = 888; //如果大于3.8m就超出超声波的量程
}
}
}</div><div>
/*********************定时器0、定时器1初始化******************/
void time_init()
{
EA = 1; //开总中断
TMOD = 0X11; //定时器0、定时器1工作方式1
ET0 = 1; //开定时器0中断
TR0 = 1; //允许定时器0定时
ET1 = 1; //开定时器1中断
TR1 = 1; //允许定时器1定时
}</div><div>/****************按键处理数码管显示函数***************/
void key_with()
{
if(key_can == 1)
{
menu_1 ++;
if(menu_1 >= 2)
{
menu_1 = 0;
}
if(menu_1 == 0)
{
menu_shudu = 20;
dis_smg[0] = smg_du[distance % 10];
dis_smg[1] = smg_du[distance / 10 % 10] ;
dis_smg[2] = smg_du[distance / 100 % 10] & 0x7f;
smg_i = 3;
}
if(menu_1 == 1)
{
menu_shudu = 1;
dis_smg[0] = smg_du[set_d % 10];
dis_smg[1] = smg_du[set_d / 10 % 10];
dis_smg[2] = smg_du[set_d / 100 % 10] & 0x7f ;
dis_smg[3] = 0x88;
smg_i = 4;
}
}
if(menu_1 == 1) //设置高温报警
{
if(flag_lj_3_en == 0) //三次连加之后速度加快
menu_shudu = 10 ; //500ms 加减一次
else
menu_shudu = 1; //250ms 加减一次
if(key_can == 2)
{
set_d ++ ; //按键按下未松开自动加三次
if(set_d > 350)
set_d = 350;
dis_smg[0] = smg_du[set_d % 10]; //取小数显示
dis_smg[1] = smg_du[set_d / 10 % 10] ; //取个位显示
dis_smg[2] = smg_du[set_d / 100 % 10] & 0x7f; //取十位显示
dis_smg[3] = 0x88; //a
}
if(key_can == 3)
{
set_d -- ; //按键按下未松开自动加三次
if(set_d <= 1)
set_d = 1;
dis_smg[0] = smg_du[set_d % 10]; //取小数显示
dis_smg[1] = smg_du[set_d / 10 % 10] ; //取个位显示
dis_smg[2] = smg_du[set_d / 100 % 10] & 0x7f ; //取十位显示
dis_smg[3] = 0x88; //a
}
// write_eepom();
}
} </div><div>/****************报警函数***************/
void clock_h_l()
{
static uchar value;
if(distance <= set_d)
{
value ++; //消除实际距离在设定距离左右变化时的干扰
if(value >= 5)
{
beep = ~beep; //蜂鸣器报警
}
}
else
{
value = 0;
beep = 1; //取消报警
}
}</div><div>/****************按键按下蜂鸣器响下**********************/
void key_beep()
{
static uint value;
if((flag_key_b_en == 1) && (flag_key_set_en == 1))
{
beep = 0; //打开蜂鸣器
value ++;
if(value > 800)
{
value = 0;
flag_key_b_en = 0;
beep = 1;//关闭蜂鸣器
}
}
}</div><div>
void main()
{
send_wave(); //测距离函数
smg_display(); //处理距离显示函数
time_init();
init_eepom(); //读eepom数据
while(1)
{
if(flag_300ms == 1)
{
flag_300ms = 0;
clock_h_l(); //报警函数
send_wave(); //测距离函数
if(menu_1 == 0)
smg_display(); //处理距离显示函数
if(zd_break_en == 1) //自动退出设置界面程序
{
zd_break_value ++; //每300ms加一次
if(zd_break_value > 100) //30秒后自动退出设置界面
{
menu_1 = 0; //
smg_i = 3;
zd_break_en = 0;
zd_break_value = 0;
}
}
}
key(); //按键函数
if(key_can < 10)
{
key_with(); //按键处理函数
}
}
}</div><div>
/*********************定时器0中断服务程序用做超声波测距的************************/
void time0_int() interrupt 1
{
set_d ++; // TH0 TL0 到65536后溢出中断
} </div><div>/*********************定时器0中断服务程序************************/
void time1_int() interrupt 3
{
static uchar value; //定时10ms中断一次
TH1 = 0xf8;
TL1 = 0x30; //2ms
display(); //数码管显示函数
value++;
if(value >= 150)
{
value = 0;
flag_300ms = 1;
}
if(value % 25 == 0)
{
if(flag_lj_en == 1) //按下按键使能 50ms
{
key_time ++;
if(key_time >= menu_shudu) //500ms
{
key_time = 0;
key_500ms = 1; //500ms
flag_value ++;
if(flag_value >= 3)
{
flag_value = 10;
flag_lj_3_en = 1; //3次后1.5秒后连加大些
}
}
}
}
}

复制代码