CN101881832A - 利用超声波测量物体位置的方法及装置 - Google Patents
利用超声波测量物体位置的方法及装置 Download PDFInfo
- Publication number
- CN101881832A CN101881832A CN 201010213535 CN201010213535A CN101881832A CN 101881832 A CN101881832 A CN 101881832A CN 201010213535 CN201010213535 CN 201010213535 CN 201010213535 A CN201010213535 A CN 201010213535A CN 101881832 A CN101881832 A CN 101881832A
- Authority
- CN
- China
- Prior art keywords
- reception
- sending
- ultrasonic
- receiving sensor
- data
- 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
Abstract
本发明提供一种利用超声波进行物体定位的方法及装置。该超声波测量物体位置的装置:其特征在于它包括处理信号用的单片机,至少两个超声波收发传感器,每个传感器通过收发电路与单片机相连。单片机控制两个收发传感器发送和接收超声波,并通过一定的算法计算出多个物体的位置,甚至测出物体轮廓。本方法适用于机器人、多点触屏等领域。
Description
一、技术领域:
本发明涉及一种利用超声波测量物体位置的方法及装置,适用于机器人、多点触屏等领域。
二、背景技术:
超声波由于指向性强、能量消耗缓慢且在介质中传播的距离较远,因而经常用于距离的测量。超声波的传播方式为直线传播,但遇到障碍物时会发生反射和绕射;频率越高,反射越强,绕射越弱。利用超声波定位往往比较迅速、方便,且计算简单、易于做到实时控制。
传统超声波定位装置常用发射角小的超声波发射器,模仿蝙蝠利用双耳接收时间差进行定位,此类装置大多只能对探测范围内的一个物体进行定位,并且当探测范围内有其他物体时,其定位结果容易受到干扰而不准确。
三、发明内容:
本发明根据现有技术情况,提供一种利用超声波测量物体位置的方法,该方法定位准确,可对有效探测范围内的两个或多个物体的位置。
本发明的另一目的是提供一种利用超声波测量物体位置的装置,该装置可对两个或多个物体进行定位。
本发明的目的是通过以下措施实现的:
1、一种利用超声波测量物体位置的方法,该方法包括以下步骤:
1)先由TR1发送一段超声波,经物体反射后由TR1、TR2接收,并记录相应接收时间为t11、t12、t13……,T11、T12、T13……;
2)再由TR2发送一段超声波,经物体反射后由TR1、TR2接收,并记录相应接收时间为t21、t22、t23……,T21、T22、T23……;
3)是否满足T11=t21、T12=t22、T13=t23……如不满足,将所测数据舍弃;
4)在t11、t12、t13……找出一个数据x,在T21、T22、T23……找出一个数据y,在t21、t22、t23……中找出一个数据z,使x+y=2*z,则由x、y和L构成一个三角形,即可确定一个物体的位置;
5)重复第4步,直到t21、t22、t23……中数据全部用到,即可确定有效测量范围内的每个物体的位置。
本发明的超声波测量物体位置的装置:
包括处理信号用的单片机,至少两个超声波收发传感器,每个传感器通过收发电路与单片机相连。单片机控制超声波收发传感器轮流发送超声波,每个传感器接收到的超声波经收发电路放大整形后送至单片机进行处理。本装置利用12864型点阵液晶屏将物体位置显示出来,但液晶屏并不是必不可少,也可以利用TWI、USART等通信接口将探测信息传送至其他应用电路。
本装置采用Atmega16作为微控制器(也可以使用其他型号单片机),使用定时器产生40KHz矩形波,基于中断的方式接收超声波信号,并在单片机内计算出物体位置。接收电路采用CX20106A对超声波信号进行放大整形,并具有滤除其他杂波的作用。
本方法可以同时探测出在有效探测范围内的两个或多个物体的位置,单片机可以计算出在有效测量范围内的每个物体与每个超声波收发传感器之间的距离,结合传感器与传感器之间的距离构成若干个三角形,继而确定物体位置。并且本装置可以使用廉价的发射角较大的超声波发射器,节约了仪器成本。
四、附图说明:
图1为超声波定位流程图。
图2作出物体可能的位置点。
图3作出物体可能的位置点。
图4确定物体位置点。
图5为装置有效测量区示意图。
图6为超声波收发电路图。
图7为单片机处理电路图。
图8为超声波处理程序流程图。
图中:TR1-超声波收发传感器1;TR2-超声波收发传感器2;L-TR1与TR2之间的距离;A、B-待测物体;D、E、F、G、H、I-物体可能的位置点。
五、具体实施方式:
1、超声波定位原理分析
本装置需要两个超声波收发传感器,利用超声波测距通过一定的算法将各个物体与收发传感器之间的距离计算出来,构成若干个三角形,进而确定物体的位置。
超声波测距原理是利用飞越时间法(time of flight,TOF),即检测超声波往返的时间,所用时间与超声波通过距离成正比,从而计算出超声波所经的距离。当超声波收发传感器发出一个短暂脉冲时,计时开始;当超声波收发传感器接收到一个返回脉冲时,记录得到时间值t。则超声波传播的路程为d=vt,其中d为传感器与被测物体之间的距离;v为超声波在介质中的传播速度。
按物体与收发传感器之间的距离关系可分两种情况进行分析,即:1、所有物体与任一收发传感器距离不等;2、至少有两个物体与某一收发传感器距离相等。由后面的分析可知上述两种情况可以合二为一,但分情况研究可以简化对数据的处理过程。
1.1所有物体与任一收发传感器距离不等
以二维平面内任意两物体说明超声波定位流程(如图1所示)
图中有收发传感器1、收发传感器2、任意位置两个(也可以多个)物体A和B,收发传感器可以发送和接收超声波,两个收发传感器之间距离L为已知,通过单片机连接在一起。
可以约定,用tmn表示收发传感器1的接收时间,用Tmn表示收发传感器2的接收时间,下标m表示接收到的超声波是由第几个收发传感器发射的,下标n表示接收到第几次回波。例如t21表示收发传感器1接收到由收发传感器2发出的超声波第1次回波所用的时间。
第一步:(如图1(a)所示)收发传感器1发送一段超声波,单片机开始计时。
第二步:(如图1(b)所示)超声波遇到物体产生反射波,反射波分别被收发传感器1和收发传感器2接收,单片机分别记下接收时间。因为探测范围内有两个物体,所以每个收发传感器可以先后接收到两段反射波,而此时无法判断先收到的是哪一个物体的反射波。记收发传感器1先后收到反射波的时间为t11、t12,收发传感器2先后收到反射波的时间为T11、T12。
第三步:(如图1(c)所示)收发传感器2发送一段超声波,单片机重新开始计时。
第四步:(如图1(d)所示)超声波遇到物体产生反射波,反射波分别被收发传感器1和收发传感器2接收,单片机分别记下接收时间。如第二步所述,记收发传感器1先后收到反射波的时间为t21、t22,收发传感器2先后收到反射波的时间为T21、T22。
处理数据:由几何关系可知:
T11=t21(1)
T12=t22(2)
利用(1)(2)两式可以判断数据的有效性,如不满足上述两式,可能原因是所测物体速度已超出仪器精度,应将数据舍弃。
以收发传感器1为圆心,以t11/2、t12/2为半径分别画圆,然后以收发传感器2为圆心,以T21/2、T22/2为半径分别画圆,可得出四个交点D、E、F、G,如图2所示。
假设t11/2不等于t12/2,则可以判断物体的位置在D、F或者G、E,即如果将圆弧相交所得的图形看作是扭曲的“矩形”,则物体所处位置的连线只能是“矩形”的对角线。所以只需判断D、E、F、G任意一点是不是物体所处的位置即可定位两物体,因为F点与收发传感器1和收发传感器2距离之和最近,所以只需判断t11/2与T21/2的和是否等于T11,如果等于,则F点即为物体位置点,反之F点不是物体位置点。这样就确定了两物体的位置。
1.2至少有两个物体与某一收发传感器距离相等
上述分析是建立在对两个收发传感器可以画出相同个数圆弧的条件下的,如果此条件不成立,例如对收发传感器2可以画出3个圆弧(即收发传感器2发送一段超声波后收到3次回波),也就是说有两个物体与收发传感器1距离相同,那么将有以下变动:
在第二步中收发传感器2将收到3次回波,设为T11、T12、T13。
在第四步中收发传感器1将收到3次回波,设为t21、t22、t23,收发传感器2将收到3次回波,设为T21、T22、T23。
由几何关系可知:
T11=t21 (3)
T12=t22 (4)
T13=t23 (5)
绘制圆弧分析如图3所示。
由图3可知物体可能的位置点有6个,即D、E、F、G、H、I。利用T11、T12、T13或者t21、t22、t23可以确定物体的位置。例如如果t11/2与T21/2之和等于t21,则可判断F点即为物体位置点,反之F点不是位置点。以t21、t22、t23分别为长轴,以收发传感器1、2为焦点画椭圆,椭圆轨迹应当经过D、E、F、G、H、I中3点,即为物体的实际位置点。假设椭圆轨迹过E、G、I三点,如图4所示。
则E、G、I三点即为物体实际位置点。
如果情况进一步特殊,例如在第二步中收发传感器1收到两次回波,而收发传感器2收到三次回波,在第四步中收发传感器1收到三次回波,收发传感器2收到两次回波,上述分析方法同样适用。
2、测量范围
每个收发传感器都有其测量范围,采用本方法的装置测量范围为两收发传感器的交集,如图5所示。
3、本发明对物体定位步骤如下:
1)先由TR1发送一段超声波,经物体反射后由TR1、TR2接收,并记录相应接收时间为t11、t12、t13……,T11、T12、T13……;
2)再由TR2发送一段超声波,经物体反射后由TR1、TR2接收,并记录相应接收时间为t21、t22、t23……,T21、T22、T23……;
3)是否满足T11=t21、T12=t22、T13=t23……如不满足,将所测数据舍弃;
4)在t11、T12、t13……找出一个数据x,在T21、T22、T23……找出一个数据y,在t21、t22、t23……中找出一个数据z,使x+y=2*z,则由x、y和L可以构成一个三角形,即可确定一个物体的位置;
重复第4步,直到t21、t22、t23……中数据全部用到,即可确定有效测量范围内的每个物体的位置;
4、超声波定位电路:
如图6所示,40Khz超声波信号通过INPUT端输入到放大电路,经过三极管Q1、变压器TR1放大后由收发传感器TR1发射出去。超声波遇到物体返回后由TR1接收,因为超声波信号比较微弱,装换为电信号后幅值很小,因此首先要经行放大。超声信号在传输过程中不可避免地混有环境中的噪声,超声波传输距离和角度的变化也会引起信号电平的变化。因此,接收时必须对原始信号进行适当的调理,尽可能地减小这些因素的影响。电信号经过R1,C1送到U2,U
2为选频放大器,对信号进行滤波放大后由OUTPUT端输出。D 1、D2反向并联起到限幅通过作用,因为反射波信号较弱,无法通过D1、D2,减少了对反射信号的衰减。而发射波信号较强,使D3、D4导通,进而屏蔽了发射波对U2的影响。
超声波处理电路如图7所示,单片机采用Atmega16,图中电源未画出,可使用直流5V稳压电源,8MHz晶振,用12864点阵液晶屏显示物体位置。也可以不用液晶屏,由单片机通信接口将探测信息输出至其他应用电路。单片机采用定时器0产生40KHz矩形波通过OUTPUT1、OUTPUT2端轮流输出,由INPUT1、INPUT2端接收超声波信号。
因为需要用两个收发传感器,所以实际电路中需要两组如图6中的电路,分别于图7中电路相连接,即收发电路中INPUT接单片机中OUTPUT1,收发电路中OUTPUT接单片机中INPUT1,同理另外一组收发电路与单片机中OUTPUT2、INPUT2相接。单片机处理后数据可由TWI、USART等通信接口送至其他应用电路。
5、单片机程序执行流程
单片机中超声波处理部分程序流程图如图8所示。
将数据t11、t12、t13……存入数组t1[],T11、T12、T13……存入T1[],t21、t22、t23……存入t2[],T11、T22、T23……存入T2[]。
数组r1[],r2[]用来存放显示数据。单片机计算出某个物体位置后,将该物体与TR1距离存放在r1[],与TR2距离存放在r2[],当液晶屏或者其他电路需要物体信息时,读取数组r1[]、r2[]对应数据即可。
可在显示屏上定出坐标,显示屏上的图像即为两个收发传感器前方二维平面内的物体分布情况,每个点均表示物体的位置,当测量精度较高时,许多点将连成线而显示出物体的轮廓。
6、说明
1、由于超声波在空气中的传播速度受温度影响,根据V≈331.4+0.607T可以对超声波的速度加以校正,得到较好的定位精度;
2、因为超声波传播速度容易受天气因素影响,故本装置适于在室内环境中使用;
3、主要有以下几种误差源影响测量结果:超声波速度误差,电路延迟误差,计时误差。其中以速度误差影响最大。
Claims (4)
1.一种利用超声波测量物体位置的方法,该方法包括以下步骤:
1)先由TR1发送一段超声波,经物体反射后由TR1、TR2接收,并记录相应接收时间为t11、t12、t13……,T11、T12、T13……;
2)再由TR2发送一段超声波,经物体反射后由TR1、TR2接收,并记录相应接收时间为t21、t22、t23……,T21、T22、T23……;
3)是否满足T11=t21、T12=t22、T13=t23……如不满足,将所测数据舍弃;
4)在t11、t12、t13……找出一个数据x,在T21、T22、T23……找出一个数据y,在t21、t22、t23……中找出一个数据z,使x+y=2*z,则由x、y和L构成一个三角形,即可确定一个物体的位置;
5)重复第4步,直到t21、t22、t23……中数据全部用到,即可确定有效测量范围内的每个物体的位置。
2.一种超声波测量物体位置的装置:其特征在于它包括处理信号用的单片机,至少两个超声波收发传感器,每个传感器通过收发电路与单片机相连。
3.根据权利要求2所述超声波测量物体位置的装置,其特征是:它包括两个超声波收发传感器。
4.根据权利要求2或3所述超声波测量物体位置的装置,其特征是:该装置还包括液晶显示器,该液晶显示器与单片机相连。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2010102135359A CN101881832B (zh) | 2010-06-30 | 2010-06-30 | 利用超声波测量物体位置的方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2010102135359A CN101881832B (zh) | 2010-06-30 | 2010-06-30 | 利用超声波测量物体位置的方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101881832A true CN101881832A (zh) | 2010-11-10 |
CN101881832B CN101881832B (zh) | 2012-07-04 |
Family
ID=43053891
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2010102135359A Expired - Fee Related CN101881832B (zh) | 2010-06-30 | 2010-06-30 | 利用超声波测量物体位置的方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101881832B (zh) |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102590815A (zh) * | 2011-01-05 | 2012-07-18 | 苏州巴米特信息科技有限公司 | 一种基于超声波的移动测距方法 |
WO2013127094A1 (zh) * | 2012-03-02 | 2013-09-06 | 华南理工大学 | 一种超声波探头空间位置和三维姿态的检测装置及方法 |
CN103344959A (zh) * | 2013-07-22 | 2013-10-09 | 乾行讯科(北京)科技有限公司 | 一种超声定位系统和具有定位功能的电子装置 |
CN105738905A (zh) * | 2016-05-16 | 2016-07-06 | 北京信息科技大学 | 一种减少盲区的室内定位系统及方法 |
WO2017144023A1 (zh) * | 2016-02-27 | 2017-08-31 | 林项武 | 部分或整体人体轮廓数据的获取装置和方法及其应用方法 |
CN108354492A (zh) * | 2018-05-12 | 2018-08-03 | 刘中华 | 一种多功能智能淋浴装置 |
GB2560191A (en) * | 2017-03-03 | 2018-09-05 | Bae Systems Plc | A Transceiver |
CN110596711A (zh) * | 2019-08-23 | 2019-12-20 | 国创新能源汽车能源与信息创新中心(江苏)有限公司 | 一种高精度超声波测距系统及方法 |
CN112747688A (zh) * | 2020-12-24 | 2021-05-04 | 山东大学 | 一种基于超声检测定位的离散制造业外观质量信息收集装置及其应用 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101226405A (zh) * | 2008-01-18 | 2008-07-23 | 浙江工业大学 | 基于超声波源的二维定位控制系统 |
CN101701937A (zh) * | 2009-11-09 | 2010-05-05 | 哈尔滨工程大学 | 一种超声无损检测方法及检测装置 |
CN201698020U (zh) * | 2010-06-30 | 2011-01-05 | 南京信息工程大学 | 超声波测量物体位置的装置 |
-
2010
- 2010-06-30 CN CN2010102135359A patent/CN101881832B/zh not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101226405A (zh) * | 2008-01-18 | 2008-07-23 | 浙江工业大学 | 基于超声波源的二维定位控制系统 |
CN101701937A (zh) * | 2009-11-09 | 2010-05-05 | 哈尔滨工程大学 | 一种超声无损检测方法及检测装置 |
CN201698020U (zh) * | 2010-06-30 | 2011-01-05 | 南京信息工程大学 | 超声波测量物体位置的装置 |
Non-Patent Citations (2)
Title |
---|
《传感器世界》 20070930 罗曦等 基于超声波传感器多目标定位系统 第25-26页摘要、第二节、图1,第27页第五节第1段 2-4 , 第09期 2 * |
《枣庄学院学报》 20080430 卢纪丽 多超声波传感器智能定位系统 79-81 1-4 第25卷, 第02期 2 * |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102590815A (zh) * | 2011-01-05 | 2012-07-18 | 苏州巴米特信息科技有限公司 | 一种基于超声波的移动测距方法 |
WO2013127094A1 (zh) * | 2012-03-02 | 2013-09-06 | 华南理工大学 | 一种超声波探头空间位置和三维姿态的检测装置及方法 |
CN103344959A (zh) * | 2013-07-22 | 2013-10-09 | 乾行讯科(北京)科技有限公司 | 一种超声定位系统和具有定位功能的电子装置 |
CN103344959B (zh) * | 2013-07-22 | 2016-04-20 | 苏州触达信息技术有限公司 | 一种超声定位系统和具有定位功能的电子装置 |
WO2017144023A1 (zh) * | 2016-02-27 | 2017-08-31 | 林项武 | 部分或整体人体轮廓数据的获取装置和方法及其应用方法 |
CN105738905A (zh) * | 2016-05-16 | 2016-07-06 | 北京信息科技大学 | 一种减少盲区的室内定位系统及方法 |
GB2560191A (en) * | 2017-03-03 | 2018-09-05 | Bae Systems Plc | A Transceiver |
CN108354492A (zh) * | 2018-05-12 | 2018-08-03 | 刘中华 | 一种多功能智能淋浴装置 |
CN110596711A (zh) * | 2019-08-23 | 2019-12-20 | 国创新能源汽车能源与信息创新中心(江苏)有限公司 | 一种高精度超声波测距系统及方法 |
CN112747688A (zh) * | 2020-12-24 | 2021-05-04 | 山东大学 | 一种基于超声检测定位的离散制造业外观质量信息收集装置及其应用 |
Also Published As
Publication number | Publication date |
---|---|
CN101881832B (zh) | 2012-07-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101881832B (zh) | 利用超声波测量物体位置的方法及装置 | |
CN104062633B (zh) | 一种基于超声波的室内定位系统及方法 | |
CN103462643B (zh) | 一种剪切波速度测量方法、装置和系统 | |
CN101004353A (zh) | 一种用于超声波流量计时差交叉检测方法 | |
CN102636252A (zh) | 一种超声波到达精确时刻检测的方法及装置 | |
CN103868555A (zh) | 一种用于超声波流量计的循环时差检测方法 | |
CN103149566A (zh) | 一种电子测距装置 | |
CN101644776A (zh) | 一种获取超声波测量装置中电路延迟时间的方法 | |
CN103593093A (zh) | 一种触控显示装置及其实现方法 | |
CN104076364A (zh) | 基于超声波定位技术的汽车障碍探测系统 | |
CN201698020U (zh) | 超声波测量物体位置的装置 | |
CN107179538A (zh) | 一种全象限超声波定位测距的方法及系统 | |
CN104535141A (zh) | 超声波流量计的流速模拟系统及方法 | |
CN204347059U (zh) | 一种多输入多输出阵列式超声测风系统 | |
CN102841343A (zh) | 一种基于工控机的回声测深仪校准系统及其校准方法 | |
CN104569484A (zh) | 一种多输入多输出阵列式超声测风系统及测量方法 | |
CN104267376A (zh) | 一种基于超声波的智能车自动定位系统及方法 | |
CN107642355B (zh) | 基于超声波发射法的水力压裂裂缝监测系统及方法 | |
CN104536003A (zh) | 基于多种发射频率的超声波测距方法及其装置 | |
CN102778510A (zh) | 变壁厚零件超声透射检测方法 | |
CN105738905A (zh) | 一种减少盲区的室内定位系统及方法 | |
CN101029927A (zh) | 一种增大超声波测距范围的方法及装置 | |
CN109471111A (zh) | 一种可抗声波干扰的超声波传感器组及目标定位方法 | |
CN205193278U (zh) | 一种基于超声波传感器的自动测距装置 | |
CN105467395A (zh) | 一种超远距离超声波测量仪 |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20120704 Termination date: 20150630 |
|
EXPY | Termination of patent right or utility model |