CN101334472B - 一种适用于特种机器人的超声波测距系统 - Google Patents

一种适用于特种机器人的超声波测距系统 Download PDF

Info

Publication number
CN101334472B
CN101334472B CN2008101063591A CN200810106359A CN101334472B CN 101334472 B CN101334472 B CN 101334472B CN 2008101063591 A CN2008101063591 A CN 2008101063591A CN 200810106359 A CN200810106359 A CN 200810106359A CN 101334472 B CN101334472 B CN 101334472B
Authority
CN
China
Prior art keywords
module
ultrasonic
inverting model
transit time
signal processing
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Expired - Fee Related
Application number
CN2008101063591A
Other languages
English (en)
Other versions
CN101334472A (zh
Inventor
罗庆生
韩宝玲
赵小川
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Institute of Technology BIT
Original Assignee
Beijing Institute of Technology BIT
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beijing Institute of Technology BIT filed Critical Beijing Institute of Technology BIT
Priority to CN2008101063591A priority Critical patent/CN101334472B/zh
Publication of CN101334472A publication Critical patent/CN101334472A/zh
Application granted granted Critical
Publication of CN101334472B publication Critical patent/CN101334472B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)

Abstract

本发明涉及一种适用于特种机器人的超声波测距系统，属于机器人传感器领域。该系统包括渡越时间确定模块、超声波传播速度实时测量模块。通过渡越时间确定模块来测量障碍物与超声波换能模块之间的渡越时间，通过超声波传播速度实时测量模块来测量机器人所处环境的实际声波速度，应用嵌入式数字信号处理模块通过计算渡越时间和超声波传播速度乘积值的一半得出机器人距离障碍物的距离。本发明的一种适用于特种机器人的超声波测距系统的测距有效值范围是0.3m～8.9m。本发明具有精度高、抗干扰能力强、实时性好、结构简单、功耗低等特点，可用于特种机器人导航和避障以提高特种机器人的探测能力和对未知环境的适应能力。

Description

一种适用于特种机器人的超声波测距系统
技术领域
本发明涉及一种适用于特种机器人的超声波测距系统，属于机器人传感器领域。
背景技术
超声波传感器具有信息处理简单、成本低廉等优点，被广泛用作机器人测距传感器，以实现环境探测和导航任务。
超声波测距利用的是超声波近似直线传播和反射的特性，目前常用的测距方式是单脉冲方式。超声波换能器在单脉冲的触发下将超声波发射出去，超声波在介质中传播到被测物体后被反射。超声波换能器接收到反射回波信号，确定出超声波从发射到接收的渡越时间，超声波传播的速度用340m/s近似代替。
特种机器人常常工作在非结构环境下，在实际测距过程中，环境中温度、湿度、气压对超声波的传播速度都会产生影响，其中温度变化的影响最大，因此用340m/s近似代替超声波传播的速度会引入误差；其次超声波回波信号是一个调制信号，无明确的回波信号前沿，因而在确定渡越时间的过程中，其基准点的选择已构成测量误差的主要来源；在非结构环境下，噪声与回波同时被接收，即使电路中带有滤波电路，与脉冲频率相近的噪声依旧无法滤除，这将造成误触发；上述问题已成为制约超声波传感器在特种机器人领域应用的瓶颈。
发明内容
本发明的目的在于提供一种适用于特种机器人的超声波测距系统，来解决在实际测距过程中，环境、超声波回波信号基准点的选择、噪声干扰等因素对传播速度测量影响大的问题。
本发明提供的一种适用于特种机器人的超声波测距系统，该系统包括渡越时间确定模块、超声波传播速度实时测量模块。
1)、渡越时间确定模块：主要包括超声波发射换能模块、超声波接收换能模块、超声波发射电路模块、回波接收、放大、滤波电路模块和嵌入式数字信号处理模块(DSP TMS320VC5509A)；嵌入式数字信号处理模块内部的运算程序包括m序列发生模块、本地码发生模块、m序列还原模块和相关判决模块等；超声波发射换能模块通过超声波发射电路模块与嵌入式数字信号处理模块相连，超声波接收换能模块通过回波接收、放大、滤波电路模块与嵌入式数字信号处理模块相连，超声波发射换能模块与超声波接收换能模块发射、接收方向平行且紧密相邻。
渡越时间确定模块的工作过程如下：
基于伪随机序列的自相关性原理，由嵌入式数字信号处理模块通过m序列发生模块产生的伪随机序列经通用I/O引脚输出，激励超声波发射电路模块将其转换成对应的超声波信号，通过超声波发射换能模块发射出去，超声波经障碍物反射到超声波接收换能模块，通过回波接收、放大、滤波电路模块将其滤波、放大后，经过A/D转换，输入给嵌入式数字信号处理模块的m序列还原模块，m序列还原模块将其还原成对应的离散序列，与本地码发生模块产生的伪随机序列通过相关判决模块的相关运算公式进行运算。当相关函数值取值最大时，通过本地伪随机序列与接收到的伪随机序列的相位差便可确定障碍物与超声波换能模块之间的渡越时间。
2)、超声波传播速度实时测量模块：主要包括长方体目标、超声波发射换能模块、超声波接收换能模块、超声波发射电路模块、回波接收、放大、滤波电路模块和嵌入式数字信号处理模块；嵌入式数字信号处理模块内部的运算程序包括m序列发生模块、本地码发生模块、m序列还原模块和相关判决模块等；超声波发射换能模块通过超声波发射电路模块与嵌入式数字信号处理模块相连，超声波接收换能模块通过回波接收、放大、滤波电路模块与嵌入式数字信号处理模块相连，超声波发射换能模块与超声波接收换能模块发射、接收方向平行且紧密相邻，长方体目标固定于超声波发射换能模块与超声波接收换能模块前端，距离为d(30cm＜d＜1m)。
超声波传播速度实时测量模块的工作过程如下：
基于伪随机序列的自相关性原理，由嵌入式数字信号处理模块通过m序列发生模块产生的伪随机序列经通用I/O引脚输出，激励超声波发射电路模块将其转换成对应的超声波信号，通过超声波发射换能模块发射出去，超声波经长方体目标反射到超声波接收换能模块，通过回波接收、放大、滤波电路模块将其滤波、放大后，经过A/D转换，输入给嵌入式数字信号处理模块的m序列还原模块，m序列还原模块将其还原成对应的离散序列，与本地码发生模块产生的伪随机序列通过相关判决模块的相关运算公式进行运算。当相关函数值取值最大时，通过本地伪随机序列与接收到的伪随机序列的相位差便可确定长方体目标与超声波换能模块之间的渡越时间，计算长方体目标距超声波换能模块的距离值d与渡越时间比值的二倍便为超声波传播速度。
通过渡越时间确定模块来测量障碍物与超声波换能模块之间的渡越时间，通过超声波传播速度实时测量模块来测量机器人所处环境的实际声波速度，应用嵌入式数字信号处理模块通过计算渡越时间和超声波传播速度乘积值的一半得出机器人距离障碍物的距离。本发明的一种适用于特种机器人的超声波测距系统的测距有效值范围是0.3m～8.9m。
本发明的有益效果：
(1)增加了超声波传播速度实时测量模块，该模块基于伪随机序列的自相关性准确地测量渡越时间后，再利用模块中目标物体与超声波换能模块距离已知的条件，计算出超声波的传播速度。克服了传统超声波测距传感器因为超声波传播速度随温度、压强的变化而造成误差的缺点。
(2)采用基于伪随机序列自相关性原理测量渡越时间，有效地提高了渡越时间测量的精度，消除了噪声的干扰。
(3)采用嵌入式数字信号处理模块处理信号，有效地提高了信息处理的实时性。
(4)采用模块化设计，结构简单，功能可靠，可广泛应用于各种特种机器人。该系统对于提高特种机器人的探测能力，增加机器人对未知环境的适应能力具有重要的作用，可进一步扩大特种机器人在民用、军事等领域的应用。
附图说明
图1是渡越时间测定的工作原理图；
图2是超声波传播速度实时测量的工作原理图；
图3是超声波测距装置的外观结构图；
图4是超声波测距装置在特种机器人上应用的示意图；
图中，1-障碍物，2-超声波发射换能模块，3-超声波接收换能模块，4-超声波发射电路模块，5-接收、放大、滤波电路模块，6m序列发生模块，7-本地码发生模块，8-m序列还原模块，9-相关判决模块，10-嵌入式数字信号处理模块DSP TMS320VC5509A，11-长方体目标。
具体实施方式
下面结合附图实施例对本发明作进一步说明。
以测试环境温度为25.3℃，压强为1007.6Hpa，相对湿度为15％为例，取不同的实际距离进行测量，检验本发明的误差。
测量具体步骤如下：
(1)通过渡越时间确定模块来测量障碍物与超声波换能模块之间的渡越时间。
如图1所示，超声波发射换能模块2通过超声波发射电路模块4与嵌入式数字信号处理模块10相连，超声波接收换能模块3通过回波接收、放大、滤波电路模块5与嵌入式数字信号处理模块10相连，超声波发射换能模块2与超声波接收换能模块3发射、接收方向平行且紧密相邻。由嵌入式数字信号处理模块10通过m序列发生模块6产生的m序列通过通用I/O引脚输出，激励超声波发射电路模块4将其转换成对应的超声波信号，通过超声波发射换能模块2发射出去，超声波经障碍物1反射到超声波接收换能模块3，通过接收、放大、滤波电路模块5将其滤波、放大后，经过A/D转换，输入给m序列还原模块8，m序列还原模块8将其还原成对应的离散序列，与本地码发生模块7产生的伪随机序列通过相关判决模块9的相关运算公式进行运算。当相关函数值取值最大时，通过本地伪随机序列与接收到的伪随机序列的相位差便可确定障碍物1与超声波发散换能模块2、超声波接收换能模块3之间的渡越时间。
(2)通过超声波传播速度实时测量模块来测量机器人所处环境的实际声波速度。
如图2所示，超声波发射换能模块2通过超声波发射电路模块4与嵌入式数字信号处理模块10相连，超声波接收换能模块3通过回波接收、放大、滤波电路模块5与嵌入式数字信号处理模块10相连，超声波发射换能模块2与超声波接收换能模块3发射、接收方向平行且紧密相邻，长方体目标固定于超声波发射换能模块与超声波接收换能模块前端，距离为42.5cm。由嵌入式数字信号处理模块10通过m序列发生模块6产生的m序列通过通用I/O引脚输出，激励超声波发射电路模块4将其转换成对应的超声波信号，通过超声波发射换能模块2发射出去，超声波经长方体目标11反射到超声波接收换能模块3，接收、放大、滤波电路模块5将其滤波、放大后，经过A/D转换，输入给m序列还原模块8，m序列还原模块8将其还原成对应的离散序列，与本地码发生模块7产生的伪随机序列通过相关判决模块9的相关运算公式进行运算。当相关函数值取值最大时，通过本地伪随机序列与接收到的伪随机序列的相位差便可确定长方体目标与超声波换能模块之间的渡越时间。计算长方体目标距超声波换能模块的距离与渡越时间比值的二倍便为超声波传播速度。
(3)取渡越时间与机器人所处环境中的超声波传播速度的乘积的一半得出机器人距离障碍物的距离，这一过程在嵌入式数字信号处理模块中完成，直接输出实验结果如下表：
 实际距离(m)   3   3.5   4   4.5   5
 无干扰测距(m)   2.992   3.468   3.978   4.522   4.998
 误差   -0.27％   -0.91％   -0.55％   +0.49％   -0.04％
 有干扰测距(m)   3.012   3.468   4.012   4.488   5.032
 误差   +0.4％   -0.91％   +0.3％   -0.27％   +0.64％
从上述实验结果中可以看出，本发明的适用于特种机器人的新型超声波测距装置的测量误差≤0.1％，具有较高的精度和良好的抗干扰能力。

Claims (4)

1.一种适用于特种机器人的超声波测距系统，其特征在于：该系统包括渡越时间确定模块，超声波传播速度实时测量模块；所述渡越时间确定模块包括超声波发射换能模块、超声波接收换能模块、超声波发射电路模块、回波接收、放大、滤波电路模块和使用TMS320VC5509A的嵌入式数字信号处理模块；所述的超声波传播速度实时测量模块包括长方体目标、超声波发射换能模块、超声波接收换能模块、超声波发射电路模块、回波接收、放大、滤波电路模块和嵌入式数字信号处理模块；嵌入式数字信号处理模块内部的运算程序包括m序列发生模块、本地码发生模块、m序列还原模块和相关判决模块；
所述的渡越时间确定模块，由嵌入式数字信号处理模块通过m序列发生模块产生的伪随机序列经通用I/O引脚输出，激励超声波发射电路模块将其转换成对应的超声波信号，通过超声波发射换能模块发射出去，超声波经障碍物反射到超声波接收换能模块，通过回波接收、放大、滤波电路模块将其滤波、放大后，经过A/D转换，输入给嵌入式数字信号处理模块的m序列还原模块，m序列还原模块将其还原成对应的离散序列，与本地码发生模块产生的伪随机序列通过相关判决模块的相关运算公式进行运算；当相关函数值取值最大时，通过本地伪随机序列与接收到的伪随机序列的相位差便可确定障碍物与超声波换能模块之间的渡越时间；
超声波传播速度实时测量模块，由嵌入式数字信号处理模块通过m序列发生模块产生的伪随机序列经通用I/O引脚输出，激励超声波发射电路模块将其转换成对应的超声波信号，通过超声波发射换能模块发射出去，超声波经长方体目标反射到超声波接收换能模块，通过回波接收、放大、滤波电路模块将其滤波、放大后，经过A/D转换，输入给嵌入式数字信号处理模块的m序列还原模块，m序列还原模块将其还原成对应的离散序列，与本地码发生模块产生的伪随机序列通过相关判决模块的相关运算公式进行运算；当相关函数值取值最大时，通过本地伪随机序列与接收到的伪随机序列的相位差便可确定长方体目标与超声波换能模块之间的渡越时间，计算长方体目标距超声波换能模块的固定距离与渡越时间比值的二倍便为超声波传播速度。
2.如权利要求1所述的一种适用于特种机器人的超声波测距系统，其特征在于：应用嵌入式数字信号处理模块通过计算超声波传播速度和渡越时间乘积值的一半得出机器人距离障碍物的距离。
3.如权利要求1所述的一种适用于特种机器人的超声波测距系统，其特征在于：超声波发射换能模块与超声波接收换能模块发射、接收方向平行且紧密相邻。
4.如权利要求1所述的一种适用于特种机器人的超声波测距系统，其特征在于：长方体目标固定于超声波发射换能模块与超声波接收换能模块前端，固定距离d的范围为30cm＜d＜1m。
CN2008101063591A 2008-05-12 2008-05-12 一种适用于特种机器人的超声波测距系统 Expired - Fee Related CN101334472B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN2008101063591A CN101334472B (zh) 2008-05-12 2008-05-12 一种适用于特种机器人的超声波测距系统

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN2008101063591A CN101334472B (zh) 2008-05-12 2008-05-12 一种适用于特种机器人的超声波测距系统

Publications (2)

Publication Number Publication Date
CN101334472A CN101334472A (zh) 2008-12-31
CN101334472B true CN101334472B (zh) 2011-05-04

Family

ID=40197191

Family Applications (1)

Application Number Title Priority Date Filing Date
CN2008101063591A Expired - Fee Related CN101334472B (zh) 2008-05-12 2008-05-12 一种适用于特种机器人的超声波测距系统

Country Status (1)

Country Link
CN (1) CN101334472B (zh)

Families Citing this family (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102508249B (zh) * 2011-10-26 2013-07-31 浙江大学 一种基于dsp的高精度超声波测距系统及其测距方法
CN102621986A (zh) * 2012-04-13 2012-08-01 西北农林科技大学 一种基于视觉和超声波的导航控制系统
CN103941259B (zh) * 2014-04-15 2016-06-22 长安大学 一种具备高抗干扰性的超声波测距方法与测距装置
US11209297B2 (en) * 2015-10-21 2021-12-28 Texas Instruments Incorporated Ultrasonic transducer system and method using broadband system responses
CN105510533A (zh) * 2015-12-18 2016-04-20 金陵科技学院 一种基于单片机的运动地板球体反弹系数测试仪和方法
CN107957579B (zh) * 2016-10-14 2020-08-28 苏州触达信息技术有限公司 一种被测物体的状态参数确定方法和系统
CN107748512A (zh) * 2017-09-28 2018-03-02 深圳市行者机器人技术有限公司 一种双足机器人的抗干扰控制系统
CN109240295A (zh) * 2018-09-14 2019-01-18 郑州轻工业学院 一种探测火场环境的辅助行走系统
CN110531333B (zh) * 2019-08-22 2021-08-17 北京理工大学 一种宽带雷达孔径渡越效应自适应补偿方法
CN111123201B (zh) * 2019-12-17 2021-10-29 浙江大学 基于多超声波传感器的自主移动机器人目标定位方法及装置

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4288866A (en) * 1979-10-09 1981-09-08 The United States Of America As Represented By The Secretary Of The Navy Ultrasonic image system
DE4003775A1 (de) * 1990-02-08 1991-08-14 Fraunhofer Ges Forschung Verfahren zur steuerung eines ultraschall-entfernungssensors
CN2356355Y (zh) * 1998-11-10 1999-12-29 华中理工大学 超声波测距装置
CN1320809A (zh) * 2000-04-24 2001-11-07 昌民技术有限公司 超声波流速测量仪
CN2591642Y (zh) * 2002-10-21 2003-12-10 张鹏 一种超声波测距装置
US6697300B1 (en) * 2002-09-13 2004-02-24 General Dynamics Advanced Information Systems, Inc. Method and apparatus for determining the positioning of volumetric sensor array lines
CN1601300A (zh) * 2004-10-13 2005-03-30 大连理工大学 管道内移动微型机器人的超声波在线定位方法
JP2006105887A (ja) * 2004-10-08 2006-04-20 Synthesis Corp 立体視装置およびそれを備えた立体画像表示システム

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US4288866A (en) * 1979-10-09 1981-09-08 The United States Of America As Represented By The Secretary Of The Navy Ultrasonic image system
DE4003775A1 (de) * 1990-02-08 1991-08-14 Fraunhofer Ges Forschung Verfahren zur steuerung eines ultraschall-entfernungssensors
CN2356355Y (zh) * 1998-11-10 1999-12-29 华中理工大学 超声波测距装置
CN1320809A (zh) * 2000-04-24 2001-11-07 昌民技术有限公司 超声波流速测量仪
US6697300B1 (en) * 2002-09-13 2004-02-24 General Dynamics Advanced Information Systems, Inc. Method and apparatus for determining the positioning of volumetric sensor array lines
CN2591642Y (zh) * 2002-10-21 2003-12-10 张鹏 一种超声波测距装置
JP2006105887A (ja) * 2004-10-08 2006-04-20 Synthesis Corp 立体視装置およびそれを備えた立体画像表示システム
CN1601300A (zh) * 2004-10-13 2005-03-30 大连理工大学 管道内移动微型机器人的超声波在线定位方法

Non-Patent Citations (7)

* Cited by examiner, † Cited by third party
Title
Baoling Han, Qingsheng Luo, Qiuli Wang, Xiaochuan Zhao.A Research on Hexapod Walking Bio-robot"s Working Space and Flexibility.《Proceedings of the 2006 IEEE International Conference on Robotics and Biomimetics》.2006, *
杜艳生.应用伪随机码的超声波测距系统.《中国优秀硕士学位论文全文数据库》.2004,(第4期), *
樊秀云,袁嗣杰,张合敏.伪码数字相关在超声波测距中的应用.《装备指挥技术学院学报》.2002,第13 卷(第3 期),77-80. *
程晓畅,王跃科.伪随机码超声扩频测距发射与接收电路设计.《声学与电子工程》.2007,(第1期),42-45. *
罗庆生, 韩宝玲.一种基于超声波与红外线探测技术的测距定位系统.《计算机测量与控制》.2005,第13卷(第4期),304-306,334. *
赵小川, 罗庆生, 韩宝玲, 徐嘉, 潘登.仿生六足机器人实时避障控制技术.《机械与电子》.2007,(第2期),57-59. *
黄增荣,秦会斌,黄博志,礼攀,胡秀江.扩频法超声测距中的渡越时间的确定.《计量学报》.2007,第28卷(第3期),280-283. *

Also Published As

Publication number Publication date
CN101334472A (zh) 2008-12-31

Similar Documents

Publication Publication Date Title
CN101334472B (zh) 一种适用于特种机器人的超声波测距系统
US11733377B2 (en) Time of flight and code signature detection for coded ultrasonic transmission
CN1997911B (zh) 使用超声波的距离测量方法与装置
CN105066918A (zh) 超声水下目标测厚系统及测厚方法
US11644555B2 (en) Threshold generation for coded ultrasonic sensing
CN109581317B (zh) 一种基于回波峰值匹配的角落目标定位方法
CN103995263A (zh) 一种基于时序的超声波测距方法
CN109471112A (zh) 一种可抗声波干扰的超声波测距传感器及其测距方法
EP2799905B1 (en) High sensitive apparatus for car parking ultrasonic sensors and method thereof
CN109696680A (zh) 基于相位检测的高精度超声波测距装置及方法
CN104536003A (zh) 基于多种发射频率的超声波测距方法及其装置
CN105044725A (zh) 利用抹香鲸叫声的水下目标隐蔽测距方法及装置
CN2784945Y (zh) 一种超声波测距传感器
Shin et al. Improving efficiency of ultrasonic distance sensors using pulse interval modulation
CN100485413C (zh) 扫频信号的时频互相关检测和时延估计方法
CN105277933A (zh) 一种多通道超声波障碍物防串扰检测方法
CN105467395A (zh) 一种超远距离超声波测量仪
CN206960652U (zh) 连续收发的汽车超声波雷达系统
CN103969648A (zh) 抗噪声超声波测距设备及方法
Jörg et al. Using pseudo-random codes for mobile robot sonar sensing
Wang et al. Range resolution of ultrasonic distance measurement using single bit cross correlation for robots
CN203705637U (zh) 高精度超声测距仪
CN111983591A (zh) 一种回波模拟仿真系统及方法
Kou et al. Research of long range accurate ranging technology based on ultrasonic sensor measurement
Liu et al. Ultrasonic distance measuring system without blind area

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
C17 Cessation of patent right
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20110504

Termination date: 20120512