新闻中心

EEPW首页>嵌入式系统>设计应用> 智能小车循迹记时测速程序

智能小车循迹记时测速程序

作者: 时间:2016-12-02 来源:网络 收藏

while(1)
{
if(P10==0&&P11==0&&P12==0)
{
TR0=0; //显示时间 停
P0=d[0];
P2=0XFE;
delay(1);
P0=d[3];
P2=0XFB;
delay(3);

P0=d[2]; //显示测速 停
P2=0XFD;
delay(3);
P0=d[3];
P2=0XF7;
delay(3);
P14=1;P15=1;P16=1; P17=1;
}
}
}
void timer1() interrupt 3 //中断 服务程序
{
unsigned int qq=0,ww=0;
TH1=0XFc;
TL1=0X18;//1ms
i++;
switch(i%4)
{
case 0:P0=c[0],P2=0XFE;d[0]=c[0];break;
case 1:P0=c[1],P2=0XFD;d[1]=c[1];break;
case 2:P0=c[2],P2=0XFB;d[2]=c[2]; break;
case 3:P0=c[3],P2=0XF7;d[3]=c[3]; break;
default:break;
}
P14=1;P15=1;P16=1; P17=1;

if(P10==0&&P11==0&&P12==0)//全测到
dr=0;
if(P10==1&&P11==0&&P12==1)//中间测到
dr=1;
if(P10==0&&P11==1&&P12==1) //左边测到
dr=2;
if(P10==1&&P11==1&&P12==0) //右边测到
dr=3;
if(P10==0&&P11==0&&P12==1) //左两测到
dr=4;
if(P10==1&&P11==0&&P12==0) //右两测到
dr=5;

switch(dr)
{
case 0:P14=1,P15=1,P16=1,P17=1,TR1=0;break; //全测到 停

case 1:P14=0,P15=1,P16=0,P17=1;break; //直走

case 2:P14=1,P15=1,P16=0,P17=1,ww=1;break; //左拐

case 3:P14=0,P15=1,P16=1,P17=1,qq=1;break; //右拐

case 4:P14=1,P15=0,P16=0,P17=1,ww=1;break; //左两测到 左拐

case 5:P14=0,P15=1,P16=1,P17=0,qq=1;break; //右两测到 右拐
}
/*跑出跑道外记忆 回到跑道内 */
if(dr==2&&ww==1||dr==4&&ww==1) //单边或双边 测到跑出去
{
qq=0;
P14=1;P15=1;P16=0;P17=1;
}
if(dr==3&&qq==1||dr==5&&qq==1)
{
ww=0;
P14=0;P15=1;P16=1;P17=1;
}

if(i==1000) //1s
{
kop=TH0;//计数器计入脉冲
kop=kop<<8;
kop=kop+TL0;
kop=kop*15;
c[3]=a[kop/10];
c[2]=a[kop%10];
time++;
c[1]=a[time/10];
c[0]=a[time%10];
i=0;
TH0=0;
TL0=0;
}
}


上一页 1 2 下一页

评论


技术专区

关闭