CN106933230A - 一种用于机器人跟踪与避障的超声波传感器***的控制方法 - Google Patents
一种用于机器人跟踪与避障的超声波传感器***的控制方法 Download PDFInfo
- Publication number
- CN106933230A CN106933230A CN201710231307.6A CN201710231307A CN106933230A CN 106933230 A CN106933230 A CN 106933230A CN 201710231307 A CN201710231307 A CN 201710231307A CN 106933230 A CN106933230 A CN 106933230A
- Authority
- CN
- China
- Prior art keywords
- ultrasonic
- ultrasonic sensor
- avoidance
- sensor
- control method
- 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
- 238000000034 method Methods 0.000 title claims abstract description 20
- 238000001514 detection method Methods 0.000 claims description 12
- 230000005855 radiation Effects 0.000 claims description 5
- 239000000523 sample Substances 0.000 description 5
- 238000010586 diagram Methods 0.000 description 3
- 230000000694 effects Effects 0.000 description 3
- 238000006467 substitution reaction Methods 0.000 description 2
- 230000004888 barrier function Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000011217 control strategy Methods 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000003780 insertion Methods 0.000 description 1
- 230000037431 insertion Effects 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0255—Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
- G01S15/66—Sonar tracking systems
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
- G01S15/88—Sonar systems specially adapted for specific applications
- G01S15/93—Sonar systems specially adapted for specific applications for anti-collision purposes
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Acoustics & Sound (AREA)
- Computer Networks & Wireless Communication (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
- Manipulator (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种用于机器人跟踪与避障的超声波传感器***的控制方法,本发明仅使用超声波传感器就同时实现了避障与跟踪双功能,有效降低了***成本,采用本发明的控制方法,还可以有效降低超声波传感器之间的噪声干扰,提高传感器的可靠性,并且,本发明所述控制方法逻辑简单,容易实现。
Description
技术领域
本发明涉及机器人控制技术领域,特别是一种用于机器人跟踪与避障的超声波传感器***的控制方法。
背景技术
目前,已有的应用超声波传感器实现目标跟踪的***,通常采用辅助传感器或无线通讯设备实现移动目标和移动机器人之间的信号同步,进而测量移动目标与移动机器人之间的位置信息。已有的应用超声波传感器实现移动机器人避障功能的***,通常采用直接控制或简单的延时实现避障超声波传感器之间的相互干扰。现有技术中没有在同一***中同时实现跟踪与避障,究其原因在于超声波传感器本身噪声大,不易控制,当两种功能同时用超声波传感器实现时,数据的可靠性不可预测。
发明内容
本发明要解决的技术问题是针对上述现有技术的不足,而提供一种同时实现跟踪与避障功能的超声波传感器***及其控制方法。
为解决上述技术问题,本发明采用的技术方案是:
一种用于机器人跟踪与避障的超声波传感器***的控制方法,所述超声波传感器***中包括三种传感器,分别为:避障用超声波传感器、移动目标用超声波传感器和用来接收目标信息的超声波传感器,分别简称为SA、ST和SR,以上所述超声波传感器的最大测距均为S,超声波的传播速度均为V,所述控制方法包括以下步骤:
第一步,信号同步及目标位置计算,具体步骤包括:
a.t1时刻,控制器关闭SR接收功能,控制SR发送超声波信号,等待Δt时间,SR开启接收功能;
b.ST发射接收功能同时开启,ST接收到SR的超声波信号后,等待Δt时间,
发射超声波信号;
c.SR在接收到ST的超声波信号后,记录当前时间t2;
d.ST相对于SR的距离为:
L=(t2-t1-Δt)×t2
其中,Δt的取值满足:
Δt≥2S/V
第二步,将移动机器人上安装的SA依次编号为1,2,…,K,再将第一步中计算所得的目标位置与移动机器人中心连线,设距离连线最近的两个SA的编号为i,i+1,此时,将ST编号为i+1,编号为i+1的SA以及后续的SA重新编号为i+2,i+3,...,K+1;
第三步,为降低超声波传感器之间的干扰,对1,2,…,K+1编号的SA采用分组策略控制,具体步骤包括:
a.从i号传感器开始,以连续N个超声波传感器为一组,其中,N≥n,n满足:
将每组中的N个超声波传感器重新依次编号为1,2,3,…...,N;其中,α为相邻两个ST的安装偏角;θ为超声波传感器的辐射角度;
αi+j为第i号与第j号这两个超声波传感器之间的安装偏角;
b.第一次分组后,将整个超声波传感器***中编号相同的超声波传感器作为一组,重新分组为G1,G2,.....,GN,不考虑超声波的折射时,Gi组的超声波传感器可同时工作而不相互影响;若取N=n,将使得超声波传感器***的采样频率最高;
c.相邻的Gi组工作之间***时间间隔Δt,由于超声波传感器最大有效探测距离的限制,传感器发射的超声波将在Δt时间后能量消耗殆尽,避免了不同组之间的超声波干扰;
第四步,完成一次数据采集后,运算跟踪和避障算法,然后跳至第二步循环。
一种用于机器人跟踪与避障的超声波传感器***的控制方法,所述第三步中取N=n,使得超声波探测***的采样频率最高,此时,探测***的工作频率为:
本发明具有如下技术效果:
本发明仅使用超声波传感器就同时实现了避障与跟踪双功能,有效降低了***成本,采用本发明的控制方法,还可以有效降低超声波传感器之间的噪声干扰,提高传感器的可靠性,并且,本发明所述控制方法逻辑简单,容易实现。
附图说明
图1a为避障用超声波传感器和移动目标用超声波传感器安装示意的侧视图;
图1b为避障用超声波传感器和移动目标用超声波传感器安装示意的俯视图;
图2是避障用超声波传感器编号过程示意图;
图3是将移动目标用超声波传感器动态***分组示意图;
图4是最终的Gi分组控制策略示意图。
具体实施方式
现在结合附图对本发明作进一步详细的说明。这些附图均为简化的示意图,仅以示意方式说明本发明的基本结构,因此其仅显示与本发明有关的构成。
图2-4中的1-14标号为传感器的编号。
一种用于机器人跟踪与避障的超声波传感器***的控制方法,所述超声波传感器***中包括三种传感器,分别为:避障用超声波传感器SA、移动目标用超声波传感器ST和用来接收目标信息的超声波传感器SR,所述控制方法包括以下步骤:
第一步,信号同步及目标位置计算,具体步骤包括:
a.t1时刻,控制器关闭SR接收功能,控制SR发送超声波信号,等待Δt时间,SR开启接收功能;
b.ST发射接收功能同时开启,ST接收到SR的超声波信号后,等待Δt时间,发射超声波信号;
c.SR在接收到ST的超声波信号后,记录当前时间t2;
d.ST相对于SR的距离为:
L=(t2-t1-△t)×t2
通过多个SR得到的L,可进一步求得ST相对于SR的距离与偏角信息,即移动目标相对于移动机器人的位置信息;其中,Δt的取值满足:
Δt≥2S/V
第二步,将移动机器人上安装的SA依次编号为1,2,…,K,再将第一步中计算所得的目标位置与移动机器人中心连线,设距离连线最近的两个避障超声波传感器SA的编号为i,i+1,此时,将ST编号为新的i+1,原来的i+1以及后续的传感器重新编号为i+2,i+3,...,K+1;
第三步,为降低超声波传感器之间的干扰,对1,2,…,K+1编号的超声波传感器采用分组策略控制,具体步骤包括:
a.从i号传感器开始,以连续N(N≥n)个超声波传感器为一组,其中n满足:
将每组中的N个超声波传感器重新依次编号为1,2,3,…...,N;其中,α为相邻两个超声波传感器的安装偏角;θ为超声波传感器的辐射角度;αi+j为第i号与第j号这两个超声波传感器之间的安装偏角;
若取N=n,将使得超声波探测***的采样频率最高,此时,探测***的工作频率为:
b.第一次分组后,将整个探测***中编号相同的超声波传感器作为一组,重新分组为G1,,G2,.....,GN,不考虑超声波的折射时,Gi组的超声波传感器可同时工作而不相互影响;若取N=n,将使得超声波探测***的采样频率最高;
c.相邻的Gi组工作之间***时间间隔Δt,由于超声波传感器最大有效探测距离的限制,传感器发射的超声波将在Δt时间后能量消耗殆尽,可以有效的避免不同组之间的超声波干扰,而不需要考虑超声波的折射反射问题;
第四步,完成一次数据采集后,运算跟踪和避障算法,然后跳至第二步循环。
实施例1
如图1a、1b所示,以一台服务机器人为例,根据用途不同,避障超声波传感器和跟踪用超声波传感器安装在不同的水平面上,避障超声波传感器2直接安装在小车1上,跟踪用超声波传感器3安装在较高位置,方便人的引导。
本实施例中采用HC-SR04超声波传感器,超声波传感器的辐射角度θ为300,最大有效探测距离S为4000mm,相邻两个超声波传感器的安装偏角α为150。
如图2所示,探测***中超声波传感器数量为13,并依次编号为1,2,…,13。
在此实施例中,为避免干扰,第一次分组中,每一组的超声波传感器的最小数量为:
代入参数后求得n为3。
如图3所示,当跟踪用超声波传感器3获得目标位置后,通过几何计算司获得跟踪超声波传感器对避障超声波传感器的最大影响位置,根据计算结果,目标位置与机器人中心的连线与9号避障超声波传感器中和10号避障超声波传感器之间穿过,因此,将移动目标的超声波传感器编号为10,原来避障超声波传感器中的10,11,12,13重新编号为11,12,13,14。
根据第三步中的a步骤的原理,从1号传感器开始,以连续N(N≥n)个超声波传感器为一组,取N=4,将超声波传感器再次编号如图4所示。图中,相同纹理的超声波传感器可同时工作,此时,整套超声波传感器***相互之间的干扰最小。
根据HC-SR04的最大量程,设当前声速为v=340m/s,求得:
Δt≥23529us
最后,取Δt=25ms,在Gi之间***25ms的延时,此时,探测***的工作频率为:
本发明可以在多个超声波传感器组成的探测***中同时实现跟踪与避障,实际应用中,超声波可能因为多次反射形成固定路径,而对辐射角以外的探头产生干扰,但这种情况只发生在传感器位置固定不变的情况下,动态环境下的影响很小,不予考虑。因此,采用本发明的超声波传感器控制方法,可以有效的降低探测***中超声波传感器之间的相互干扰,使得超声波传感器的测量数据稳定可靠。并且,本发明方法逻辑简单,实现容易。
尽管本发明的内容已经通过上述实施例作了详细介绍,但应当认识到上述的描述不应被认为是对本发明的限制。在本领域技术人员阅读了上述内容后,对于本发明的多种修改和替代都将是显而易见的。因此,本发明的保护范围应由所附的权利要求来限定。
Claims (2)
1.一种用于机器人跟踪与避障的超声波传感器***的控制方法,其特征在于:所述超声波传感器***中包括三种传感器,分别为:避障用超声波传感器、移动目标用超声波传感器和用来接收目标信息的超声波传感器,分别简称为SA、ST和SR,以上所述超声波传感器的最大测距均为S,超声波的传播速度均为V,所述控制方法包括以下步骤:
第一步,信号同步及目标位置计算,具体步骤包括:
a.t1时刻,控制器关闭SR接收功能,控制SR发送超声波信号,等待Δt时间,SR开启接收功能;
b.ST发射接收功能同时开启,ST接收到SR的超声波信号后,等待Δt时间,发射超声波信号;
c.SR在接收到ST的超声波信号后,记录当前时间t2;
d.ST相对于SR的距离为:
L=(t2-t1-Δt)×t2
其中,Δt的取值满足:
Δt2S/V
第二步,将移动机器人上安装的SA依次编号为1,2,…,K,再将第一步中计算所得的目标位置与移动机器人中心连线,设距离连线最近的两个SA的编号为i,i+1,此时,将ST编号为i+1,编号为i+1的SA以及后续的SA重新编号为i+2,i+3,...,K+1;
第三步,为降低超声波传感器之间的干扰,对1,2,…,K+1编号的SA采用分组策略控制,具体步骤包括:
a.从i号传感器开始,以连续N个超声波传感器为一组,其中,N≥n,n满足:
将每组中的N个超声波传感器重新依次编号为1,2,3,…...,N;其中,α为相邻两个ST的安装偏角;θ为超声波传感器的辐射角度;
αi+j为第i号与第j号这两个超声波传感器之间的安装偏角;
b.第一次分组后,将整个超声波传感器***中编号相同的超声波传感器作为一组,重新分组为G1,G2,.....,GN,不考虑超声波的折射时,Gi组的超声波传感器可同时工作而不相互影响;若取N=n,将使得超声波传感器***的采样频率最高;
c.相邻的Gi组工作之间***时间间隔Δt,由于超声波传感器最大有效探测距离的限制,传感器发射的超声波将在Δt时间后能量消耗殆尽,避免了不同组之间的超声波干扰;
第四步,完成一次数据采集后,运算跟踪和避障算法,然后跳至第二步循环。
2.根据权利要求1所述的用于机器人跟踪与避障的超声波传感器***的控制方法,其特征在于:所述第三步中取N=n,使得超声波探测***的采样频率最高,此时,探测***的工作频率为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710231307.6A CN106933230B (zh) | 2017-04-11 | 2017-04-11 | 用于机器人跟踪与避障的超声波传感器***的控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710231307.6A CN106933230B (zh) | 2017-04-11 | 2017-04-11 | 用于机器人跟踪与避障的超声波传感器***的控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106933230A true CN106933230A (zh) | 2017-07-07 |
CN106933230B CN106933230B (zh) | 2019-09-10 |
Family
ID=59425690
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710231307.6A Active CN106933230B (zh) | 2017-04-11 | 2017-04-11 | 用于机器人跟踪与避障的超声波传感器***的控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106933230B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107526085A (zh) * | 2017-07-25 | 2017-12-29 | 福建网龙计算机网络信息技术有限公司 | 超声波阵列测距建模的方法及其*** |
CN108196539A (zh) * | 2017-12-29 | 2018-06-22 | 深圳市艾特智能科技有限公司 | 机器人避障方法、***、可读存储介质及机器人 |
CN114355358A (zh) * | 2021-12-10 | 2022-04-15 | 厦门攸信信息技术有限公司 | 基于超声波测距的智能避障装置及其避障方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20020075180A1 (en) * | 2000-10-26 | 2002-06-20 | Matsushita Electric Works, Ltd. | Autonomous moving apparatus having obstacle avoidance funtion |
JP2005128722A (ja) * | 2003-10-23 | 2005-05-19 | Matsushita Electric Works Ltd | 障害物回避機能付き車両 |
CN102445694A (zh) * | 2011-09-20 | 2012-05-09 | 中南大学 | 导航机器人障碍探测方法及*** |
CN104000694A (zh) * | 2014-05-27 | 2014-08-27 | 上海交通大学 | 电动轮椅辅助驾驶***及方法 |
CN204188805U (zh) * | 2014-09-29 | 2015-03-04 | 江门市东方智慧物联网科技有限公司 | 一种移动机器人感侦结构 |
CN105182971A (zh) * | 2015-08-21 | 2015-12-23 | 河海大学常州校区 | 一种室内环境下服务机器人的避障方法 |
CN105629970A (zh) * | 2014-11-03 | 2016-06-01 | 贵州亿丰升华科技机器人有限公司 | 一种基于超声波的机器人定位避障方法 |
CN105739499A (zh) * | 2016-03-17 | 2016-07-06 | 江苏物联网研究发展中心 | 自主移动机器人避障***的多路红外及超声波传感器分布结构 |
-
2017
- 2017-04-11 CN CN201710231307.6A patent/CN106933230B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20020075180A1 (en) * | 2000-10-26 | 2002-06-20 | Matsushita Electric Works, Ltd. | Autonomous moving apparatus having obstacle avoidance funtion |
JP2005128722A (ja) * | 2003-10-23 | 2005-05-19 | Matsushita Electric Works Ltd | 障害物回避機能付き車両 |
CN102445694A (zh) * | 2011-09-20 | 2012-05-09 | 中南大学 | 导航机器人障碍探测方法及*** |
CN104000694A (zh) * | 2014-05-27 | 2014-08-27 | 上海交通大学 | 电动轮椅辅助驾驶***及方法 |
CN204188805U (zh) * | 2014-09-29 | 2015-03-04 | 江门市东方智慧物联网科技有限公司 | 一种移动机器人感侦结构 |
CN105629970A (zh) * | 2014-11-03 | 2016-06-01 | 贵州亿丰升华科技机器人有限公司 | 一种基于超声波的机器人定位避障方法 |
CN105182971A (zh) * | 2015-08-21 | 2015-12-23 | 河海大学常州校区 | 一种室内环境下服务机器人的避障方法 |
CN105739499A (zh) * | 2016-03-17 | 2016-07-06 | 江苏物联网研究发展中心 | 自主移动机器人避障***的多路红外及超声波传感器分布结构 |
Non-Patent Citations (1)
Title |
---|
王景川 等: "基于多传感器的智能轮椅设计与实现", 《南京理工大学学报(自然科学版)》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107526085A (zh) * | 2017-07-25 | 2017-12-29 | 福建网龙计算机网络信息技术有限公司 | 超声波阵列测距建模的方法及其*** |
CN107526085B (zh) * | 2017-07-25 | 2020-07-14 | 福建网龙计算机网络信息技术有限公司 | 超声波阵列测距建模的方法及其*** |
CN108196539A (zh) * | 2017-12-29 | 2018-06-22 | 深圳市艾特智能科技有限公司 | 机器人避障方法、***、可读存储介质及机器人 |
CN114355358A (zh) * | 2021-12-10 | 2022-04-15 | 厦门攸信信息技术有限公司 | 基于超声波测距的智能避障装置及其避障方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106933230B (zh) | 2019-09-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104714209B (zh) | 一种基于uwb与激光测距组合的动态定位方法及装置 | |
CN101968162B (zh) | 基于负压波和声波协同检测的管道泄漏定位***及方法 | |
CN106933230A (zh) | 一种用于机器人跟踪与避障的超声波传感器***的控制方法 | |
CN101881832B (zh) | 利用超声波测量物***置的方法及装置 | |
CN108415417A (zh) | 一种基于障碍物运动状态预测的机器人避障***及方法 | |
CN104569484B (zh) | 一种多输入多输出阵列式超声测风***及测量方法 | |
CN105203996A (zh) | 移动设备及其室内定位方法、***及装置、锚节点 | |
CN108267719B (zh) | 一种水下多个信标实时定位的方法 | |
CN103792513B (zh) | 一种雷声定位***及方法 | |
CN104155030B (zh) | 一种考虑声线弯曲的声学ct温度场重建方法 | |
CN105629241A (zh) | 一种基于分体超声结合射频的机器人定位方法 | |
CN103941232A (zh) | 一种基于时间反转聚焦技术的声发射源定位方法 | |
CN107271962A (zh) | 基于超声波的室内定位***及其定位方法 | |
CN109884639A (zh) | 用于移动机器人的障碍物探测方法及装置 | |
CN107796403A (zh) | 机器人的移动方法、装置和机器人 | |
CN108169752A (zh) | 一种基于无线通信的超声波测距方法及*** | |
CN106772326A (zh) | 一种多子阵合成孔径声纳相位误差分析方法 | |
KR101172354B1 (ko) | 회전형 마이크로폰 어레이를 이용한 음원 방향 검지 장치 및 방법 | |
CN105320367A (zh) | 一种舞台交互*** | |
CN105738905A (zh) | 一种减少盲区的室内定位***及方法 | |
CA3111960A1 (en) | Acoustic air data system with radially paired receivers | |
CN103163502B (zh) | 一种大孔径水声柔性阵阵形自校准装置及方法 | |
CN206945956U (zh) | 采用超声波的室内移动定位*** | |
CN107024695A (zh) | 用于机器人避障的超声波测距传感器***及其控制方法 | |
CN201698020U (zh) | 超声波测量物***置的装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |