CN101334472A - 一种适用于特种机器人的超声波测距系统 - Google Patents
一种适用于特种机器人的超声波测距系统 Download PDFInfo
- Publication number
- CN101334472A CN101334472A CNA2008101063591A CN200810106359A CN101334472A CN 101334472 A CN101334472 A CN 101334472A CN A2008101063591 A CNA2008101063591 A CN A2008101063591A CN 200810106359 A CN200810106359 A CN 200810106359A CN 101334472 A CN101334472 A CN 101334472A
- 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.)
- Granted
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-接收、放大、滤波电路模块，6-m序列发生模块，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、一种适用于特种机器人的超声波测距系统，其特征在于：该系统包括渡越时间确定模块，超声波传播速度实时测量模块；所述渡越时间确定模块包括超声波发射换能模块、超声波接收换能模块、超声波发射电路模块、回波接收、放大、滤波电路模块和嵌入式数字信号处理模块(DSP 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。
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 true CN101334472A (zh) | 2008-12-31 |
| CN101334472B 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) |
Cited By (10)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102508249A (zh) * | 2011-10-26 | 2012-06-20 | 浙江大学 | 一种基于dsp的高精度超声波测距系统及其测距方法 |
| CN102621986A (zh) * | 2012-04-13 | 2012-08-01 | 西北农林科技大学 | 一种基于视觉和超声波的导航控制系统 |
| CN103941259A (zh) * | 2014-04-15 | 2014-07-23 | 长安大学 | 一种具备高抗干扰性的超声波测距方法与测距装置 |
| CN105510533A (zh) * | 2015-12-18 | 2016-04-20 | 金陵科技学院 | 一种基于单片机的运动地板球体反弹系数测试仪和方法 |
| CN107014447A (zh) * | 2015-10-21 | 2017-08-04 | 德州仪器公司 | 使用宽带系统响应的超声波换能器系统及方法 |
| CN107748512A (zh) * | 2017-09-28 | 2018-03-02 | 深圳市行者机器人技术有限公司 | 一种双足机器人的抗干扰控制系统 |
| CN107957579A (zh) * | 2016-10-14 | 2018-04-24 | 苏州触达信息技术有限公司 | 一种被测物体的状态参数确定方法和系统 |
| CN109240295A (zh) * | 2018-09-14 | 2019-01-18 | 郑州轻工业学院 | 一种探测火场环境的辅助行走系统 |
| CN110531333A (zh) * | 2019-08-22 | 2019-12-03 | 北京理工大学 | 一种宽带雷达孔径渡越效应自适应补偿方法 |
| CN111123201A (zh) * | 2019-12-17 | 2020-05-08 | 浙江大学 | 基于多超声波传感器的自主移动机器人目标定位方法及装置 |
Family Cites Families (8)
| 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 | 华中理工大学 | 超声波测距装置 |
| KR100349504B1 (ko) * | 2000-04-24 | 2002-08-21 | 주식회사 창민테크 | 초음파 유속 측정장치 |
| 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 | 大连理工大学 | 管道内移动微型机器人的超声波在线定位方法 |
-
2008
- 2008-05-12 CN CN2008101063591A patent/CN101334472B/zh not_active Expired - Fee Related
Cited By (17)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN102508249B (zh) * | 2011-10-26 | 2013-07-31 | 浙江大学 | 一种基于dsp的高精度超声波测距系统及其测距方法 |
| CN102508249A (zh) * | 2011-10-26 | 2012-06-20 | 浙江大学 | 一种基于dsp的高精度超声波测距系统及其测距方法 |
| CN102621986A (zh) * | 2012-04-13 | 2012-08-01 | 西北农林科技大学 | 一种基于视觉和超声波的导航控制系统 |
| CN103941259A (zh) * | 2014-04-15 | 2014-07-23 | 长安大学 | 一种具备高抗干扰性的超声波测距方法与测距装置 |
| CN103941259B (zh) * | 2014-04-15 | 2016-06-22 | 长安大学 | 一种具备高抗干扰性的超声波测距方法与测距装置 |
| CN107014447B (zh) * | 2015-10-21 | 2020-05-26 | 德州仪器公司 | 使用宽带系统响应的超声波换能器系统及方法 |
| CN107014447A (zh) * | 2015-10-21 | 2017-08-04 | 德州仪器公司 | 使用宽带系统响应的超声波换能器系统及方法 |
| US12038314B2 (en) | 2015-10-21 | 2024-07-16 | Texas Instruments Incorporated | Ultrasonic transducer system and method using broadband system responses |
| 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 | 苏州触达信息技术有限公司 | 一种被测物体的状态参数确定方法和系统 |
| CN107957579A (zh) * | 2016-10-14 | 2018-04-24 | 苏州触达信息技术有限公司 | 一种被测物体的状态参数确定方法和系统 |
| CN107748512A (zh) * | 2017-09-28 | 2018-03-02 | 深圳市行者机器人技术有限公司 | 一种双足机器人的抗干扰控制系统 |
| CN109240295A (zh) * | 2018-09-14 | 2019-01-18 | 郑州轻工业学院 | 一种探测火场环境的辅助行走系统 |
| CN110531333A (zh) * | 2019-08-22 | 2019-12-03 | 北京理工大学 | 一种宽带雷达孔径渡越效应自适应补偿方法 |
| CN110531333B (zh) * | 2019-08-22 | 2021-08-17 | 北京理工大学 | 一种宽带雷达孔径渡越效应自适应补偿方法 |
| CN111123201A (zh) * | 2019-12-17 | 2020-05-08 | 浙江大学 | 基于多超声波传感器的自主移动机器人目标定位方法及装置 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN101334472B (zh) | 2011-05-04 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN101334472B (zh) | 一种适用于特种机器人的超声波测距系统 | |
| US11733377B2 (en) | Time of flight and code signature detection for coded ultrasonic transmission | |
| CN1997911B (zh) | 使用超声波的距离测量方法与装置 | |
| CN101173986B (zh) | 一种无盲区的超声测距仪 | |
| CN105066918A (zh) | 超声水下目标测厚系统及测厚方法 | |
| US11644555B2 (en) | Threshold generation for coded ultrasonic sensing | |
| CN109471112A (zh) | 一种可抗声波干扰的超声波测距传感器及其测距方法 | |
| CN103995263A (zh) | 一种基于时序的超声波测距方法 | |
| EP2799905B1 (en) | High sensitive apparatus for car parking ultrasonic sensors and method thereof | |
| CN104536003A (zh) | 基于多种发射频率的超声波测距方法及其装置 | |
| CN105044725A (zh) | 利用抹香鲸叫声的水下目标隐蔽测距方法及装置 | |
| CN2784945Y (zh) | 一种超声波测距传感器 | |
| CN100485413C (zh) | 扫频信号的时频互相关检测和时延估计方法 | |
| CN105277933A (zh) | 一种多通道超声波障碍物防串扰检测方法 | |
| US20240027613A1 (en) | Object detection apparatus and object detection method | |
| Shin et al. | Improving efficiency of ultrasonic distance sensors using pulse interval modulation | |
| CN105467395A (zh) | 一种超远距离超声波测量仪 | |
| CN206960652U (zh) | 连续收发的汽车超声波雷达系统 | |
| CN103969648A (zh) | 抗噪声超声波测距设备及方法 | |
| Jörg et al. | Using pseudo-random codes for mobile robot sonar sensing | |
| KR20160069076A (ko) | 초음파를 이용한 거리 측정 방법 및 장치 | |
| 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 |
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 |