|
本帖最后由 不傷手的立白 于 2019-5-16 13:51 編輯
這個程序可以實(shí)現(xiàn)左轉(zhuǎn)跟右轉(zhuǎn),但是有時候會一直右轉(zhuǎn)或者轉(zhuǎn)彎半徑小而撞到障礙物,完全看不出問題在哪里,好氣啊
if((P0==0xfb)&&(S<17)) //D5檢測到,超聲波小于17cm
{
D3=1;
juli=0;
hou();//后退
delay(1000);
for(f=0;f<3200;f++)
{
R_motor(83);
L_motor(80);
IN1=1;IN2=0;
IN3=0;IN4=1;//右轉(zhuǎn)
DisplayOneChar(12, 0, 'T');
}
qian();//前進(jìn)
DisplayOneChar(12, 0, ' ');
delay(1000);
}
if((P0==0xfd)&&(S<17)) //D3檢測到,超聲波小于17cm
{
D5=1;
juli=0;
hou();//后退
delay(1000);
for(h=0;h<3200;h++)
{
R_motor(83);
L_motor(80);
IN1=0;IN2=1;
IN3=1;IN4=0;//左轉(zhuǎn)
DisplayOneChar(12, 0, 'T');
}
qian();//前進(jìn)
DisplayOneChar(12, 0, ' ');
delay(1000);
}
|
|
|