单片机控制小车循迹(前进、后退、左右转)

整理文档很辛苦,赏杯茶钱您下走!

免费阅读已结束,点击下载阅读编辑剩下 ...

阅读已结束,您可以下载文档离线阅读编辑

资源描述

/************************************************************************控制小车循迹前进、后退、左转、右转、停止前进简单程序作者:eagle200901Email:eagle200901@live.com*************************************************************************/#includereg52.h#defineucharunsignedchar#defineuintunsignedintsbitP10=P1^0;//Controltheleftmotorforwardlowerlevelisvalid;左电机前进,低电平有效sbitP11=P1^1;//controltheleftmotorbackward左电机后退sbitP12=P1^2;//controltherightmotorforward右电机前进sbitP13=P1^3;//controltherightmotorbackward右电机后退sbitLtra14=P1^4;//trackontheleft左循迹sbitMtra15=P1^5;//trackinthemiddle中间循迹sbitRtra16=P1^6;//trackontheright右循迹voidadvance()/*前进*/{P10=0;P11=1;P12=0;P13=1;}voidgoback(){P10=1;P11=0;P12=1;P13=0;}voidTurnLeft(){P10=1;P11=1;P12=0;P13=1;}voidTurnRight(){P10=0;P11=1;P12=1;P13=1;}voidStop(){P10=1;P11=1;P12=1;P13=1;}voidmain(){while(1){if(Ltra14==0&&Mtra15==0&&Rtra16==0||Ltra14==0&&Mtra15==1&Rtra16==0)advance();if(Ltra14==1&&Mtra15==0&&Rtra16==0)TurnLeft();if(Ltra14==0&&Mtra15==0&&Rtra16==1)TurnRight();if(Ltra14==0&&Mtra15==1&&Rtra16==1)Stop();}}我比较懒得输入法切换,所以就直接用英语注释,为了初学者看得懂,才加了中文。o(∩_∩)o...哈哈。希望对初学者有帮助!

1 / 2
下载文档,编辑使用

©2015-2020 m.777doc.com 三七文档.

备案号:鲁ICP备2024069028号-1 客服联系 QQ:2149211541

×
保存成功