C语言控制机器人走路的程序
发布网友
发布时间：2022-05-06 19:02
共2个回答
热心网友
时间：2022-07-01 20:42
void ZYMotor(unsigned char ZState, unsigned char ZSpeed, unsigned char YState, unsigned char YSpeed)
{
SetMotor(_MOTOR_ZuoMotor_, ZState, ZSpeed);
SetMotor(_MOTOR_YouMotor_, YState, YSpeed);
}
//确认各个端口的状态
void ShiBieXian()
{
n=1;
XJ[1]= GetADScable(_SCABLEAD_HB1_);
XJ[2]= GetADScable(_SCABLEAD_HB2_);
XJ[3]= GetADScable(_SCABLEAD_HB3_);
XJ[4]= GetADScable(_SCABLEAD_HB4_);
XJ[5]= GetADScable(_SCABLEAD_HB5_);
while(n<=5)
{
if(XJ[n]>FZ[n])
{HB[n]=0;}
else
{HB[n]=1;}
n++;
}
}
void GoOnLine()
{
if(HB[2]&&HB[3]&&HB[4])
{ZYMotor(0,60,0,60);}
else
{
if(HB[2]&&HB[3])
{ZYMotor(2,20,0,80);}
else
{
if (HB[2])
{ZYMotor(2,50,0,80);}
else
{
if(HB[3]&&HB[4] )
{ZYMotor(0,80,2,20);}
else
{
if(HB[4])
{ZYMotor(0,80,2,50);}
else
{
if (HB[1]&&!HB[2]&&!HB[3]&&!HB[4]&&!HB[5])
{ZYMotor(2, 80, 0, 80);}
else
{
if (!HB[1]&&!HB[2]&&!HB[3]&&!HB[4]&&HB[5])
{ZYMotor(0, 80, 2, 80);}
else
{ZYMotor(0, 60, 0, 60);}
}
}
}
}
}
}
}追问if(HB[2]&&HB[3])是什么意思？
追答如果2号光感与3号光感，在黑线上。 都一年了才追问。。。。
热心网友
时间：2022-07-01 20:42
