基于超声波定位的智能跟随小车 - 图文

电子测量技术第３６卷第１１期ＥＬＥＣＴＲＯＮＩＣＭＥＡＳＵＲＥＭＥＮＴＴＥＣＨＮＯＬＯＧＹ２０１３年１１月基于超声波定位的智能跟随小车＊蔡磊周亭亭郭云鹏陈素芳吴汉帮（长春理工大学光电工程学院长春１３００２２）摘要：设计并实现了一种基于超声波定位、红外避障以及单片机控制的智能跟随小车系统，在开发板ＡＶＲｍｅｇａｌ６上完成了设计的全部功能。通过安装在载物小车顶部的无线电装置和超声波传感器，实时感知载物小车与主人的距离信息，并反馈给单片机用于控制电机的转速与载物小车的姿态。为了提高超声波定位系统的精度，采取了温度补偿措施。基于超声波四点定位系统高精度小盲区的设计使自动跟随小车能够３６０。转弯跟随，加上小车具有避障功能，使小车跟随目标更加精确和智能化。关键词：超声波定位；ＡＶＲｍｅｇａｌ６；温度补偿，智能化中国分类号：ＴＰ２７４文献标识码：Ａ国家标准学科分类代码：Ｄ４２０ＩｎｔｅｌｌｉｇｅｎｔｆｏｌｌｏｗｉｎｇｃａｒｒｉａｇｅｂａｓｅｄｏｎｕｌｔｒａｓｏｎｉｃｐｏｓｉｔｉｏｎｉｎｇＣａｉＬｅｉＺｈｏｕＴｉｎｇｔｉｎｇＧｕｏＹｕｎｐｅｎｇＣｈｅｎＳｕｆａｎｇＷｕＨａｎｂａｎｇ（ＣｏｌｌｅｇｅｏｆＰｈｏｔｏ－ｅｌｅｃｔｒｏｎｉｃＥｎｇｉｎｅｅｒｉｎｇ，ＣｈａｎｇｃｈｕｎＵｎｉｖｅｒｓｉｔｙｏｆＳｃｉｅｎｃｅａｎｄＴｅｃｈｎｏｌｏｇｙ，Ｃｈａｎｇｃｈｕｎ１３００２２，Ｃｈｉｎａ）Ａｂｓｔｒａｃｔ：Ｔｈｉｓｐａｐｅｒｄｅｓｉｇｎｓａｎｄｉｍｐｌｅｍｅｎｔｓａｎｉｎｔｅｌｌｉｇｅｎｔｃａｒｒｉａｇｅｓｙｓｔｅｍｗｈｉｃｈｃａｎｆｏｌｌｏｗｔｈｅｍａｓｔｅｒａｕｔｏｍａｔｉｃａｌｌｙｂａｓｅｄｏｎｕｌｔｒａｓｏｎｉｃｐｏｓｉｔｉｏｎｉｎｇ，ｉｎｆｒａｒｅｄｏｂｓｔａｃｌｅａｖｏｉｄａｎｃｅａｎｄｓｉｎｇｌｅ－ｃｈｉｐｍｉｃｒｏｃｏｍｐｕｔｅｒｃｏｎｔｒ０１．ＩｔｃｏｍｐｌｅｔｓａｌｌｄｅｓｉｇｎｅｄｆｕｎｃｔｉｏｎｓｏｎＡＶＲｍｅｇａｌ６．Ｂｙｔｈｅｕｌｔｒａｓｏｕｎｄｒｅｃｅｉｖｉｎｇｓｅｎｓｏｒａｎｄｉｎｆｒａｒｅｄｓｅｎｓｏｒｉｎｓｔａｌｌｅｄｏｎｔｈｅｔｏｐｏｆｔｈｅｃａｒ。ｔｈｅｃａｒｃａｎｓｅｎｓｅｔｈｅｄｉｓｔａｎｃｅｂｅｔｗｅｅｎｔｈｅｃａｒａｎｄｔｈｅｍａｓｔｅｒａｎｄｔｈｅｉｎｆｏｒｍａｔｉｏｎｏｆｔｈｅａｈｅａｄｏｂｓｔａｃｌｅｓｉｎｒｅａｌ—ｔｉｍｅ，ｔｈｅｎｆｅｅｄｂａｃｋｔｏｔｈｅｓｉｎｇｌｅｃｈｉｐｍｉｃｒｏｃｏｍｐｕｔｅｒｔｏｃｏｎｔｒｏｌｔｈｅｒｏｔａｔｅｓｐｅｅｄｏｆｔｈｅｅｌｅｃｔｒｉｃａｌｍａｃｈｉｎｅａｎｄｔｈｅｐｏｓｔｕｒｅｏｆｔｈｅｃａｒ。Ｉｎｏｒｄｅｒｔｏｉｍｐｒｏｖｅｔｈｅａｃｃｕｒａｃｙｏｆｕｌｔｒａｓｏｎｉｃｐｏｓｉｔｉｏｎｉｎｇｓｙｓｔｅｍ，ａｄｏｐｔｔｅｍｐｅｒａｔｕｒｅｃｏｍｐｅｎｓａｔｉｏｎ。Ｔｈｅｄｅｓｉｇｎｂａｓｅｄｏｎｕｌｔｒａｓｏｎｉｃｐｏｓｉｔｉｏｎｉｎｇｓｙｓｔｅｍａｔｆｏｕｒｐｏｉｎｔｓ，ｗｈｉｃｈｉｓｏｆｈｉｇｈｐｒｅｃｉｓｉｏｎｗｉｔｈｓｍａｌｌｂｌｉｎｄａｒｅａ，ｍａｋｅｓｔｈｅｃａｒｒｉａｇｅｔｈａｔｆｏｌｌｏｗｓｔｈｅｍａｓｔｅｒａｕｔｏｍａｔｉｃａｌｌｙｔｕｒｎ３６０。ｔｏｆｏｌｌｏｗ．Ｉｎａｄｄｉｔｉｏｎ，ｔｈｅｃａｒｒｉａｇｅｈａｓｔｈｅｆｕｎｃｔｉｏｎｏｆｏｂｓｔａｃｌｅａｖｏｉｄａｎｃｅ，ｍａｋｉｎｇｔｈｅｃａｒｒｉａｇｅｆｏｌｌｏｗｔｈｅｍａｓｔｅｒｍｏｒｅａｃｃｕｒａｔｅｌｙａｎｄｉｎｔｅｌｌｉｇｅｎｔｌｙ．Ｋｅｙｗｏｒｄｓ：ｕｌｔｒａｓｏｎｉｃｐｏｓｉｔｉｏｎｉｎｇ；ＡＶＲｍｅｇａｌ６；ｔｅｍｐｅｒａｔｕｒｅｃｏｍｐｅｎｓａｔｉｏｎ；ｉｎｔｅｌｌｉｇｅｎｔｉｚａｔｉｏｎ引言２系统原理及硬件介绍这些年来，小车智能化已是一种主流趋势，然而目前，系统实现了基于ＡＶＲｍｅｇａｌ６单片机的小车智能跟随的功能。为实现小车对目标的智能跟随，采用了超声波定位、无线电通信、红外避障等功能模块设计ｎ］。由于系统采用模块化的设计思想，系统整体的实时性、可靠性都有所提高，并且功耗降低，体积也满足了设计需求。２．１系统原理系统为实现小车自动跟随主人，小车首先向主人发送无线电信号同时小车开始计时，主人接收到无线电信号后向小车发送超声波信号，由于主人距离小车上的４个超声波接收器距离不同，则超声波信号到达４个接收器的时间不同，单片机通过对４个接收器接收超声波时间的比较和收稿日期：２０１３－０６＊基金项目：本项目荣获第四届挑战杯大赛科技类作品长春理工大学一等奖，吉林省特等奖?７６?万方数据１国内市场上暂时还没有出现具有跟随性的智能载物小车。如今中国具有跟随性的产品，主要是有轨机械跟随，用于工厂的各类生产机车的一部分，或是比赛场的有轨跟随拍摄车，并没有实际针对超市、旅馆、飞机场等大众场合，或家庭个人的产品。基于超声波定位及单片机各模块的综合运用，设计了一款能够对特定移动目标进行实时跟踪的智能小车。利用超声波定位技术和跟随性技术可以根据不同场合的跟踪要求设置小车的跟踪距离和跟踪速度等参数，可以实现对移动目标的准确跟踪，帮助携带物品，解放人们双手。蔡磊等：基于超声波定位的智能跟随小车运算，计算出各个超声波接收器到主人的距离。然后基于超声波定位的相应算法，可以计算出主人在小车所建立坐标系中的具体坐标，从而判断主人相对小车的具体方位，并通过ＰＷＭ控制电机转速实现小车按照设定距离跟随目标。小车俯视示意图如图１所示，主人为Ｍ，主人在小车左前方，主人距离小车左侧接收器距离较近，经过ＭＡ路线的时问较短，通过超声波定位，小车判断主人在小车左前方，控制系统向小车左电机发出降低转速信号，右电机加速，小车向左转。小车后２轮驱动，前２轮采用万向轮，通过两侧电机非对称转动及用万向轮实现转向。若主人在其他方向原理相同。第１１期信号时，输出端输出低电平，触发中断，读取定时器计数值，实现测距。超声波发射和接收电路分别如图３和图４所示‘“。Ｒｌ＾Ｉｋｎ图３超声波发射电路ＤＢ图１小车俯视示意２．２硬件设计由于小车需要对周边目标物进行定位，并做出运动控制决策，本设计采用了无线电装置与超声波传感器采集距离信息，并将采集到的数据输送给控制系统，经过控制系统的处理及超声波定位算法可识别目标的方位心］。另外，ＤＳｌ８８２０传感器作为温度补偿单元，使声速等参数更加准确，从而提高超声波定位的精度。小车硬件设计的总体框图如图２所示。系统采用Ｅ１８一Ｄ８０ＮＫ反射式接近开关传感器，它是一种集红外线发射与接收于一体的轻便型传感器，用以检测小车运动范围内有无障碍物。另外，该传感器有一个灵敏度调节旋钮，可以调节传感器触发的距离。有效探测距离在２０～８００ｍｍ可调。为了实现小车对目标物的同步跟随，在小车和目标物上安装了无线电装置。无线电为小车的反馈信号，使得超声波发射模块向小车发射超声波信号。系统采用的无线电模块ＮＲＦ２４Ｌ０１是一款工作在２．４～２．５ＧＨｚ世界通用ＩＳＭ频段的单片机无线电收发器芯片。无线电收发器包括：频率发生器、功率放大器、晶振振荡器、调制器、解调器、输出功率、频道选择等，其通信距离为０～８００ｍ。ＧＮＤ图４超声波接收电路对电机转速的控制，是通过ＰＷＭ波实现的，ＰＷＭ的图２小车硬件设计一个优点是从处理器到被控系统信号都是数字形式的，无需进行数模转换，让信号保持为数字形式可将噪声影响降到最小口１。电机驱动电路为一个由分立元件制作的直流电动机可逆双极型桥式驱动器，其功率元件由４支Ｎ沟道功率ＭＯＳＦＥＴ管组成，额定工作电流可以轻易达１００Ａ以上，大大提高了电动机的工作转矩和转速，电机驱动电路如图５所示。基于超声波定位原理，在小车顶部设置４个超声波接收器，超声波信号由目标物发出。考虑到单片机端口驱动能力有限［３］，采用ＬＭ３８６芯片对输出信号进行功率放大，用于超声波发射。接收模块采用集成芯片ＣＸ２０１０６，声波信号先经过ＣＸ２０１０６内部前置放大器和限幅放大器，再经整形，送给输出端。当收到与滤波器中心频率相符的声波?７７?万方数据第３６卷电子Ｏ．５测Ｖ量技术：ＧＮＤ图５电机驱动电路３核心技术系统主要有３大核心技术：超声波测距技术、定位技术及红外避障技术。３．１超声波测距超声波测距是超声波定位的基础，超声波测距的原理为［６１：检测从超声波发射器发出的超声波经气体介质的传播到接收器的时间，即渡越时间。渡越时间与气体中的声速相乘，结果就是声波传输的距离Ｓ。即：Ｓ—ｕｔ３．２定位技术将被定位点作为发射点，设置４个接收点作为参照点，一次发射得到４个距离。根据空间位置计算出发射点相对于参照点的坐标。按此构思¨］，可构建如下系统：超声波接收点布置４个，构成矩形，为了方便，假设该矩形就是正方形，边长为Ｓ，顺时针编号。０号为坐标原点（ｏ，ｏ），１号为（ｏ，Ｓ），２号为（Ｓ，Ｓ），３号为（Ｓ，０）。计算时先根据直角三角形算出投射到移动物体平面的距离，斜边为测距值，高为一个直角边。小车对目标定位原理图如图６所示。就是超声波测距的机理。声速受温度影响口３，声速与温度关系：式中：Ｔ为温度，单位是℃。声速与温度关系表如表１所示‘“。表１声速与温度关系（Ｓ研（ｓ，ｏ）图６小车对目标定位原理移动节点的坐标为（ｚ，ｙ），经推导得到：可见，只要测得超声波发射和接收的时间差ｔ以及环境温度Ｔ，就能得到较为精确的距离。（３）?７８?万方数据蔡磊等：基于超声波定位的智能跟随小车第１１期ｘ，一孚＋气导ｙ：一萼＋与｝ｘ：一萼＋与导可以减少误差。（４）４?２误差分析４．２．１误差来源引起小车不同距离下响应时间不同的因素有很多，一（５）般可以归结为如３种主要误差”ｏＪ：１）超声波信号在传播过程中的衰减（６）超声波信号在传播过程中，随着检测距离的增大，声波信号减弱，导致声波信号检测难度加大，测距精度降低。２）收到声波到被检测出的滞后该项误差源于检测电路的灵敏度和判断偏差，从收到实际声波到电路确认并输出相应信号肯定存在滞后，这和声波信号强弱、检测电路原理及判断电路的敏感性相关，也是超声波测距的核心。如果超声波传感器灵敏度过低，大大限制了检测距离（声波衰减是距离的平方关系）。由于判断滞后会随着声波的强弱而变化，故这部分误差是导致数据不稳定的主要来源。３）启动计时和启动超声波发射之间的偏差由系统原理可知，从小车启动计时到主人启动超声波通过以上４个测量值可以得到２组坐标，将２组平均３．３红外避障在小车运动过程中，红外发射器发射出一定频率的红外线，当检测方向遇到障碍物时，红外线反射回来被接收管接收，经过比较器电路处理后，绿色指示灯会亮起，同时信号输出接口输出数字信号（１个低电平信号），通过读取该接口的电平信号可判断前方是否有障碍物ｑ。４系统测试与误差分析系统测试本实验是用来测试小车的响应特性，可通过不同距离发射实际上是先后完成的，存在时差，距离越远时差越大。４．２．２减小测量误差措施声波检测采用ＴＬ８５２电路，其最大特征在于变增益，它支持通过控制将增益逐渐变大，这样可以利用单片机根据时间去控制。随着距离加大，时间变长，声波信号减弱，就需要提高增益，以检出信号。此外，针对测量距离较远时声波不易进入接收头问题，可采用在一个平面内设置多个接收的办法。同时为弥补超声波在传播过程中的衰减，增大发射功率或发射的持续时间也是有必要的。对于启动计时和启动超声波发射之间的偏差，系统采用无线电作为反馈信号，其传播速度接近光速，因此启动计时和启动超声波发射之间的偏差可忽略不计。５４．１下小车的反应时间来衡量。由于超声波速度受温度影响很大，故该实验是将小车（实物图如图７所示）。结论介绍了基于超声波定位的自动跟随小车系统，运用超声波传感器及无线电装置实现小车的实时跟随，并采用红外避障传感器实现小车自动避障的功能，使小车的跟随更加安全和智能化。通过实验验证，小车反应时间为几十ｍｓ至ｌＳ左右，能与主人保持５ｍ以内距离的同步跟随。并且系统采用充电电池、电机驱动，不排放尾图７小车实物气，具有清洁环保、简单智能、成本低廉、方便实用的特点。小车应用范围广泛，可应用于超市、飞机场、高尔夫置于２０６Ｃ的环境下进行，尽可能排除外界因素对实验球场等公共场合。的干扰，然后通过改变主人与小车之间的距离，可得小车的响应时间如表２所示。表２不同检测距离下小车的响应时间参考文献［１］邹恩，陈乐欢，林锦钱，等．基于ＣＡＮ总线的智能超声波测距车载系统Ｉ－Ｊ］．湖南工业大学学报，２０１１（３）：６７－７１．（下转第１０５页）?７９?万方数据