利用单片机驱动液晶屛进行声音定位

ID:120148 · 发表于 2016-5-11 21:28

#include <reg52.h>
#include <math.h>
#define uchar unsigned char
#define uint unsigned int
uchar code table[]="X:";
uchar code table1[]="Y:";
sbit lcden=P1^4;    //液晶使能端
sbit lcdrs=P1^6;    //液晶数据命令选择端
sbit lcdrw=P1^5; //液晶数据的读与写控制
uchar num=0;
uchar flag=0;    //标志位，启动定时器2
uint Ta,Tb,Tc,Td;
uint x=0,y=0;
void delay(uint z)
{
uint m,n;
for(m=z;m>0;m--)
for(n=110;n>0;n--);
}
void Init_ex_int()    //外部中断初始化函数
{
EA=1;
EX0=1;
EX1=1;
IT0=1;       //下降沿触发
IT1=1;
}
//计数器0
void InitTimer0() //初始化函数
{
TMOD=0x05; //设置定时器0工作模式1
TH0=0x0FF; //计数器装初值
TL0=0x0FF;
EA=1;       //开总中断
ET0=1;       //开计数器0中断
TR0=1;       //启动定时器0
}
//计数器1
void InitTimer1()    //初始化函数
{
TMOD=0x50; //设置定时器1工作模式1
TH1=0x0FF;    //计数器装初值
TL1=0x0FF;
EA=1;          //开总中断
ET1=1;       //开定时器1中断
TR1=1;       //启动定时器1
}
//定时器
void InitTimer2()    //初始化函数，打开定时器2
{
TMOD=0x01; //设置定时器2工作模式1
TH2=0;       //定时器装初值
TL2=0;
EA=1;          //开总中断
ET2=1;       //开定时器2中断
TR2=1;       //启动定时器2
}

void write_com(uchar com)    //写命令
{
lcdrs=0;
P2=com;
delay(5);
lcden=1;
delay(5);
lcden=0;
}
void write_data(uint date)    //写数据
{
lcdrs=1;
P2=date;
delay(5);
lcden=1;
delay(5);
lcden=0;
}
void printc(uint cc)    //将阿拉伯数字在液晶上准确显示
{
write_data(cc/100+'0');    //百位
write_data(cc/10%10+'0');    //十位
// prints(".");
write_data(cc%10+'0');       //个位
}
void Initlcd()
{
lcden=0;
write_com(0x38);       //设置16X2显示,5X7点阵,8位数据接口
write_com(0x0c);       //设置开显示，不显示光标
write_com(0x06);       //写一个字符后地址指针加1
write_com(0x01);       //显示清零，数据指针清零
}
void date(uint Ta,uint Tb,uint Tc,uint Td)    //定位算法
{
double m1,n1,m2,n2,b1,b2,c1,c2,c3,c4,d1,d2;    //计算中的中间变量
uint x1,x2,y1,y2;
c1=0.34*(Ta-Tb);       //时间差到距离差单位为毫米
c2=0.34*(Ta-Tc);
c3=0.34*(Tc-Td);
c4=0.34*(Tb-Td);
m1=(4*c2)/(c1*3);
n1=(c1*c2-c2*c2+300*300)/600;    //计算中的中间变量
b1=m1*m1+1-(4*200*200)/(c1*c1);
b2=n1*n1+200*200-(c1*c1)/4;
x1=(int)((sqrt((m1*m1*n1*n1-b1*b2))-m1*n1)/b1);    //第一组想(x,y)
y1=(int)(m1*x1+n1);

m2=4*c4/(3*c3);
n2=(c3*300*300+c3*c4*c4-c4*c3*c3)/(600*c3);
d1=m2*m2+1-(4*200*200)/(c3*c3);
d2=n2*n2-600*n2+300*300+200*200-(c3*c3)/4;
x2=(int)((sqrt((m2*m2*(n2-300)*(n2-300)-d1*d2))-m2*(n2-300))/d1); //第二组(x,y)
y2=(int)(m2*x2+n2);

x=(int)((x1+x2)/2);    //最终的（x,y）(取算数平均值)
      y=(int)((y1+y2)/2);
}
void main()
{
Init_ex_int();
InitTimer0();
InitTimer1();
Initlcd();
TH2=0;    //定时器2装初值
TL2=0;
while(1)
{
if(flag==1)    //第一次外部中断发生后打开T2
            {
write_com(0x85);
write_data('1');
              InitTimer2();
            }
            if(flag==4)    //第四个外部中断发生后关掉所有中断
            {
write_com(0xc5);
write_data('1');
              EA=0;    //关总中断
               ET2=0;       //关定时器2中断
           }
            date( Ta,Tb,Tc,Td);
         // date( 300,250,300,250);
write_com(0x80);       //在1602的第一行上显示X
for(num=0;num<2;num++)
{
write_data(table[num]);
delay(5);
}
         //write_data(48);
printc(x);    //显示X的值
delay(5);
write_com(0x80+0x40);    //在1602的第二行上显示Y
for(num=0;num<2;num++)
{
write_data(table1[num]);
delay(5);
}
printc(y);    //显示Y的值
delay(5);
}
}
void ex_int0() interrupt 0    //外部中断0的中断服务程序
{
EX0=0;    //关闭外部中断0
flag++;
Ta=TH2*256+TL2;    //读取定时器2中的值
}
void ex_int1() interrupt 0    //外部中断1的中断服务程序
{
EX1=0;
   flag++;
Tb=TH2*256+TL2;    //读取定时器2中的值
}
void timer0() interrupt 1    //定时/计数器0中断服务程序
{
ET0=0;       //关定时器0中断
flag++;
Tc=TH2*256+TL2;    //读取定时器2中的值
}
void timer1() interrupt 1    //定时/计数器1中断服务程序
{
ET1=0;          //关定时器1中断
flag++;
Td=TH2*256+TL2;
}

请教大神上面程序哪里出错了，为什么液晶屛上不显示任何东西，拜托拜托！！！！！