C语言控制机器人走路的程序
\\\/\\\/设置左右马达参数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);} } } } } } } }
我要做会走路的机器人
为什么要在意别人的眼光，如果随便一个人对你的质疑都会让你心生怀疑，那么你的人生是会很累的。
