datasheet

基于DSP的多超声测距数据采集处理系统

2008-03-27来源: www.chinaaet.com 关键字:超声传感器  测距传感器  DSP  外部中断  上位机  核心处理器  北京航空航天大学出

  摘 要:介绍了自行设计的移动机器人CASIA-I中超声测距系统的软、硬件,以及超声测距数据与上位机通信的设计和实现过程。该系统以DSP—TMS320LP2407A作为核心处理器,以CAN总线为基础,实现了上述功能。经实验验证,测距范围为0.45m~3.5m,系统测距精度在0.7%以内,可以满足移动机器人室内导航的要求。

  关键词:移动机器人 DSP 超声测距 CAN总线通讯

  

  移动机器人要实现在未知和不确定环境下运行,必须具备自动导航和避障功能。在移动机器人的导航系统中,传感器起着举足轻重的作用。视觉、激光、红外、超声传感器[1]等都在实际系统中得到了广泛的应用。其中,超声波传感器以其信息处理简单、速度快和价格低,被广泛用作移动机器人的测距传感器,以实现避障、定位、环境建模和导航等功能。

  传统的轮式移动机器人超声数据采集系统大多采用单片机作为微处理器,以此来测量移动机器人到障碍物的距离,并将距离通过串口传输到上位机。采用这种设计,系统制作简单、成本低。但是,对于多超声传感器测距系统,如果仍采用单片机来完成测距任务,由于系统中超声传感器数量较多,为保证系统的实时性,就需要多个单片机才能完成数据采集,这使得采集系统不可避免地存在设计复杂和一些算法难以实现等缺陷。随着微电子工艺的发展,数字信号处理器(DSP)的应用领域已从通信行业拓展到工业控制领域。TI公司推出的TMS320LF2407A是专门针对控制领域应用的DSP,它具有高速信号处理和数字控制功能所必需

  的体系结构,其指令执行速度高达40MIPS,且大部分的指令都可以在一个25ns的单周期内执行完毕。另外,它还具有非常强大的片内I/0端口和其它外围设备,可以简化外围电路设计,降低系统成本。正是基于这种思想,中国科学院自动化研究所在国家“863”计划的支持下,利用多DSP和嵌入式PCI04自行设计和研制了轮式移动机器人CASIA-I。本文着重介绍其超声数据采集系统,同时对通过CAN总线完成的超声数据与上位机通讯的原理和设计过程进行分析说明,并给出实验结果。

  1超声测距原理

  超声测距的原理较简单,一般采用渡越时间法[1],即:

  D=ct/2 (1)

  其中D为移动机器人与被测障碍物之间的距离,c为声波在介质中的传输速率。声波在空气中传输速率为[1]:

  

  

  

  其中,T为绝对温度,c。=331.4m/s。在不要求测距精度很高的情况下,一般可以认为c为常数。渡越时间法主要是测量超声发射到超声返回的时间间隔t,即“渡越时间”,然后根据式(1)计算距离。

  2系统硬件设计

  在距地面高度为45cm、相隔为22.5°的同一环上均匀分布着16个Polaroid生产的超声传感器,其编号为1#~16#(逆时针安排),超声传感器波束角为30°,超声传感器的最小作用距离为0.45m。超声数据采集板主要有两大模块:一是16路超声传感器的超声波发射和回波的接收模块,二是与上位机(机器人中央控制器)的CAN总线通讯模块。其硬件结构见图1。

  

  

  TMS320LF2407A向I/0端口发出控制信号,启动内部定时器进行计时。此控制信号经功率放大后作为超声传感驱动电路的启动信号(1NIT),超声传感器产生的、遇到障碍物时返回的高频振荡信号经放大(为弥补传播过程中信号的衰减)使超声传感驱动电路的ECHO端产生高电平脉冲。ECHO电平变化经过门电路后引起TMS320LF2407A外部中断,在中断程序内获取定时器的计数值,根据式(1)计算距离;否则,认为传感器前方探测范围内无障碍物。

  因为超声传感器之间的安装位置相差22.5°,而超声传感器的波束角为30°,如果超声波同时发射,必然会有干扰。如果采用轮循方式,即一个接一个地发射超声波,虽然可以消除串扰回波的影响,但是16个超声传感器轮循一次周期较长,降低了采集频率。为了在不降低采集频率的同时消除超声的相互干扰,本系统将16个超声传感器分成A(1#、3#、5#、7#、9#、11#、13#、15#)和B(2#、4#、6#、8#、10#、12#、14#、16#)两组,因为同一组内的两个超声传感器安装位置相差45°,通过计算可以知道,这种情况下超声传感器同时工作不会产生干扰,因而每一组里的超声传感器同时工作,组与组之间则采用轮循方式工作。这样既可以达到很高的采集频率,同时也满足了系统的实时性要求。每组8个超声传感器的ECHO端分别连接到一门电路,然后通过门电路连接DSP的XINTl和XINT2端。XINTl/2引脚电平发生跳变时会产生外部中断,通过I/0口可以知道是哪个或哪几个传感器引起中断。

  TMS320LF2407A内部集成了CAN控制器,通过它可以方便地构成CAN控制局域网络。TMS320LF2407A的CANTX和CANRX接口与CAN收发器SN65HVD230相连,通过SN65HVD230连接CAN总线。SN65HVD230是TI公司生产的专门针对240X系列DSP内CAN控制器与物理总线

  的接口。它的供电电压和TMS320LF2407A一样,仅为3.3V。由于CAN总线的数据通信具有突出的可靠性、实时性和灵活性,最高传输速率可达到1Mbps。超声采集板的数据能够快速、可靠地传给中央控制器。

  3软件设计

  系统软件主要由两部分构成,即超声数据采集与处理模块、CAN总线通讯模块。

  3.1多路超声传感器数据采集模块

  超声传感器被分为两组,两组循环交替工作。软件设计上采用两个定时器依次工作,分别对两组传感器进行计时。选择定时器的周期比超声传感器探测最大距离所需的渡越时间稍长。在每个定时器周期开始时,触发一组超声传感器同时开始工作。在定时器周期内,每个回波返回,都会触发一次外部中断(XINTl或XINT2中断),在外部中断处理程序内,将超声波返回时间进行纪录,并将相应的超声传感器关闭。外部中断处理程序非常简短,本系统只用了不到20条指令,并且TMS320LF2407A指令执行速度很快,因而即使因进入外部中断处理程序而延误了对后来回波的处理,但这种延误的时间根据计算不大于0.5μs,由此引入的距离误差根据(1)式计算小于83.5×10-6m。可见误差非常小,可以忽略不计。当定时器中断时,对于距离大于最大超声探测范围的,没有相应的时间记录,给它们加上超出测距范围的标志。其它的时间数据都有记录,根据(1)式计算距离,然后启动下一个定时器工作,并触发下一组超声传感器。本文的超声传感器的最大探测距离为3.5m,因而超声波探测的最长时间为20.58ms。所以每个定时器的周期选为20.6ms。图2只画出了一组超声传感器的处理框图,另一组与此相同,不再赘述。

  

  

  由于受环境温度、湿度的影响,超声传感器的测量值与实际值总有一些误差,表1列出了本超声测距系统测量值与对应的实际值。采用最小二乘法[8]对表1的数据进行拟合,结果为:

  y=O.9986x+0.2111

  式中,x为测量值,y为实际值。

  

  

  3.2基于CAN总线的数据通信

  超声数据采集板发送测距数据以中断的方式完成。TMS320LF2407A有专门的mailbox

  中断,用于响应发送/接收中断。每个超声传感器的测距值在DSP内用两个字节存储,而CAN总线传输标准要求每个数据帧最多只能传输8个字节的数据。本系统共有16个超声传感器,共有32个字节存储所有测距值。CAN总线传输所有测距值需要4个数据帧才能传送完。本系统的通讯过程为:中央控制器发送远程请求,超声数据采集板进入接收中断,在中断服务程序内,采用查询方式发送4帧数据,每帧数据包含4个超声传感器的测距值。本系统采用的波特率是500kbps。TMS320LF2407A用mailbox0接收中央控制器的远程请求帧,用mailbox2发送测距数据值。图3是超声数据采集板的发送数据中断服务程序框图。其中,TA2是对应mailbox2发送数据帧完成的标志位,RMP0是对应mailbox0接收数据帧的标志位。关于TMS320LF2407A的CAN模块的具体说明,参见文献[4],在此不作具体介绍。

  

  

  中央控制器接收子程序由VC++编写。当机器人需要新的测距值时,即调用此子程序。程序框图见图4。接收程序收到一帧数据后,判断数据是否有错,若有错,则向采集板发送命令,要求重发此帧数据;若正确,发送确认命令,要求采集板发送下一组数据,直到所有的超声测距数据都接收完。

  

  

  本文介绍的超声数据采集系统采用TMS320LF2407A为核心处理器,可以达到很高的采集速率和精度。通过CAN总线通讯,可以将测距值以很高的波特率可靠地发送给机器人中央控制器。此系统已经在自行设计的智能移动机器人CASIA-I上得到了实际应用。实验验证了硬

  件系统的可靠性和算法的有效性。

  参考文献

  1 Gtegory Dudek,Michael Jenkin. Computational Principles of Mobile Robotics.Cambridge University Press,2000

  2 D.Wilkes,G.Dudek,etc.Modeling Sonar Range Sensors.In C.Archibald and E.Petriu(eds.),Advances in Machine Vision:StrateSies and Applications,World Scientific Press,Singapore,1992:361~370

  3 李贻斌,刘明,周风余.移动机器人多超声传感器信息融合方法.系统工程与电子技术,1999;21(9):55~57

  4 TMS320LF/LC240XA DSP Controllers Reference Guide.Texas lnstruments lnc,2001

  5 高梅国,何佩琨.数字信号处理器DSPs的发展.电子技术 应用,2000;26(5)

  6 邬宽民.CAN总线原理和应用系统设计.北京:北京航空航天大学出版社,1996

  7 阳宪惠.现场总线技术及其应用.北京:清华大学出版社,1999

  8 张如州.微型计算机数据采集与处理.北京:北京工业学院出版社,1987

 

关键字:超声传感器  测距传感器  DSP  外部中断  上位机  核心处理器  北京航空航天大学出

编辑:ssb 引用地址:http://www.eeworld.com.cn/gykz/2008/0327/article_701.html
本网站转载的所有的文章、图片、音频视频文件等资料的版权归版权所有人所有,本站采用的非本站原创文章及图片等内容无法一一联系确认版权者。如果本网所选内容的文章作者及编辑认为其作品不宜公开自由传播,或不应无偿使用,请及时通过电子邮件或电话通知我们,以迅速采取适当措施,避免给双方造成不必要的经济损失。

上一篇:MEMS运动传感器有助于提高手持设备的可靠性
下一篇:意法半导体(ST)的尺寸更小、智能更高的运动传感器引领MEMS产品消费化浪潮

关注eeworld公众号 快捷获取更多信息
关注eeworld公众号
快捷获取更多信息
关注eeworld服务号 享受更多官方福利
关注eeworld服务号
享受更多官方福利

推荐阅读

超声传感器实现精确测距20米 对自动驾驶汽车意味着什么

  测距20米超声波技术,让价廉物美的超声波不再只用在倒车雷达上,还将大幅度降低自动驾驶环境感知技术的硬件成本。近日,在重庆市科学技术委员会、重庆市九龙坡区人民政府、重庆高新区主办的中国创新创业大赛第二届国际新能源及智能汽车大赛重庆赛区复赛及决赛上,重庆博创声远科技有限公司开发的“无人驾驶汽车超声波传感器”,因其精确测距可达20米,引得了众多评委和企业的注意。  自动驾驶,感知传感器非常关键,目前自动驾驶汽车测距与避障,主要采用传感器超声波、毫米波、摄像头和激光三种方式。这三种方式根据测距场景的不同,可以在自动驾驶中进行融合运用。  “超声测量范围最近,而毫米波和激光则负责远距离测量,如毫米波测量范围为200米,激光是100多米
发表于 2017-12-02

看这家公司怎么靠超声传感器在无人驾驶市场大赚特赚

掌握着无人驾驶最核心技术——超声传感器,占据这一领域市场近半壁江山,日本陶瓷株式会社(Nippon Ceramic Co.)的股票在三年里悄悄上涨了40%。分析师预计,到2018年,该公司盈利有望翻倍。   日本陶瓷株式会社的名字或许并非尽人皆知,但它却占据了超声传感器市场的一半份额。而事实上,在2013年的广州国际汽车零部件及用品展览会上,就已出现过日本陶瓷株式会社的身影。   该公司生产的直径仅一指宽的超声传感器,是无人驾驶技术不可或缺的核心。无人驾驶技术市场潜力不可估量,对紧急制动系统的要求也越发明显,预计2021年,驾驶员辅助功能这一与超声传感器最密切相关的市场,规模
发表于 2016-04-15
看这家公司怎么靠超声传感器在无人驾驶市场大赚特赚

基于ARM的自主式移动机器人设计

自主式移动机器人系统是指根据指令任务及环境信息进行自主路径规划,并且在任务执行过程中不断采集局部环境信息,做出决策,从而实现安全行驶并准确到达目标地点的智能系统。本文以LPC2119为控制核心,介绍了一种轮式移动机器人的设计方案。该机器人系统应用超声传感器、光敏传感器、碰撞传感器采集外部环境信息,采用PTR2000实现移动机器人与计算机通信,从而实现现场信息的反馈和计算机控制命令的发送。LPC2119是Philips公司推出的支持实时仿真和跟踪的ARM7TDMI-S微处理器,嵌入128KB高速Flash存储器。它采用3级流水线技术,取指、译码和执行同时进行,能够并行处理指令,提高CPU运行速度。由于其具有非常小的尺寸和极低的功耗
发表于 2013-10-21
基于ARM的自主式移动机器人设计

超声传感器适应更多工业领域应用

超声传感器的使用原理 超声传感器内有一个频率变换器,当变换器元件振动时,这个频率变换器就会向一个方向发出听不见的高频声波。如果声波碰到物体并反射回来,变换器即可接到回波信号。传感器根据从发出超声波脉冲到返回回波信号之间的时间来确定与物体之间的距离。 例如,装在塑料熔体罐或塑料粒料室顶部的超声传感器向集装箱内部发出声波时,回波返回的时间长度即可表示该集装箱是否已满、空或半满。 有些超声传感器分别采用一个发射器和一个接收器变换器。这种双向模式超声传感器适用于需要进行制品边缘检测或希望有更快的响应时间,或在潮湿环境下使用的情况。 在检测透明物体、液体、任何表面(粗糙、光滑、光亮)的密致材料和不规则物体时,超声传感器应该是首选
发表于 2013-05-16
超声传感器适应更多工业领域应用

利用MAXQ7667确定超声传感器的谐振频率和阻尼特性

 引言   本文介绍了如何利用MAXQ7667智能SoC (片上系统)确定超声传感器的谐振频率和阻尼特性。这些功能有助于诊断传感器模块,优化系统性能,并且可以在生产过程中用于校准。本应用笔记并非针对所有系统泛泛地讨论“如何实现”,而是针对特定的传感器模型讨论设计细节以及特定条件下的性能。利用这些信息,用户可以大大简化系统测试。另外,这些测试假定超声波反射目标与传感器的距离大于1英尺。   测试装置   本文中的所有测试数据取自MAXQ7667 EV (评估)板,这些数据通过评估板的RS-232串口传送到PC,然后利用Excel表产生曲线图。传感器采用随评估板提供的40kHz 400EP250。传感器水平安装在电路板上,可以方
发表于 2012-09-14
利用MAXQ7667确定超声传感器的谐振频率和阻尼特性

基于超声传感器的自动报靶系统设计与实现

的局限性。针对现有技术的上述不足,提出一种敞开形超声传感器的报靶系统,其结构简单、体积小、重量轻、无耗材并且野外布设、便携、射击瞄准指示物材料无特定要求,定位精度高,能解决弹丸单、连发精确定位问题。是一种能很好适用于野外实弹连发射击训练、演习、战场杀伤破坏评估中弹丸定位及自动报靶的声电定位装置。 1 声电定位原理    声电定位的主要优点在于测量精度高,工作与光照条件无关,可以全天候工作。    对装于“口”型布阵靶框内侧的声学传感器来说,枪械类型和射击距离不同,其探测到的传感器信号不同,波形也会有所不同。在一个矩形木质框架上装入若干个声电传感器,当弹头从框架内穿过时,冲击
发表于 2012-08-11
基于超声传感器的自动报靶系统设计与实现

小广播

电子工程世界版权所有 京ICP证060456号 京ICP备10001474号 电信业务审批[2006]字第258号函 京公海网安备110108001534 Copyright © 2005-2018 EEWORLD.com.cn, Inc. All rights reserved
pt type="text/javascript" src="//v3.jiathis.com/code/jia.js?uid=2113614" charset="utf-8">