探头数量在循迹问题上探讨和实践.docVIP

探头数量在循迹问题上探讨和实践 　　【摘要】机器人循迹比赛（即按照白场地画黑线或黑场地画白线运行）是机器人竞赛项目一个主要内容，以光电管循迹的机器人为主。光电管循迹的机器人转弯在线路为圆弧和钝角时循迹比较容易，而对于直角或锐角来说，光电管机器人很容易冲出轨迹线而失控。本文仅讨论有轮机器车在采用不同循迹方案时最简单的光电管组合和最好的循迹效果并付诸实践，本文的讨论不涉及程序以及程序优化问题。 　　【关键词】光电探头；循迹方法 　　1.问题的提出 　　在许多的场地机器人比赛的项目中，机器人循迹运行是非常为普遍的一个项目。为了循迹准确和防止机器人小车冲出线路需要做许多黑白检测电路来进行循迹，按照目前的文章和实物可以见到的循迹多为多红外光电对管电路（以下简称探头）进行循迹，有如下几种组合形式（投影示意图），如图1所示： 　　可能还有更多种探测形式，但思路多是以更多的探头来进行更多点的检测线路已达到更精确的循迹控制，已见到的有5～13个探头阵列，在小车机器人的前后各安放一列，再加上防冲出探测头已超过10个循迹探头，使得MPU的I/O口用量增加，程序编制和控制策略更加复杂。 　　如何采用最少的探头同样达到较佳的探测和循迹是本文讨论的主要问题。 　　2.方案设计 　　为了讨论解决上述提出的问题，我们采用了以下几种方案进行设计和制作。 　　2.1 方案设计 　　按照循迹的基本原理，我们提出三种可能情况以便设计方案：黑白（白黑）探测、双边界探测、单边界探测等三个基本讨论点。 　　2.2 黑白探测 　　本文采用了以下方案循迹：①双探头跨在寻线两端（2枚探头）、②多探头两边在线外，中间的在线内（一行4枚探头）、③前三角（3枚探头和4枚探头，本文为后者）、④菱形（4枚探头）。 　　2.3 双边界探测 　　这种探测也是较为经典的设计依据，本文采用了⑤左右双探头（4枚探头）、⑥前后左右双探头（8枚探头），两个方案。如果有多余探头空置不用。 　　2.4 单边界探测 　　仅考虑黑白（白黑）边界为依据进行循迹，本文采用了⑦单探头、⑧前双探头、⑨前后双探头（4枚探???），三个方案。 　　2.5 机器小车介绍 　　小车采用前后左2电机和右2电机分别独立控制，旋转中心就是小车的中心如图2所示。 　　为了讨论方便，我们在小车的投影图上设置了A’、A、B、C、D、E、F，5个位置，在这些位置上安放了探头，同时小车在转弯时，我们让其左右两侧的电机组同步反转，使小车可以于原地转圈的方式进行转弯，以便开展讨论。 　　2.6 场地介绍 　　本次测试采用全国职业院校2010机器人竞赛——机器人设计与制作测试比赛场地。本次比赛场地采用黑场地之间铺有30mm宽的白线，场地投影见图3（图中单位为mm）： 　　3.方案的实践 　　本文的重点是采用最少的探头达到较佳的循迹效果，所以我们先对方案进行筛选。 　　限于篇幅，筛选和讨论过程省略，本次实践测试采用了①③⑤⑦⑧等5个方案进行实践探讨，而在实践过程中，我们发现方案③⑦⑧效果较好，因此本文仅对方案③⑦⑧进行讨论。 　　在测试和讨论过程，探头的灵敏度调节只保证能区分黑与白的灵敏度（忽略探头反馈线路信号是连续变化的这一特点），只有0、1数字量的信号、探头探测距离固定为10～15mm之间，一律采用自制的RPR220反射型红外发射接收对管电路。 　　在这些方案中，方案③为前三角形探头接法，分别在A、A’、B、D四点上接入探头；方案⑦为单探头接法，仅仅在A’单点上接入一个探头；方案⑧为双探头，在A’（或A）点上接入两个对称探头；这样共有4种实践接法。 　　在这些接法中，有几个参数是可变的，调整距离将影响探测结果。图4中，L1表示B、D点两枚探头之间的距离（即循迹线的宽度），图4中L2表示两枚探头之间的距离，（分别在循迹线和场地之间的宽度），L3表述前探头与后边的探头之间的距离。下图4描述的就是这三种探头接法与小车中心关系的示意图。 　　3.1 对于方案③讨论 　　方案③循迹原理：A’的探头在循线中，B、D探头在循线外，A一定在循线中，小车加速前进，当A’在循线外，减速前行，当B或D探头在循线内，则向右或向左拐弯（原地转向），直到A进入循线后慢速前进并继续转弯，而当A’进入循线后，加速前进。 　　方案③有4个探头，互相之间的距离对循迹影响比较大。其影响主要表现在A’与C的距离问题上，A’与C过近则减速距离太短，容易冲出循线，过长则会使转弯探测半径增大，转弯时间增加，进而影响速度。本次实际设计中L3≈80mm，L3’≈30mm，L1≈70mm。 　　3.2 对于方案⑦讨论 　　方案⑦循迹原理：A’永远反黑白运动。小车前进一小步，如果探头由黑变到白，则小车向黑色区域转弯，然后前进一小步；