CN113671442A - 基于矢量水听器技术的水下无人集群导航定位方法 - Google Patents
基于矢量水听器技术的水下无人集群导航定位方法 Download PDFInfo
- Publication number
- CN113671442A CN113671442A CN202110868120.3A CN202110868120A CN113671442A CN 113671442 A CN113671442 A CN 113671442A CN 202110868120 A CN202110868120 A CN 202110868120A CN 113671442 A CN113671442 A CN 113671442A
- Authority
- CN
- China
- Prior art keywords
- node
- navigation
- passive
- main node
- cluster
- 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 44
- 239000013598 vector Substances 0.000 title claims abstract description 41
- 238000005516 engineering process Methods 0.000 title claims abstract description 15
- 230000015572 biosynthetic process Effects 0.000 claims abstract description 24
- 238000012423 maintenance Methods 0.000 claims abstract description 5
- 238000012545 processing Methods 0.000 claims description 7
- 238000004422 calculation algorithm Methods 0.000 claims description 5
- 230000005236 sound signal Effects 0.000 claims description 3
- 238000001228 spectrum Methods 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 description 5
- 238000004088 simulation Methods 0.000 description 3
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 238000004891 communication Methods 0.000 description 2
- 230000007547 defect Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000006073 displacement reaction Methods 0.000 description 2
- 238000001914 filtration Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000001360 synchronised effect Effects 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 1
- 230000001143 conditioned effect Effects 0.000 description 1
- 230000002500 effect on skin Effects 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000010365 information processing Effects 0.000 description 1
- 230000014759 maintenance of location Effects 0.000 description 1
- 239000002245 particle Substances 0.000 description 1
- 238000003672 processing method Methods 0.000 description 1
- 239000013535 sea water Substances 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
Images
Classifications
-
- 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
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/18—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using ultrasonic, sonic, or infrasonic waves
- G01S5/22—Position of source determined by co-ordinating a plurality of position lines defined by path-difference measurements
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
Abstract
本发明提供一些基于矢量水听器技术的水下无人集群导航定位方法，包括，集群***中的主节点的发射声源和精确导航***作为导航信息来源；主节点、被动节点完成时间同步设定；在集群航行过程中主节点按照2秒1次的重复周期发射含有信息的声脉冲信号；集群航行器中的被动节点接收到主节点发射的声信号后进行分析处理，通过声脉冲信号解算出自身与主节点的相对方位和距离；通过声脉冲信号获取当前要保持的编队形式；将获得方位和距离信息合并后取得绝对大地坐标；被动节点计算偏航后，按照编队形式调整自身相对主节点的位置，实现编队保持。本发明中提供了完善的水下声学导航手段和编队能力，功能完善、定位精度高、使用方便等优点。
Description
技术领域
本发明涉及水下无人***导航与定位领域，具体为一种基于矢量水听器技术的水下无人集群导航定位方法。
背景技术
矢量水听器的出现被誉为“水声技术的革命”，它相较于传统声压水听器可以获得更全面的声场信息，矢量水听器可以获取水下声场中的矢量信息，包括水质点的位移、振速、加速度及声压梯度等。如今，振速、加速度及声压梯度式矢量水听器的技术已经趋于成熟，在水声的各个领域中都有着广泛的应用。水下无人集群导航与定位的原理和方法是，当水下无人航行器由于海水的“趋肤效应”而无法获取无线电导航定位信号，而且由于能量载荷等原因无法采用大型惯性导航***时，采用矢量水听器和矢量信号处理方法完成对水下无人集群进行导航的声学方法。水下无人集群的导航定位是水下UUV集群的关键问题，目前采用矢量水听器声学原理的水下集群导航尚无人研究，该研究尚处于起步阶段。
目前传统的水下无人集群导航定位的方法中，具备可实现性的是惯性导航和超短基线导航。惯性导航成本高累计误差大，每个无人节点均使用高成本惯性导航***代价是无法承受的。超短基线声学导航方法只有主站能获取被定位节点位置信息，但被动节点无法获得自身与主节点相对位置和绝对位置，缺陷明显。小型无人集群***也可使用主从式导航，即主节点携带高精度导航设备而从节点与之进行通信通过声学***获取位置信息，但这种方法的关键在于精确获取主从节点的位置关系，然而集群***无法携带大孔径声纳阵，这种方法的精度无法保证。综上所述，目前急需开展水下无人集群导航定位新方法的研究。
近年来，UUV类水下无人集群逐渐被各个国家重视起来。国内外对于水下无人集群的研究有了一定的开展。惯性导航和超短基线水声导航的缺点不再重复，主从式水下导航的典型文献《基于水声传播延迟的主从式多无人水下航行器协同导航定位研究》(《兵工学报》2009年第12期p1674-1678)与本发明实现原理不同，其存在的最大问题是，采用文中的方法，即便使用后置滤波处理也会在在几分钟之内有高达百米量级的导航定位误差，从该文图4中可以看出，在不到1200秒时间内，其定位误差高达100m，并且随着时间的增长，其定位误差越来越大，这种误差在集群编队导航应用中是无法容忍的。
发明内容
本发明的目的在于为水下无人集群***提供一种基于矢量水听器技术的水下无人集群导航定位方法，可以使编队中的被动节点精确获取主节点的位置信息，在主动节点带领下完成绝对位置获取编队队形保持能力。
本发明提供的基于矢量水听器技术的水下无人集群导定位方法是一种仅依靠矢量水听器为核心即可完成的水下集群导航方法，其原理是，设备工作于水下，包括一个主节点和多个被动节点组成，为提高***可靠性，可设置一个被动节点携带主节点同样功能设备作为备份主节点；主节点发射宽带声波信号，被动节点采用矢量接收水听器获取声信号后，采用矢量信号处理算法，得到大型声纳阵才能获得的高精度的测向和测距结果，通过该结果计算与主节点的相对方位和距离，其后主节点发射声通信信号广播自身位置信息和指令代码，被动节点接收后解算得到自身真方位和下一步运动要素。当被动节点远离主节点作业后，主节点可以发送导向信号，被动节点接收到导向信号后可以回到主节点附近重新编队。本***具有定位导航精度高，寻回距离远并能够自主获取相对位置以保持编队队形的特点。
具体的技术方案为：
基于矢量水听器技术的水下无人集群导航定位方法，包括以下步骤：
步骤一：集群***中的主节点的发射声源和精确导航***作为导航信息来源；
步骤二：主节点、被动节点完成时间同步设定；
步骤三：在集群航行过程中主节点按照2秒1次的重复周期发射含有信息的声脉冲信号，该信号由两部分构成，第一部分是测距脉冲，第二部分是指令编码脉冲；
步骤四：集群航行器中的被动节点接收到主节点发射的声信号后进行分析处理，通过第一部分的测距脉冲解算出自身与主节点的相对方位和距离；
步骤五：通过第二部分的指令编码脉冲获取当前要保持的编队形式；
步骤六：将步骤四进行后获得方位和距离信息合并后取得绝对大地坐标；
步骤七：被动节点计算偏航后，按照编队形式调整自身相对主节点的位置，实现编队保持。
其中步骤四的分析处理，被动节点计算与主节点方位时采用的是矢量方位估计算法。
步骤四中的矢量方位估计方法为：矢量水听器可同时获得主节点所发射声信号的声压P，X轴振速Vx和Y轴振速Vy，其中声压P是标量，Vx和Vy是矢量，通过胡功率谱运算后，可以得到声强矢量，X轴声强Ix＝P×Vx，Y轴声强Iy＝P×Vy，此时主节点与被动节点的相对方位为：θ＝atan(Iy/Ix)。
当被动节点远离主节点执行任务后要返回主节点附近重新进行编队航行时，可以仍然采用上述步骤，被动节点只需远程探测主节点广播的测距脉冲，获得方位后机动至主节点附近。
本发明中的水下无人集群导航定位方法，给现有水下无人集群导航提供了完善的水下声学导航手段和编队能力，与已有的用于水下无人集群的导航定位方法相比，且具有功能完善、定位精度高、使用方便等优点，可以用于水下集群导航定位。填补了国内该领域的空白。
本发明的优点是：
1.本发明中各被动节点可以通过矢量声信息解算获得自身与主节点的相对位置，具备很高的精度，并可以通过主节点信息判断自身在编队行进中的状态。
2.各个被动节点可以通过声信息解算获取与主节点间的距离。
3.各个被动节点可以通过声指令进行位置调整而实现编队队形不变。
4.主节点和备份主节点可以提高***容错率和使用效能。
附图说明
图1是本发明的原理框图；
图2是本发明的信息处理流程图；
图3为实施例中信噪比与测向偏差之间的仿真图。
具体实施方式
结合实施例说明本发明的具体技术方案。
本发明的技术原理如图1所示，图1中的主节点发射宽带声波信号，该信号以时间同步信号为起点，包含位置信息和指令信息。被动节点1～n接收声信号后采用矢量信号处理算法计算多个参数，主要包含与主节点的相对方位、相对距离，解码主节点位置信息和指令编码。主节点的声信息从发射换能器输出，全部采用广播方式。被动节点声信息的接收均采用矢量水听器，该水听器指向性与频率无关，可以实现大孔径声纳阵才能获得的高定向精度。无论主节点发送何种声信息均可用于高精度测向。其测向精度的柯拉米罗下界为：
其中：M是样本数，M＝BT(时间带宽积)，
是俯仰角，SNR是信噪比。从式中可以看出，当集群内航行器处于同一平面内时，主节点广播信号的高带宽和较高的通信信噪比，都能给矢量水听器测向带来很大好处，因此被动节点的测向精度是很高的，由此可获得小于1％R(R是两个节点间的距离)的定位精度，不失一般性的，当R＝500米时，定位误差为5m以下。这是其它采用主从方式导航的水声***无法比拟的。
本***采用的信号分为两种，一种使编队行进和作业时的广播信号，由前缀和简单信息传输。前缀用于同步测距，之后的声信号用于信息传输和指令。当获得了与主节点的相对方位和绝对距离后，通过主节点广播的自身位置即可解算出被动节点的自身绝对位置，从而完成队形保持。第二种信号是主节点广播的导向信号，该信号用于被动节点的引导，被动节点接收到该信号后，依靠其与频率无关指向性和空间增益，得到主节点方位而后返回至主节点附近重新编队。
本发明的方法流程如图2所述，主节点在时间同步信号的引导下发射声脉冲信号，该信号通过水介质传播后，被编队中的被动节点矢量水听器所接收，接收后的信号结果调理数字化后进行三项处理，第一项处理是矢量方位解算，通过矢量信号处理算法被动节点可以获得与主节点的精确相对方位。第二项处理是通过匹配滤波方法在同步信号配合下，被动节点可以获得主节点所发射声脉冲信号的精确到达时间，进而可以通过声速解算得到其与主节点间的距离。第三项处理是解算主节点发出的广播信息，信息中包含主节点的大地坐标和指令编码。通过这三项处理后，被动节点已经完全获得了其自身位置、与主节点的相对位置和编队信息等，通过这些信息可以指导其激动和完成编队保持。
本实施例的仿真结果如图3所示。
试验工况参数为：声源频率f0＝2.5kHz，发射声源级SL＝140dB(re 1μPa@1m)。根据R.J尤力克的《水声原理》中声纳方程进行仿真计算，设作用距离R＝500m，则传播损失TL＝20lgR＝54dB，2.5kHz处的环境噪声谱级为58dB，所以信噪比SNR＝140–54–58＝28dB。通过CR下界进行计算得到图2输入信噪比和方位估计偏差之间的关系。从图中可以看出，在留有充分裕量的情况下，0dB的输入信噪比可以保证1°的方位估计精度。
由此可知，140dB声源级下，500m内的测向精度为1°是可以保证的。因此推位误差Δ＜500*sin(1°)＝8.7m。
Claims (7)
1.基于矢量水听器技术的水下无人集群导航定位方法，其特征在于，包括以下步骤：
步骤一：集群***中的主节点的发射声源和精确导航***作为导航信息来源；
步骤二：主节点、被动节点完成时间同步设定；
步骤三：在集群航行过程中主节点按照2秒1次的重复周期发射含有信息的声脉冲信号；
步骤四：集群航行器中的被动节点接收到主节点发射的声信号后进行分析处理，通过声脉冲信号解算出自身与主节点的相对方位和距离；
步骤五：通过声脉冲信号获取当前要保持的编队形式；
步骤六：将步骤四进行后获得方位和距离信息合并后取得绝对大地坐标；
步骤七：被动节点计算偏航后，按照编队形式调整自身相对主节点的位置，实现编队保持。
2.根据权利要求1所述的基于矢量水听器技术的水下无人集群导航定位方法，其特征在于，步骤三中所述的声脉冲信号，包括两部分，第一部分是测距脉冲，第二部分是指令编码脉冲。
3.根据权利要求2所述的基于矢量水听器技术的水下无人集群导航定位方法，其特征在于，步骤四中通过第一部分的测距脉冲解算出自身与主节点的相对方位和距离。
4.根据权利要求2所述的基于矢量水听器技术的水下无人集群导航定位方法，其特征在于，步骤五中通过第二部分的指令编码脉冲获取当前要保持的编队形式。
5.根据权利要求1所述的基于矢量水听器技术的水下无人集群导航定位方法，其特征在于，步骤四的分析处理，被动节点计算与主节点方位时采用的是矢量方位估计算法。
6.根据权利要求5所述的基于矢量水听器技术的水下无人集群导航定位方法，其特征在于，所述的矢量方位估计方法为：矢量水听器可同时获得主节点所发射声信号的声压P，X轴振速Vx和Y轴振速Vy，其中声压P是标量，Vx和Vy是矢量，通过胡功率谱运算后，可以得到声强矢量，X轴声强Ix＝P×Vx，Y轴声强Iy＝P×Vy，此时主节点与被动节点的相对方位为：
θ＝atan(Iy/Ix)。
7.根据权利要求6所述的基于矢量水听器技术的水下无人集群导航定位方法，其特征在于，当被动节点远离主节点执行任务后要返回主节点附近重新进行编队航行时，采用矢量方位估计，被动节点远程探测主节点广播的测距脉冲，获得方位后机动至主节点附近。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110868120.3A CN113671442B (zh) | 2021-07-30 | 基于矢量水听器技术的水下无人集群导航定位方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110868120.3A CN113671442B (zh) | 2021-07-30 | 基于矢量水听器技术的水下无人集群导航定位方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN113671442A true CN113671442A (zh) | 2021-11-19 |
| CN113671442B CN113671442B (zh) | 2024-07-09 |
Family
ID=
Citations (12)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20080165617A1 (en) * | 2007-01-04 | 2008-07-10 | Ocean Acoustical Services And Insrumentation Systems (Oasis) Inc. | Methods of and systems for continually measuring the range between mobile underwater vehicles carrying acoustical signal transmitters and remotely deployed synchronized underwater acoustical receivers provided with signal processing for continually determining such range during the underwater moving of the vehicle, and for measuring acoustic underwater transmission loss, geoacoustical properties and for other purposes |
| RU2456634C1 (ru) * | 2011-03-16 | 2012-07-20 | Юрий Николаевич Жуков | Способ навигации подводного объекта посредством гидроакустической навигационной системы |
| RU2463624C1 (ru) * | 2011-03-23 | 2012-10-10 | Юрий Николаевич Жуков | Гидроакустическая навигационная система |
| CN107728109A (zh) * | 2017-09-18 | 2018-02-23 | 哈尔滨工程大学 | 一种非合作目标辐射噪声测量定位技术 |
| US20190204430A1 (en) * | 2017-12-31 | 2019-07-04 | Woods Hole Oceanographic Institution | Submerged Vehicle Localization System and Method |
| CN110412508A (zh) * | 2019-08-06 | 2019-11-05 | 青岛国海通讯科技有限公司 | 一种基于矢量水听器的主从式多uuv协同定位方法 |
| CN110954107A (zh) * | 2019-12-04 | 2020-04-03 | 宁波羽声海洋科技有限公司 | 一种无人航行器集群协同导航方法及装置 |
| CN111273298A (zh) * | 2020-02-19 | 2020-06-12 | 国家深海基地管理中心 | 基于波浪滑翔器组网技术的水下声学目标定位与跟踪方法 |
| CN111427008A (zh) * | 2020-04-19 | 2020-07-17 | 中国电子科技集团公司电子科学研究院 | 一种用于水下自主航行器集群的位置测定方法及相关装置 |
| CN112099019A (zh) * | 2020-07-16 | 2020-12-18 | 中国海洋石油集团有限公司 | 一种水下声矢量探测装置 |
| CN112269163A (zh) * | 2020-09-30 | 2021-01-26 | 黑龙江工程学院 | 一种基于坐底单三维矢量水听器的水中声源方位深度协同跟踪方法 |
| CN112731408A (zh) * | 2020-12-31 | 2021-04-30 | 青岛海纳水下信息技术有限公司 | 矢量吊放声纳目标探测方法、反潜***以及反潜方法 |
Patent Citations (12)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20080165617A1 (en) * | 2007-01-04 | 2008-07-10 | Ocean Acoustical Services And Insrumentation Systems (Oasis) Inc. | Methods of and systems for continually measuring the range between mobile underwater vehicles carrying acoustical signal transmitters and remotely deployed synchronized underwater acoustical receivers provided with signal processing for continually determining such range during the underwater moving of the vehicle, and for measuring acoustic underwater transmission loss, geoacoustical properties and for other purposes |
| RU2456634C1 (ru) * | 2011-03-16 | 2012-07-20 | Юрий Николаевич Жуков | Способ навигации подводного объекта посредством гидроакустической навигационной системы |
| RU2463624C1 (ru) * | 2011-03-23 | 2012-10-10 | Юрий Николаевич Жуков | Гидроакустическая навигационная система |
| CN107728109A (zh) * | 2017-09-18 | 2018-02-23 | 哈尔滨工程大学 | 一种非合作目标辐射噪声测量定位技术 |
| US20190204430A1 (en) * | 2017-12-31 | 2019-07-04 | Woods Hole Oceanographic Institution | Submerged Vehicle Localization System and Method |
| CN110412508A (zh) * | 2019-08-06 | 2019-11-05 | 青岛国海通讯科技有限公司 | 一种基于矢量水听器的主从式多uuv协同定位方法 |
| CN110954107A (zh) * | 2019-12-04 | 2020-04-03 | 宁波羽声海洋科技有限公司 | 一种无人航行器集群协同导航方法及装置 |
| CN111273298A (zh) * | 2020-02-19 | 2020-06-12 | 国家深海基地管理中心 | 基于波浪滑翔器组网技术的水下声学目标定位与跟踪方法 |
| CN111427008A (zh) * | 2020-04-19 | 2020-07-17 | 中国电子科技集团公司电子科学研究院 | 一种用于水下自主航行器集群的位置测定方法及相关装置 |
| CN112099019A (zh) * | 2020-07-16 | 2020-12-18 | 中国海洋石油集团有限公司 | 一种水下声矢量探测装置 |
| CN112269163A (zh) * | 2020-09-30 | 2021-01-26 | 黑龙江工程学院 | 一种基于坐底单三维矢量水听器的水中声源方位深度协同跟踪方法 |
| CN112731408A (zh) * | 2020-12-31 | 2021-04-30 | 青岛海纳水下信息技术有限公司 | 矢量吊放声纳目标探测方法、反潜***以及反潜方法 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| US20210284305A1 (en) | Deep-sea low-cost long-endurance collaborative navigation and positioning system | |
| CN107664758B (zh) | 基于长基线或超短基线组网的深海导航定位***及方法 | |
| CN108318863B (zh) | 基于海底信标的水下无人设备无源定位方法及其*** | |
| CN109814069B (zh) | 一种基于单定位信标的水下移动节点无源定位方法及其*** | |
| CN103323815B (zh) | 一种基于等效声速的水下声学定位方法 | |
| CN108267719B (zh) | 一种水下多个信标实时定位的方法 | |
| CN103956074A (zh) | 基于位置服务的停车场自动指引***及实现方法 | |
| CN109861762B (zh) | 一种基于声-光的跨介质隐蔽通信***和方法 | |
| CN105547290A (zh) | 一种基于超短基线定位***的从潜器导航方法 | |
| WO2021101613A1 (en) | Method and apparatus for robust low-cost variable-precision self-localization with multi-element receivers in gps-denied environments | |
| CN114200401A (zh) | 一种基于网格划分的水下机器人自定位***及自定位方法 | |
| US11719784B2 (en) | Method for positioning underwater glider based on virtual time difference of arrival of single beacon | |
| CN108627802B (zh) | 多信源海洋物联网定位方法 | |
| CN113432601B (zh) | 一种用于水下直升机的定位巡航***及其工作方法 | |
| Geist et al. | Towards a hyperbolic acoustic one-way localization system for underwater swarm robotics | |
| CN111928851B (zh) | 基于tma技术的多自主水下机器人集群协同导航方法 | |
| CN113671442B (zh) | 基于矢量水听器技术的水下无人集群导航定位方法 | |
| CN113671442A (zh) | 基于矢量水听器技术的水下无人集群导航定位方法 | |
| CN201876548U (zh) | 一种多用户水下超短基线定位设备 | |
| CN116609815A (zh) | 一种海底航行器智能定位***及方法 | |
| Lv et al. | Link strength for Unmanned Surface Vehicle's underwater acoustic communication | |
| CN114485645B (zh) | 基于测距与信息交互的uuv集群协同定位***和方法 | |
| CN106028414A (zh) | 一种反向水下定位方法和*** | |
| Zhu et al. | Return-to-base navigation of robotic swarms in mars exploration using doa estimation | |
| Mengyuan et al. | High precision positioning for searching airborne black boxes underwater based on acoustic orbital angular momentum |
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 |