|
既然有人有兴趣。那我就把控制逻辑程序发给大家看看咯
while(1)
{
if(Z1==0&&Y1==1)//Y1,Z1 是红外传感器,左右两个,并排在一起,而且都要能包含再黑线内,0为在黑线内,1是线外
{
if(flag3)
{
A2=0;//左轮子的速度
B2=C+30;//右轮子的速度
flagb=0;//flag都是逻辑标志
}
else
{flag1=1;
flag2=0;
B2=C;
A2=C+30;}
}
/****************/
if(Y1==0&&flag1)
{flag3=0;
B2=0;A2=C+20;
if(flagb)
flag3=1;
}
/*******************************/
if(Y1==0&&Z1==1)
{
if(flag4)
{
B2=0;
A2=C+30;
flagb=0;
}
else
{ flag2=1;
flag1=0;
A2=C;
B2=C+30;}
}
/************/
if(Z1==0&&flag2)
{
flag4=0;
A2=0;B2=C+20;
if(flagb)
flag4=1;
}
while(Z1==1&&Y1==1)
{
B2=C+30;
A2=C+30;
flag1=0;
flag2=0;
flag3=0;
flag4=0;
flagb=1;
}
} |
|