智能小车红外避障c语言程1

《智能小车红外避障c语言程1》由会员上传分享，免费在线阅读，更多相关内容在行业资料-天天文库。

1、智能小车红外避障c语言程序#includebitRandomFactor=0;bitRandomFactorBuf=0;#include#defineFLeftMotorP0_2=1;P0_3=0#defineBLeftMotorP0_2=0;P0_3=1#defineFRightMotorP0_5=1;P0_4=0#defineBRightMotorP0_5=0;P0_4=1#defineLeftStop   P0_2=0;P0_3=0#defineRightStop  P0_4=0;P0_5=0#defineCarStopP0_2=0;P0_

2、3=0;P0_4=0;P0_5=0#defineRightSenserP0_0#defineLeftSenserP0_1//********************************************************//左转//********************************************************voidTurnLeft_1(){LeftStop;FRightMotor;}//********************************************************//快速左转//***********

3、*********************************************voidTurnLeft_Fast(){BLeftMotor;FRightMotor;}//********************************************************//右转//********************************************************voidTurnRight_1(){RightStop;FLeftMotor;}//*********************************************

4、***********//快速右转//********************************************************voidTurnRight_Fast(){BRightMotor;FLeftMotor;}//********************************************************//用倒退的方式进行车头右转//********************************************************voidBTurnRight_1(){LeftStop;BRightMotor;}//***

5、*****************************************************//用倒退的方式进行车头左转//********************************************************voidBTurnLeft_1(){RightStop;BLeftMotor;}//********************************************************//前进//********************************************************voidFCar(){

6、FLeftMotor;FRightMotor;}//********************************************************//后退//********************************************************voidBCar(){BLeftMotor;BRightMotor;}//********************************************************//壁障程序//***************************************************

7、*****voidObstacle_Avoid(void){if(RightSenser&&LeftSenser&&PWM){  FCar();}if((!RightSenser)&&LeftSenser&&PWM){  BTurnLeft_1();}if(RightSenser&&(!LeftSenser)&&PWM){  BTurnRight_1();   }if(!(RightSenser

8、

9、LeftSenser)){    Random