本帖最后由 不傷手的立白 于 2019-5-16 13:51 編輯
這個程序可以實現左轉跟右轉，但是有時候會一直右轉或者轉彎半徑小而撞到障礙物，完全看不出問題在哪里，好氣啊
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;//右轉
DisplayOneChar(12, 0, 'T');
}
qian();//前進
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;//左轉
DisplayOneChar(12, 0, 'T');
}
qian();//前進
DisplayOneChar(12, 0, ' ');
delay(1000);
}
|
|
