CN109596128A - 一种基于多水听器提高多auv协同定位性能的方法 - Google Patents
一种基于多水听器提高多auv协同定位性能的方法 Download PDFInfo
- Publication number
- CN109596128A CN109596128A CN201910033292.1A CN201910033292A CN109596128A CN 109596128 A CN109596128 A CN 109596128A CN 201910033292 A CN201910033292 A CN 201910033292A CN 109596128 A CN109596128 A CN 109596128A
- Authority
- CN
- China
- Prior art keywords
- auv
- moment
- hydrophone
- navigator
- following
- 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
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
- G01C21/203—Specially adapted for sailing ships
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
Abstract
本发明属于自主式水下航行领域,具体涉及一种基于多水听器提高多AUV协同定位性能的方法。该方法包括:在跟随AUV上配置多个水听器,设置水听器的位置并固定水听器;领航AUV与跟随AUV通过水听器进行水声测距,同时领航AUV将自身位置广播发送给跟随AUV;建立单领航AUV模式的协同定位***状态空间模型;利用EKF滤波方法,对跟随AUV定位。通过设计多个水听器在跟随AUV上的位置,增加状态空间模型量测矩阵维数,***的可观测性大大提高,有效降低了对单领航方案中的各AUV高机动性要求;减少了多AUV协同导航***领航AUV数量,避免了由于设置多个领航AUV所需要配备的高精度惯性测量单元,降低成本;不涉及到多领航AUV时间同步的问题,容易实施,而且定位精度较高。
Description
技术领域
本发明属于自主式水下航行领域,具体涉及一种基于多水听器提高多AUV协同定位性能的方法。
背景技术
协同导航是目前中间层区域多自主式水下航行器最有效的导航方法之一,具有广阔的应用前景。基于水声通信网络的自主水下航行器AUV协同导航技术是伴随多AUV协作***发展而来的一种新的AUV水下导航方案,相比传统的惯性导航、声学基线导航,协同导航不仅精度高,而且成本低、鲁棒性好,可以大大增强多AUV***的协同作业能力,具有重要的研究价值。据领航AUV数目的不同,又可以分为单领航模式和多领航模式。单领航模式结构简单、容易部署且操作、成本需求低,但是***整体导航性能取决于单个领航AUV,对领航AUV的可靠性要求较高;其次,单领航AUV***可观测性较低,需要领航AUV不断进行航路机动以提高***的可观测性。相对单领航AUV方案来说,多领航方案由于领航AUV数目的增多,***对单个领航AUV的可靠性要求大大降低。同时,由于***的可观测性大大提高,在协同过程中通常不需要靠领航AUV的航路机动来保证***的可观测性,不仅提高了***的协同定位性能,同时更有利于按照预定的任务队形协作执行任务。但是相比于单领航模式来说,由于领航AUV数目的增多,***的导航成本有所增加。从水下协同导航技术的发展趋势来看,基于单领航AUV方案的协同导航无疑更具有吸引力,正受到越来越多的关注和发展。然而,***可观测是实现水下航行器协同导航的前提条件,尤其对于单领航方案来说至关重要。如果所描述的***是可观测的,则载体自身定位误差就可以通过融合领航AUV相对精确的位置信息以及二者间距离量测信息进行协同校正;反之,则不论采用什么样的滤波算法都无法实现位置状态的准确估计,因而如何增强***的可观测性,对提高多AUV协同导航***的协同定位性能来说至关重要。
发明内容
本发明的目的在于提供一种通过在跟随AUV上配置多个水听器并基于非线性滤波估计的多AUV协同导航方法,能够提高单领航模式下的主从式多AUV协同导航***可观测性,并最终提高***的协同定位性能。
本发明的目的是这样实现的:
一种基于多水听器提高多AUV协同定位性能的方法,该方法包括以下步骤:
步骤1:在跟随AUV上配置多个水听器,设置水听器的位置并固定水听器;
步骤2:领航AUV与跟随AUV通过水听器进行水声测距,得到跟随AUV上配置的多个水听器到领航AUV之间的距离,同时领航AUV将自身位置广播发送给跟随AUV;
步骤3:根据水听器的位置信息、跟随AUV上水听器到领航AUV之间的距离信息、领航AUV位置信息、跟随AUV组合推位的位置信息建立单领航AUV模式的协同定位***状态空间模型;
步骤4:利用EKF滤波方法,得到***状态的估计值,对跟随AUV定位。
步骤1所述的在跟随AUV上配置多个水听器包括:以跟随AUV的质心为坐标原点建立载体坐标系Oxbybzb,载体坐标系的xb轴沿跟随AUV横轴指右,yb轴沿跟随AUV纵轴指前,zb轴沿跟随AUV竖轴并与xb、yb轴构成右手直角坐标系;跟随AUV沿载体坐标系纵轴航行,跟随AUV上配置的多个水听器位置应均不处于同一纵轴;将水听器A和水听器B分别固定在跟随AUV头尾两侧,设水听器A和水听器B在该载体坐标系的位置坐标分别为(a,b,0)和(-c,-d,0),其中a为水听器的xb轴距离,c为跟随AUV质心的xb轴距离,b为水听器的yb轴距离,d为跟随AUV质心的yb轴距离,单位为米。
步骤3所述的建立单领航AUV模式的协同定位***状态空间模型表示为:
式中,k+1表示tk+1时刻;Xk=(xk,yk,θk)T为跟随AUV在tk时刻的状态量,xk为在导航坐标系中跟随AUV在tk时刻的东向位置坐标,yk为跟随AUV在tk时刻的北向位置坐标,θk为跟随AUV的在tk时刻的航向角;Xk+1为跟随AUV在tk+1时刻的状态量;uk=(Vkθk)T为tk时刻***的传感器输入量,Vk为跟随AUV在tk时刻的前向速度;Zk+1为tk+1时刻的量测向量;为领航AUV在tk+1时刻的状态量,为跟随AUV和领航AUV在tk+1时刻的东向位置坐标,为领航AUV在tk+1时刻的北向位置坐标;wk为过程噪声向量,vk+1为量测噪声向量,且wk、vk+1均为Gauss白噪声;状态函数δt为采样周期;ω为角速率;量测函数表示为:
其中,xk+1为在导航坐标系中跟随AUV在tk+1时刻的东向位置坐标;yk+1为跟随AUV在tk+1时刻的北向位置坐标;为tk+1时刻水听器A到跟随AUV质心在导航坐标系中的东向距离,为tk+1时刻水听器A到跟随AUV质心在导航坐标系中的北向距离,为tk+1时刻水听器B到跟随AUV质心在导航坐标系中的东向距离,为tk+1时刻水听器B到跟随AUV质心在导航坐标系中的北向距离。
假设状态向量Xk=[xk,yk]T在tk时刻***后验概率状态以及后验概率密度函数已知,Pkk为tk时刻的状态估计方差阵,Zk为tk时刻由水声测距得到的跟随AUV上两个水听器到领航AUV的距离组成的量测向量,步骤4所述的利用EKF滤波方法,包括以下步骤:
步骤4.1:时间更新;
步骤4.2:量测更新;
步骤4.3:以此过程逐次递推至状态估计误差协方差达到稳定值。
步骤4.1所述时间更新包括,状态一步预测方程表示为下式:
状态预测方差阵表示为:
其中,***状态转移矩阵 为Fk的转置;***噪声激励阵 为Gk的转置;***噪声协方差阵wk T为wk转置,为传感器速度噪声方差,为航向噪声方差。
步骤4.2所述的量测更新包括,滤波增益表示为下式:
其中,量测矩阵表示为下式:
其中,为Ηk+1的转置;量测噪声协方差阵Rk+1=E[vk+1vk+1 T],vk+1 T为vk+1转置;
状态估计表示为下式:
状态估计方差阵表示为下式:
Pk+1|k+1=[I-Kk+1Hk+1]Pk+1|k
式中,I为单位阵,由滤波估计得到的跟随AUV在tk+1时刻的状态量;
以此过程逐次递推至状态估计误差协方差达到稳定值,即得到***状态的估计,对跟随AUV定位。
本发明的有益效果在于:
1.跟随AUV配备多个水听器,通过设计多个水听器在跟随AUV上的位置,增加状态空间模型量测矩阵维数,***的可观测性大大提高,有效降低了对单领航方案中的各AUV高机动性要求;
2.减少了多AUV协同导航***领航AUV数量,避免了由于设置多个领航AUV所需要配备的高精度惯性测量单元,降低成本;
3.基于多水听器的协同导航方法不涉及到多领航AUV时间同步的问题,容易实施,而且定位精度较高。
附图说明
图1为本发明的流程图;
图2为跟随AUV上水听器的安装示意图;
图3为双水听器领航AUV与跟随AUV间的测距方案;
图4为EKF滤波流程图;
图5为领航AUV与跟随AUV的真实航行轨迹图;
图6为协同导航跟随AUV轨迹对比图;
图7定位误差对比图。
具体实施方式
下面结合附图对本发明做进一步描述。
单领航方案的多AUV协同导航***成本低、易操作,但其对领航AUV与跟随AUV运动状态要求较高。单领航模式下,若领航AUV、跟随AUV以相同的航速沿相互平行的直线路径机动时,将导致***全局不可观测;若领航AUV、跟随AUV以同速、同向航行时,或航行速度切线方向一致,将导致多AUV协同导航***局部不可观测。通过设计复杂的航路规划方案可以满足协同导航***的可观测性。然而对于航速慢、机动性差的AUV***来说,为了提高***的可观测性,在实际执行任务过程中进行复杂的航路机动往往是不现实的。针对以上问题,本专利设计一种基于多水听器提高多AUV协同导航***可观测性的方法,通过在跟随AUV上装备多个水听器,由水声测距得到各个水听器到领航AUV的距离及水听器与跟随AUV质心的坐标关系,建立多AUV协同导航***状态空间模型,增强了***的可观测性,提高了多AUV***协同定位性能。
步骤一:在跟随AUV上配置水听器。
以跟随AUV的质心为坐标原点建立载体坐标系Oxbybzb,载体坐标系的xb轴沿跟随AUV横轴指右,yb轴沿跟随AUV纵轴指前,zb轴沿跟随AUV竖轴并与xb、yb轴构成右手直角坐标系。跟随AUV沿载体坐标系纵轴航行,跟随AUV上配置的多个水听器位置应均不处于同一纵轴,并且各个水听器之间距离尽可能远。跟随AUV上安装多个水听器可提高协同导航***可观测性,但安装过多的水听器对提高协同导航***定位性能并不明显,且成本需求高。以跟随AUV上配置两个水听器为例,将水听器A和水听器B分别固定在在跟随AUV头尾两侧,设水听器A和水听器B在该载体坐标系的位置坐标分别为(a,b,0)和(-c,-d,0),其中a、c为水听器与跟随AUV质心的xb轴距离,b、d为水听器与跟随AUV质心的yb轴距离,单位为米。
步骤二:领航AUV与跟随AUV进行水声测距,领航AUV广播自身位置。
领航AUV与跟随AUV通过水听器进行水声测距,可分别得到跟随AUV上配置的两个水听器到领航AUV之间的距离,同时,领航AUV将自身位置信息广播发送给跟随AUV。
步骤三:建立基于双水听器的单领航AUV协同定位***状态空间模型。
在实际水下协同定位中,AUV的深度和水平位置是相互独立的,通过压力传感器可以获得精确的深度信息,故可将三维的协同定位问题简化为二维,在讨论中将模型投影到二维水平面进行分析。在导航坐标系Oxtyt中,定义跟随AUV在tk时刻和tk+1时刻的位置向量分别为(xk,yk)和(xk+1,yk+1),领航AUV在tk时刻和tk+1时刻的位置向量分别为和 分别为跟随AUV和领航AUV在tk时刻的东向位置坐标;分别为跟随AUV和领航AUV在tk时刻的北向位置坐标;分别为跟随AUV和领航AUV在tk+1时刻的东向位置坐标;分别为跟随AUV和领航AUV在tk+1时刻的北向位置坐标。基于相对位置量测的协同导航***状态方程具体为:
式中,xk和xk+1分别为在导航坐标系中跟随AUV在tk时刻和tk+1时刻的东向位置坐标;yk和yk+1分别为跟随AUV在tk时刻和tk+1时刻的北向位置坐标;δt为采样周期;Vk为跟随AUV在tk时刻的前向速度,θk为跟随AUV的在tk时刻的航向角;ω为角速率。
将跟随AUV上的水听器A到跟随AUV质心的xb轴距离和yb轴距离由载体坐标系投影到导航坐标系得到:
式中,为水听器A到跟随AUV质心距离投影到导航坐标系中的东向距离和北向距离,则水听器A在导航坐标系中位置向量为
同理:
式中,为水听器B到跟随AUV质心距离投影到导航坐标系中的东向距离和北向距离,得到水听器B在导航坐标系中位置向量为
跟随AUV在tk时刻通过水声通信得到的相对观测信息为领航AUV在tk时刻的位置信息及领航AUV与跟随AUV之间相对距离量测信息分别为和量测向量由以上信息可得领航AUV和跟随AUV之间的坐标位置关系为:
式中,分别为在导航坐标系中领航AUV在tk时刻和tk+1时刻的东向、北向位置坐标;
基于式(1)和式(2),建立多AUV协同定位***的离散时间状态空间模型(状态方程和量测方程)如下:
式中,k+1表示tk+1时刻;Xk=(xk,yk,θk)T为跟随AUV在tk时刻的状态量;Xk+1为跟随AUV在tk+1时刻的状态量;uk=(Vkθk)T为tk时刻***的传感器输入量;Zk+1为tk+1时刻的量测向量;为领航AUV在tk+1时刻的状态量;wk为过程噪声向量,vk+1为量测噪声向量,且wk、vk+1均为Gauss白噪声;状态函数量测函数 为tk+1时刻水听器A到跟随AUV质心在导航坐标系中的东向距离和北向距离,为tk+1时刻水听器B到跟随AUV质心在导航坐标系中的东向距离和北向距离。
步骤四:利用EKF滤波方法,得到***状态的估计值,从而实现对跟随AUV的协同定位。
假设状态向量Xk=[xk,yk]T在tk时刻***后验概率状态以及后验概率密度函数已知,Pkk为tk时刻的状态估计方差阵,Zk为tk时刻由水声测距得到的跟随AUV上两个水听器到领航AUV的距离组成的量测向量。
(1)时间更新
状态一步预测方程:
状态预测方差阵:
其中***状态转移矩阵 为Fk的转置;***噪声激励阵 为Gk的转置;***噪声协方差阵wk T为wk转置,和分别为传感器速度噪声方差和航向噪声方差。
(2)量测更新
滤波增益:
其中量测矩阵 为Ηk+1的转置;量测噪声协方差阵Rk+1=E[vk+1vk+1 T],vk+1 T为vk+1转置。
状态估计:
状态估计方差阵:
Pk+1|k+1=[I-Kk+1Hk+1]Pk+1|k (10)
式中,I为单位阵,由滤波估计得到的跟随AUV在tk+1时刻的状态量。
以此过程逐次递推至状态估计误差协方差达到稳定值,即得到***状态的估计,从而实现对跟随AUV的定位。
为进一步说明本发明的有益效果,模拟在领航AUV安装有惯性导航设备和多普勒计程仪,跟随AUV安装有MEMS惯性***和多普勒计程仪实验环境下,对基于双水听器的多AUV协同定位方案进行了仿真验证:
仿真时间为3600s;采样周期为1s;领航AUV以角速率大小为0.1°/s做曲线运动,跟随AUV沿航向角为60°的方向匀速直航;领航AUV与跟随AUV的速度均为4kn;跟随AUV速度传感器量测噪声取为的零均值高斯白噪声;跟随AUV航向角测量噪声取为的零均值高斯白噪声,且跟随AUV航向角存在5°/h的航向漂移误差;仿真中还引入领航AUV与跟随AUV间水声测距的量测噪声,方差为(0.5m)2;水听器A、水听器B分别安装在跟随AUV的右上角与左下角,两个水听器与跟随AUV质心的横向距离均为2米,纵向距离均为5米,进行仿真实验。
Claims (6)
1.一种基于多水听器提高多AUV协同定位性能的方法,其特征在于,该方法包括以下步骤:
步骤1:在跟随AUV上配置多个水听器,设置水听器的位置并固定水听器;
步骤2:领航AUV与跟随AUV通过水听器进行水声测距,得到跟随AUV上配置的多个水听器到领航AUV之间的距离,同时领航AUV将自身位置广播发送给跟随AUV;
步骤3:根据水听器的位置信息、跟随AUV上水听器到领航AUV之间的距离信息、领航AUV位置信息、跟随AUV组合推位的位置信息建立单领航AUV模式的协同定位***状态空间模型;
步骤4:利用EKF滤波方法,得到***状态的估计值,对跟随AUV定位。
2.根据权利要求1所述的一种基于多水听器提高多AUV协同定位性能的方法,其特征在于,步骤1所述的在跟随AUV上配置多个水听器包括:以跟随AUV的质心为坐标原点建立载体坐标系Oxbybzb,载体坐标系的xb轴沿跟随AUV横轴指右,yb轴沿跟随AUV纵轴指前,zb轴沿跟随AUV竖轴并与xb、yb轴构成右手直角坐标系;跟随AUV沿载体坐标系纵轴航行,跟随AUV上配置的多个水听器位置应均不处于同一纵轴;将水听器A和水听器B分别固定在跟随AUV头尾两侧,设水听器A和水听器B在该载体坐标系的位置坐标分别为(a,b,0)和(-c,-d,0),其中a为水听器的xb轴距离,c为跟随AUV质心的xb轴距离,b为水听器的yb轴距离,d为跟随AUV质心的yb轴距离,单位为米。
3.根据权利要求2所述的一种基于多水听器提高多AUV协同定位性能的方法,其特征在于,步骤3所述的建立单领航AUV模式的协同定位***状态空间模型表示为:
式中,k+1表示tk+1时刻;Xk=(xk,yk,θk)T为跟随AUV在tk时刻的状态量,xk为在导航坐标系中跟随AUV在tk时刻的东向位置坐标,yk为跟随AUV在tk时刻的北向位置坐标,θk为跟随AUV的在tk时刻的航向角;Xk+1为跟随AUV在tk+1时刻的状态量;uk=(Vkθk)T为tk时刻***的传感器输入量,Vk为跟随AUV在tk时刻的前向速度;Zk+1为tk+1时刻的量测向量;为领航AUV在tk+1时刻的状态量,为跟随AUV和领航AUV在tk+1时刻的东向位置坐标,为领航AUV在tk+1时刻的北向位置坐标;wk为过程噪声向量,vk+1为量测噪声向量,且wk、vk+1均为Gauss白噪声;状态函数δt为采样周期;ω为角速率;量测函数表示为:
其中,xk+1为在导航坐标系中跟随AUV在tk+1时刻的东向位置坐标;yk+1为跟随AUV在tk+1时刻的北向位置坐标;为tk+1时刻水听器A到跟随AUV质心在导航坐标系中的东向距离,为tk+1时刻水听器A到跟随AUV质心在导航坐标系中的北向距离,为tk+1时刻水听器B到跟随AUV质心在导航坐标系中的东向距离,为tk+1时刻水听器B到跟随AUV质心在导航坐标系中的北向距离。
4.根据权利要求3所述的一种基于多水听器提高多AUV协同定位性能的方法,其特征在于:假设状态向量Xk=[xk,yk]T在tk时刻***后验概率状态以及后验概率密度函数已知,Pk|k为tk时刻的状态估计方差阵,Zk为tk时刻由水声测距得到的跟随AUV上两个水听器到领航AUV的距离组成的量测向量,步骤4所述的利用EKF滤波方法,包括以下步骤:
步骤4.1:时间更新;
步骤4.2:量测更新;
步骤4.3:以此过程逐次递推至状态估计误差协方差达到稳定值。
5.根据权利要求4所述的一种基于多水听器提高多AUV协同定位性能的方法,其特征在于,步骤4.1所述时间更新包括,状态一步预测方程表示为下式:
状态预测方差阵表示为:
其中,***状态转移矩阵 为Fk的转置;***噪声激励阵 为Gk的转置;***噪声协方差阵wk T为wk转置,为传感器速度噪声方差,为航向噪声方差。
6.根据权利要求4所述的一种基于多水听器提高多AUV协同定位性能的方法,其特征在于,步骤4.2所述的量测更新包括,滤波增益表示为下式:
其中,量测矩阵表示为下式:
其中,为Ηk+1的转置;量测噪声协方差阵Rk+1=E[vk+1vk+1 T],vk+1 T为vk+1转置;
状态估计表示为下式:
状态估计方差阵表示为下式:
Pk+1|k+1=[I-Kk+1Hk+1]Pk+1|k
式中,I为单位阵,由滤波估计得到的跟随AUV在tk+1时刻的状态量;
以此过程逐次递推至状态估计误差协方差达到稳定值,即得到***状态的估计,对跟随AUV定位。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910033292.1A CN109596128B (zh) | 2019-01-14 | 2019-01-14 | 一种基于多水听器提高多auv协同定位性能的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910033292.1A CN109596128B (zh) | 2019-01-14 | 2019-01-14 | 一种基于多水听器提高多auv协同定位性能的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109596128A true CN109596128A (zh) | 2019-04-09 |
CN109596128B CN109596128B (zh) | 2022-06-21 |
Family
ID=65966253
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910033292.1A Active CN109596128B (zh) | 2019-01-14 | 2019-01-14 | 一种基于多水听器提高多auv协同定位性能的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109596128B (zh) |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110186461A (zh) * | 2019-06-27 | 2019-08-30 | 武汉科技大学 | 一种基于重力梯度信息测距的协同导航方法 |
CN110908393A (zh) * | 2019-10-31 | 2020-03-24 | 中国矿业大学 | 基于探通一体化的水下无人航行器编队协同方法 |
CN110954107A (zh) * | 2019-12-04 | 2020-04-03 | 宁波羽声海洋科技有限公司 | 一种无人航行器集群协同导航方法及装置 |
CN111256727A (zh) * | 2020-02-19 | 2020-06-09 | 广州蓝胖子机器人有限公司 | 一种基于Augmented EKF的提高里程计精度的方法 |
CN111595348A (zh) * | 2020-06-23 | 2020-08-28 | 南京信息工程大学 | 一种自主水下航行器组合导航***的主从式协同定位方法 |
CN113176533A (zh) * | 2021-04-28 | 2021-07-27 | 中国电子科技集团公司第三十六研究所 | 水声通信信号的测向方法、装置及电子设备 |
CN113324547A (zh) * | 2021-05-25 | 2021-08-31 | 江苏科技大学 | 基于迭代扩展rts平滑滤波算法的多auv协同定位方法 |
CN113945892A (zh) * | 2021-10-11 | 2022-01-18 | 哈尔滨工程大学 | 一种体目标三维运动轨迹测量方法 |
CN114840003A (zh) * | 2022-03-21 | 2022-08-02 | 哈尔滨工程大学 | 一种单领航多auv协同定位及轨迹跟踪控制方法 |
CN114840003B (zh) * | 2022-03-21 | 2024-08-02 | 哈尔滨工程大学 | 一种单领航多auv协同定位及轨迹跟踪控制方法 |
Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB1368590A (en) * | 1972-09-05 | 1974-10-02 | Oki Electric Ind Co Ltd | Method and apparatus for computing and displaying sound waves of a sonar system |
US5659520A (en) * | 1995-04-24 | 1997-08-19 | Sonatech, Inc. | Super short baseline navigation using phase-delay processing of spread-spectrum-coded reply signals |
CN102901514A (zh) * | 2012-09-25 | 2013-01-30 | 北京航空航天大学 | 一种基于多惯组信息约束的协同初始对准方法 |
CN103292813A (zh) * | 2013-05-24 | 2013-09-11 | 哈尔滨工程大学 | 一种提高水面艇编队导航精度的信息滤波方法 |
CN103398712A (zh) * | 2013-08-02 | 2013-11-20 | 中国人民解放军63983部队 | 交替领航的协同导航方法 |
WO2014204820A1 (en) * | 2013-06-17 | 2014-12-24 | Westerngeco Llc | Seismic data processing |
CN104457754A (zh) * | 2014-12-19 | 2015-03-25 | 东南大学 | 一种基于sins/lbl紧组合的auv水下导航定位方法 |
CN104569917A (zh) * | 2014-12-26 | 2015-04-29 | 中国船舶重工集团公司第七一五研究所 | 一种auv平台自适应定位与导航***及方法 |
CN105319534A (zh) * | 2015-11-09 | 2016-02-10 | 哈尔滨工程大学 | 一种基于水声双程测距的多auv协同定位方法 |
CN105445722A (zh) * | 2015-11-09 | 2016-03-30 | 哈尔滨工程大学 | 一种适用于多auv协同导航的动态条件下水声双程测距误差补偿方法 |
CN106569179A (zh) * | 2016-11-08 | 2017-04-19 | 东南大学 | 一种基于遗传粒子滤波算法的水下目标跟踪定位方法 |
CN106767793A (zh) * | 2017-01-19 | 2017-05-31 | 东南大学 | 一种基于sins/usbl紧组合的auv水下导航定位方法 |
-
2019
- 2019-01-14 CN CN201910033292.1A patent/CN109596128B/zh active Active
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB1368590A (en) * | 1972-09-05 | 1974-10-02 | Oki Electric Ind Co Ltd | Method and apparatus for computing and displaying sound waves of a sonar system |
US5659520A (en) * | 1995-04-24 | 1997-08-19 | Sonatech, Inc. | Super short baseline navigation using phase-delay processing of spread-spectrum-coded reply signals |
CN102901514A (zh) * | 2012-09-25 | 2013-01-30 | 北京航空航天大学 | 一种基于多惯组信息约束的协同初始对准方法 |
CN103292813A (zh) * | 2013-05-24 | 2013-09-11 | 哈尔滨工程大学 | 一种提高水面艇编队导航精度的信息滤波方法 |
WO2014204820A1 (en) * | 2013-06-17 | 2014-12-24 | Westerngeco Llc | Seismic data processing |
CN103398712A (zh) * | 2013-08-02 | 2013-11-20 | 中国人民解放军63983部队 | 交替领航的协同导航方法 |
CN104457754A (zh) * | 2014-12-19 | 2015-03-25 | 东南大学 | 一种基于sins/lbl紧组合的auv水下导航定位方法 |
CN104569917A (zh) * | 2014-12-26 | 2015-04-29 | 中国船舶重工集团公司第七一五研究所 | 一种auv平台自适应定位与导航***及方法 |
CN105319534A (zh) * | 2015-11-09 | 2016-02-10 | 哈尔滨工程大学 | 一种基于水声双程测距的多auv协同定位方法 |
CN105445722A (zh) * | 2015-11-09 | 2016-03-30 | 哈尔滨工程大学 | 一种适用于多auv协同导航的动态条件下水声双程测距误差补偿方法 |
CN106569179A (zh) * | 2016-11-08 | 2017-04-19 | 东南大学 | 一种基于遗传粒子滤波算法的水下目标跟踪定位方法 |
CN106767793A (zh) * | 2017-01-19 | 2017-05-31 | 东南大学 | 一种基于sins/usbl紧组合的auv水下导航定位方法 |
Non-Patent Citations (5)
Title |
---|
EMMANUEL SKARSOULIS等: ""Bayesian linearized two-hydrophone localization of a pulsed acoustic source"", 《THE JOURNAL OF THE ACOUSTICAL SOCIETY OF AMERICA》 * |
GAO, WEI等: ""An Improved Cooperative Localization Method for Multiple Autonomous Underwater Vehicles Based on Acoustic Round-Trip Ranging"", 《2014 IEEE/ION POSITION, LOCATION AND NAVIGATION SYMPOSIUM, PLANS 2014》 * |
GAO, WEI等: ""Moving Horizon Estimation for Cooperation Localization of Multiple Unmanned Underwater Vehicles with Communication Delay"", 《2014 IEEE/ION POSITION, LOCATION AND NAVIGATION SYMPOSIUM - PLANS 2014》 * |
徐博,等: ""多 AUV 协同导航问题的研究现状与进展"", 《自动化学报》 * |
聂星阳,等: ""近海水下目标多水听器阵列协同定位"", 《指挥信息***与技术》 * |
Cited By (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110186461B (zh) * | 2019-06-27 | 2021-02-19 | 武汉科技大学 | 一种基于重力梯度信息测距的协同导航方法 |
CN110186461A (zh) * | 2019-06-27 | 2019-08-30 | 武汉科技大学 | 一种基于重力梯度信息测距的协同导航方法 |
CN110908393A (zh) * | 2019-10-31 | 2020-03-24 | 中国矿业大学 | 基于探通一体化的水下无人航行器编队协同方法 |
CN110954107A (zh) * | 2019-12-04 | 2020-04-03 | 宁波羽声海洋科技有限公司 | 一种无人航行器集群协同导航方法及装置 |
CN110954107B (zh) * | 2019-12-04 | 2023-09-19 | 上海迈波科技有限公司 | 一种无人航行器集群协同导航方法及装置 |
CN111256727B (zh) * | 2020-02-19 | 2022-03-08 | 广州蓝胖子机器人有限公司 | 一种基于Augmented EKF的提高里程计精度的方法 |
CN111256727A (zh) * | 2020-02-19 | 2020-06-09 | 广州蓝胖子机器人有限公司 | 一种基于Augmented EKF的提高里程计精度的方法 |
CN111595348A (zh) * | 2020-06-23 | 2020-08-28 | 南京信息工程大学 | 一种自主水下航行器组合导航***的主从式协同定位方法 |
CN113176533A (zh) * | 2021-04-28 | 2021-07-27 | 中国电子科技集团公司第三十六研究所 | 水声通信信号的测向方法、装置及电子设备 |
CN113176533B (zh) * | 2021-04-28 | 2023-11-24 | 中国电子科技集团公司第三十六研究所 | 水声通信信号的测向方法、装置及电子设备 |
CN113324547A (zh) * | 2021-05-25 | 2021-08-31 | 江苏科技大学 | 基于迭代扩展rts平滑滤波算法的多auv协同定位方法 |
CN113945892A (zh) * | 2021-10-11 | 2022-01-18 | 哈尔滨工程大学 | 一种体目标三维运动轨迹测量方法 |
CN113945892B (zh) * | 2021-10-11 | 2022-05-03 | 哈尔滨工程大学 | 一种体目标三维运动轨迹测量方法 |
CN114840003A (zh) * | 2022-03-21 | 2022-08-02 | 哈尔滨工程大学 | 一种单领航多auv协同定位及轨迹跟踪控制方法 |
CN114840003B (zh) * | 2022-03-21 | 2024-08-02 | 哈尔滨工程大学 | 一种单领航多auv协同定位及轨迹跟踪控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109596128B (zh) | 2022-06-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109596128A (zh) | 一种基于多水听器提高多auv协同定位性能的方法 | |
CN104316045B (zh) | 一种基于sins/lbl的auv水下交互辅助定位***及定位方法 | |
CN111595348B (zh) | 一种自主水下航行器组合导航***的主从式协同定位方法 | |
Lee et al. | Simulation of an inertial acoustic navigation system with range aiding for an autonomous underwater vehicle | |
Vaganay et al. | Experimental validation of the moving long base-line navigation concept | |
CN105823480A (zh) | 基于单信标的水下移动目标定位算法 | |
CN111829512B (zh) | 一种基于多传感器数据融合的auv导航定位方法及*** | |
CN109884730B (zh) | 一种基于深海水下滑翔机平台的虚拟阵被动探测方法 | |
CN109974706A (zh) | 一种基于双运动模型的主从式多auv协同导航方法 | |
CN109765523A (zh) | 基于自适应akf的单应答器斜距水声定位方法及*** | |
CN107966145B (zh) | 一种基于稀疏长基线紧组合的auv水下导航方法 | |
CN106054135B (zh) | 一种基于周期移动时间窗的被动水声定位方法 | |
CN107797125B (zh) | 一种减小深海探测型auv导航定位误差的方法 | |
Jin et al. | Single-source aided semi-autonomous passive location for correcting the position of an underwater vehicle | |
Zhu et al. | A calibration method of USBL installation error based on attitude determination | |
CA2477677A1 (en) | Autonomous velocity estimation and navigation | |
CN112747748A (zh) | 一种基于逆向解算的领航auv导航数据后处理方法 | |
Allotta et al. | Localization algorithm for a fleet of three AUVs by INS, DVL and range measurements | |
CN113639749A (zh) | 一种基于不确定性的多波束测深数据匹配检测方法 | |
Harris et al. | Cooperative acoustic navigation of underwater vehicles without a DVL utilizing a dynamic process model: Theory and field evaluation | |
CN112945245B (zh) | 基于条件数理论在多auv协同导航***中可观测性分析方法 | |
Gode | Long Basline Ranging Acoustic Positioning System | |
Pfingsthorn et al. | Full 3D navigation correction using low frequency visual tracking with a stereo camera | |
Ferreira | Control and cooperation of marine vehicles | |
Sahu et al. | Centralized kalman filter for fusion of multiple on-board auxiliary sensors with ins for underwater navigation |
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 |