智能循迹小车C程序(完美-详尽)

智能循迹小车C程序(完美-详尽)

ID:47072653

大小:47.00 KB

页数:7页

时间:2019-07-16

智能循迹小车C程序(完美-详尽)_第1页
智能循迹小车C程序(完美-详尽)_第2页
智能循迹小车C程序(完美-详尽)_第3页
智能循迹小车C程序(完美-详尽)_第4页
智能循迹小车C程序(完美-详尽)_第5页
资源描述:

《智能循迹小车C程序(完美-详尽)》由会员上传分享,免费在线阅读,更多相关内容在行业资料-天天文库

1、/*-----------------------------------------------------------------------------小车运行主程序---------------------------------------------------------------------------简介:@模块组成:红外对管检测模块----五组对管,五个信号采集端口直流电机驱动模块----驱动两个直流电机,另一个轮子用万向轮单片机最小系统------用于烧写程序,控制智能小车运动@

2、功能简介:在白色地面或皮质上用黑色胶带粘贴出路线路径宽度微大于相邻检测管间距。这样小车便可在其上循迹运行。@补充说明:该程序采取“右优先”的原则:即右边有黑线向右转,若无,前方有黑线,向前走,若无,左边有黑线,向左转,若全无,从右方向后转。程序开头定义的变量的取值是根据我的小车所调试选择好的,如果采用本程序,请自行调试适合自己小车的合适参数值。编者:陈尧,黄永刚(江苏大学电气学院二年级,三年级)1.假定:IN1=1,IN3=1时电机正向转动,必须保证本条件2.假定:遇到白线输出0,遇到黑线输出1;如果实

3、际电路是:遇到白线输出1,遇到黑线输出0,这种情况下只需要将第四,第五句改成:#definem01#definem10即可。3.说明1:直行---------------速度full_speed_left,full_speed_right.转弯,调头速度------correct_speed_left,correct_speed_right.微小校正时---------高速轮full_speed_left,full_speed_right;低速轮correct_speed.可以通过调节第六,七,八,九,

4、十条程序,改变各个状态下的占空比(Dutycycle),以求达到合适的转弯,直行速度4.lenth----------length检测到黑线到启动转动的时间间隔5.width----------mid3在黑线上到脱离黑线的时间差6.mid3-----------作为判断中心位置是否进入黑线的标志,由于运行的粗糙性和惯性,常取其他对管的输出信号作为判断条件7.check_right----若先检测到左边黑线,并且左边已出黑线,判断右端是否压黑线时间拖延---------------------------

5、-------------------------------------------------------------------------------------*/#include#defineucharunsignedchar#defineuintunsignedint#definem01//黑线m1,白线m0#definem10#definefull_speed_left40//方便调节各个状态的占空比,可用参数组:(30,35,6,25,30,68000,

6、27000,500);#definefull_speed_right45//(40,45,6,25,30,68000,27000,500);#definecorrect_speed6//校正时的低速轮的占空比#defineturn_speed_left25#defineturn_speed_right30#definelenth68000//测试数据:10000--》100--》500--》2000--80000--76000--68000#definewidth27000//500--》10-->20

7、00--》60000--30000---》27000#definecheck_right500//2000--》20--》200--》500#definemidlleft1#definemidrright5ucharDuty_left,Duty_right,i=0,j=0;//左右占空比标志,取1--100sbitIN1=P2^0;sbitIN2=P2^1;sbitIN3=P2^2;sbitIN4=P2^3;sbitENA=P1^0;sbitENB=P1^1;//循迹口五组红外对管,依次对应从左往右第1

8、,2,3,4,5五组sbitleft1=P1^6;sbitleft2=P1^5;sbitmid3=P1^4;sbitright4=P1^3;sbitright5=P1^2;voidline_left();voidline_right();voidline_straight()reentrant;//----------------------------------------voiddelay(longintDelay_time)//延时

当前文档最多预览五页,下载文档查看全文

此文档下载收益归作者所有

当前文档最多预览五页,下载文档查看全文
温馨提示:
1. 部分包含数学公式或PPT动画的文件,查看预览时可能会显示错乱或异常,文件下载后无此问题,请放心下载。
2. 本文档由用户上传,版权归属用户,天天文库负责整理代发布。如果您对本文档版权有争议请及时联系客服。
3. 下载前请仔细阅读文档内容,确认文档内容符合您的需求后进行下载,若出现内容与标题不符可向本站投诉处理。
4. 下载文档时可能由于网络波动等原因无法下载或下载错误,付费完成后未能成功下载的用户请联系客服处理。