按照順序執(zhí)行后，第一個電機正常，但是第二個電機不轉(zhuǎn)，相應(yīng)if語句里燈的變化正常，求問是怎么回事
捕獲.PNG (86.08 KB, 下載次數(shù): 36)
下載附件
2020-5-27 16:24 上傳
void jiance()
{ GPIO_MOTOR=0x99;
while(1)
{
if(p00==0&&p01==0&&p03==1&&L3==0) //p00檢測到有托盤要進入 ,p01檢測內(nèi)部沒有托盤，p02檢測內(nèi)部沒有零部件
{
L1=1; //L1表示當前工位內(nèi)部有托盤，開始工作
L2=0; //L2不亮不啟用p02
SETP_MOTOR_QZ(); //前端正轉(zhuǎn)
delay(10);
}
if(p00==1&&p01==1&&p03==1&&L1==1&&L2==0&&L3==0) //p00檢測到?jīng)]有托盤要進入 ,p01檢測內(nèi)部有，p02檢測沒有且已經(jīng)打開過前端開關(guān)
{
SETP_MOTOR_QF(); //前端反轉(zhuǎn) ，防止后邊托盤進入
delay(10);
L2=1; //L2亮p02 起作用
}
if(p03==1&&L1==1&&L2==1&&L3==0) //p00檢測到?jīng)]有托盤要進入,p01檢測內(nèi)部有，p02檢測內(nèi)部沒有零部件
{
if(p02==0)
{
SETP_MOTOR_QZ(); //后端正轉(zhuǎn) ,直接離開
delay(10);
}
elseL3=1;
}
if(L3==1&&K3==0)
{ // (p00==1&&p01==0&&p02==0&&p03==1)p00
SETP_MOTOR_HZ(); //后端正轉(zhuǎn)
delay(10);
L3=0;
}
if(p00==1&&p03==0) //p00檢測到?jīng)]有托盤要進入 ,p01檢測內(nèi)部沒有，p02檢測內(nèi)部沒有零部件，p03檢測已經(jīng)離開
{
SETP_MOTOR_QF();
L1=0;
L2=0;
delay(10);
}
}
return;
}
|
100 黑幣
QQ好友和群
QQ空間
騰訊微博
騰訊朋友
收藏
淘帖
頂
踩
