技术中心

产品推荐:水表|超声波流量计|压力变送器|热电偶|液位计|冷热冲击试验箱|水质分析仪|光谱仪


您现在的位置  >仪表网>仪表技术 > 应用设计

采用超声波的移动机器人导航设计方法

分享
2013年01月30日 15:01
A- A+
来源:

  摘要:采用新型的超声波传感器,设计并开发基于ARM9与嵌入式linux为平台的轮式移动机器人平台的下的未知环境的避障导航系统。本文重点介绍该超声波传感器的实现原理以及在机器人平台中的整个软件实现流程以及控制机器人行走的实现方法。
  
  1、引言
  
  在项目开发中采用从英国进口的SRF05超声波传感器,它的回波反馈与测距方式与通常使用的超声波传感器相比较特别,在ARM中实现也稍有难度,但该传感器精度很高可达到1cm,因此用该传感器去掉了用于近距离测距的红外测距模块节约了硬件资源。
  
  该机器人的zui小系统为,触摸屏模块,超声波模块,摄像头图像采集模块,直流电机闭环控制系统,在整个系统中测距是zui总要的一环,它直接影响电机运行距离的精度,在有效范围内的图像采集控制。整个系统都是在ARM9与linux平台中完成,每个模块都是用设备驱动的方式实现使得模块的控制更加方便。
  
  2、SRF05超声波测距方法
  
  提供一个10us的脉冲触发超声波传感器,SRF05会发出8个周期的频率为40khz的超频脉冲,此时在echo也是就回波口上的电平变为高,此时定时器开始计时,等到echo变为低电平证明有障碍物此时停止计时,高脉冲的宽度有测距的距离成正比,该超声波的有效测距范围为1cm~4m,因此如果没有障碍物或障碍物大于4m,echo依然会变为低电平此时定时器的时间为30ms,因此在测距时定时器的周期应大于30ms这样才能有效测距。
  
  原理如图1所示。
  
  3、超声波测距软件实现
  
  如图2为超声波测距的流程图。
  
  3.1回波检测的采集方法
  
  超声波的回波的检测是个难点,因为在ARM中一个端口设置中断只能设置一种触发方式,如果设为上升沿触发可以打开定时器定时但无法捕获下降沿,也就无法关闭定时器,从而不能测距,因此用软件的方式实现。首先设置两个时间延迟函数usdelay()和msdelay(),这样可以在给出高脉冲10us后等超声波触发再打开定时期计时,在设置一个外部中断eint1接到超声波传感器的echo口并设置为下降沿触发,等下降沿来临关闭定时器读出值既为脉宽的时间长度,然后根据障碍物的距离=(ECHO高电平的时间)*声纳速度/2得出距离。空气中v与温度关系:v=331.5√1+T/273m/s,T为摄氏温度。一般情况下超声波速近似声速,在室内温度影响下取约343.2m/s.
  
  3.2超声波触发的实现
  
  利用数字示波器设计一个软件计时函数usdelay,具体实现如下。
  
  则usdelay(1)既为10us,该函数用于在给出激发高脉冲后延续10us然后关脉冲。
  
  还要设计一个msdelay()用于控制整个测距周期的时间值。
  
  msdelay(1000)在主函数数中用于延迟1s,这样定时器可以*有足够的回波检测时间同时也不会对其它三路超声波信号造成干扰。
  
  如下所示。
  
  3.3超声波回波检测的实现
  
  回波检测计算脉宽的时间需要用到定时器和外部中断,外部中断接超声波的echo并设置为下降沿触发。定时器的初始化如下。
  
  rTCFG0=0x9595;//预分频值为95
  
  rTCFG1=0x00000;//分割值1/2
  
  rTCNTB0=10000;/
  
  根据T=[TCNTB0*(TCFG0+1)*(1/TCFG1)]/50MHZ得出定时器的周期为60ms在这个时间段里足以计算回波时间。
  
  外部中断1初始化如下
  
  rGPFCON=0xaa;//GPF1设置为EINT1
  
  rINTMOD=0x0;//设置为普通中断
  
  rGPFUP=0xf;//禁止GPF0上拉电阻
  
  pISR_EINT1=(unsigned)Eint1Handler;//建立中断向量
  
  EnableIrq(BIT_EINT1);//使能中断
  
  rEXTINT0=0x492;//EINT1下降沿触发
  
  根据T=[TCNTB0*(TCFG0+1)*(1/TCFG1)]/50MHZ得出定时器的周期为60ms在这个时间段里足以计算回波时间。
  
  3.4在外部中断中计算机距离
  
  3.5循环控制与轮询测距
  
  由于超声波之间有干扰,采用轮询的方式依次打开超声波,每次只测一个,这样可以有效地避免干扰,为了提高实时性可以控制定时器周期,比如设置为35ms,这样四路超声波轮询一次大约为140ms,足以满足实时要求。
  
  4、机器人控制的实现
  
  图3为利用超声波的反馈信息控制机器人直流电机闭环系统的总体结构图。
  
  linux系统中超声波传感器为只读的字符设备,具体应用为在应用程序下打开超声波设备,然后在驱动中测距,测得的数据传到应用程序,应用程序中有超声波的避障算法,根据算法判断障碍物的位置给直流电机控制信号进行避障导航。
  
  触摸屏中的图形界面中含有机器人的指令设置,可以设置运行速度,图像采集与超声波模块的打开与关闭,是否开启机器人模糊算法运行轨迹还是使用普通的PID调节,这使得机器人有很多种方案可以选择。
  
  机器人的每一次行为都是根据超声波传感器测得的值和当前机器人运行的即时速度来来给出将要运行的时间,在遇到障碍物时(0<t<30us等于30微秒时达到超声波的zui大探测距离),开启摄像头图像采集模块,这时摄像头会拍下障碍物的图像,并利用无线MODEM把图像传回控制电脑,这样用户就可以知道前方是什么障碍物,该系统实现了移动机器人的自主避障和采集障碍物信息的作用,可以用来探测未知环境。
  
  5、结论
  
  本文采用新型的超声波传感器,在ARM9与嵌入式linux为平台的移动机器人上实现了超声波的测距,并利用超声波传感器控制运动系统和图像采集系统。该机器人目前已经成功应用与本项目的开发并取得良好的效果。
  
  本文创新点:采用一种精度高的新型超声波传感器,用软件方法克服了它在ARM9中不利于检测回波的问题,成功应用于移动机器人的运行轨迹控制,使得机器人无论在行走和图像采集的即时性上都得到了很大的高。

版权与免责声明
  • 凡本网注明“来源:仪表网”的所有作品,均为浙江兴旺宝明通网络有限公司-仪表网合法拥有版权或有权使用的作品,未经本网授权不得转载、摘编或利用其它方式使用上述作品。已经本网授权使用作品的,应在授权范围内使用,并注明“来源:仪表网”。违反上述声明者,本网将追究其相关法律责任。
  • 本网转载并注明自其它来源(非仪表网)的作品,目的在于传递更多信息,并不代表本网赞同其观点或和对其真实性负责,不承担此类作品侵权行为的直接责任及连带责任。其他媒体、网站或个人从本网转载时,必须保留本网注明的作品第一来源,并自负版权等法律责任。
  • 如涉及作品内容、版权等问题,请在作品发表之日起一周内与本网联系,否则视为放弃相关权利。

热点排行

媒体平台


仪表站,帮你做
生意的APP

微信公众号新浪微博投稿联系媒体合作建议反馈


新手指南
了解仪表网卖家注册买家注册操作指南手机版仪表网
旗下子站
流量仪表温度仪表压力仪表液位仪表气体检测工控仪表
站点导航
找资讯找企业找产品找展会找品牌
本站服务
会员服务企业建站广告服务SEO优化兴旺通在线投诉

返回首页