CN110703205A - 基于自适应无迹卡尔曼滤波的超短基线定位方法 - Google Patents
基于自适应无迹卡尔曼滤波的超短基线定位方法 Download PDFInfo
- Publication number
- CN110703205A CN110703205A CN201910971966.2A CN201910971966A CN110703205A CN 110703205 A CN110703205 A CN 110703205A CN 201910971966 A CN201910971966 A CN 201910971966A CN 110703205 A CN110703205 A CN 110703205A
- Authority
- CN
- China
- Prior art keywords
- underwater robot
- noise
- ultra
- underwater
- adaptive
- 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
- 238000001914 filtration Methods 0.000 title claims abstract description 25
- 230000003044 adaptive effect Effects 0.000 title claims abstract description 24
- 238000000034 method Methods 0.000 title claims abstract description 17
- 230000033001 locomotion Effects 0.000 claims description 18
- 230000001133 acceleration Effects 0.000 claims description 16
- 239000011159 matrix material Substances 0.000 claims description 15
- 238000005070 sampling Methods 0.000 claims description 7
- 238000005259 measurement Methods 0.000 claims description 4
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 claims description 4
- 230000005534 acoustic noise Effects 0.000 claims description 3
- 230000006978 adaptation Effects 0.000 claims description 3
- 238000004891 communication Methods 0.000 claims description 3
- 238000013507 mapping Methods 0.000 claims description 3
- 230000009466 transformation Effects 0.000 description 6
- 238000012544 monitoring process Methods 0.000 description 4
- 230000004044 response Effects 0.000 description 3
- 238000001514 detection method Methods 0.000 description 2
- 230000004927 fusion Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000006467 substitution reaction Methods 0.000 description 2
- 230000002238 attenuated effect Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000012546 transfer 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/26—Position of receiver fixed by co-ordinating a plurality of position lines defined by path-difference measurements
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/11—Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
- G06F17/12—Simultaneous equations, e.g. systems of linear equations
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/16—Matrix or vector computation, e.g. matrix-matrix or matrix-vector multiplication, matrix factorization
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F2218/00—Aspects of pattern recognition specially adapted for signal processing
- G06F2218/02—Preprocessing
- G06F2218/04—Denoising
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02A—TECHNOLOGIES FOR ADAPTATION TO CLIMATE CHANGE
- Y02A90/00—Technologies having an indirect contribution to adaptation to climate change
- Y02A90/30—Assessment of water resources
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Pure & Applied Mathematics (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Computational Mathematics (AREA)
- Theoretical Computer Science (AREA)
- Data Mining & Analysis (AREA)
- Software Systems (AREA)
- General Engineering & Computer Science (AREA)
- Algebra (AREA)
- Databases & Information Systems (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Computing Systems (AREA)
- Operations Research (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种基于自适应无迹卡尔曼滤波的超短基线定位方法,包括以下步骤:步骤1:利用超短基线进行水下定位;步骤2:通过光电混合缆将母船位置信息和超短基线定位到的水下机器人位置信息发送给水下机器人;步骤3:水下机器人接收到母船发送的位置信息;步骤4:水下机器人将位置信息融合自身携带的加速度计、惯导、深度计等传感器,根据自适应无迹卡尔曼滤波算法进行噪声的削弱,本发明操作简洁,通过融合多传感器及超短基线定位信息,能够提高水下机器人的水下定位精度。
Description
技术领域
本发明涉及一种定位方法,特别涉及一种超短基线定位方法。
背景技术
当前,在海底资源探索、水下机器人探伤、渔业捕捞、水下搜救等应用中,水下机器人定位的研究显得尤为重要,水下定位的精度也越来越高。与陆地上定位不同的是,水下环境复杂,无线电波及光波在水中会迅速衰减,无法进行长距离的传播,因此,声波成为了目前唯一有效的水下信息传播介质,被广泛应用于水下机器人上。
在水声定位***中,分为长基线(LBL)、短基线(SBL)、超短基线(USBL)定位***,长基线定位精度最高,但是水底布设高精度定位已知点的施工难度大且费用较高,一般使用在石油平台检测、水下考古等需要高精度定位的工程;短基线定位需要对船体进行改造才能放置换能器基阵;而超短基线利用测量信号的相位差原理进行水下定位,设备安装简单且具有很强的适应性和灵活性。虽然超短基线安装方便且成本较低,但是定位精度相较长基线与短基线较低,虽然可以通过改进基阵阵形,加大基阵孔径的方法提高定位精度,但该方法定位精度提升有限且操作繁琐。
综合以上因素,需要一种定位精度高,成本低的水下定位方法,能解决现有水下定位方法成本高,操作繁琐及定位精度较低的问题。
发明内容
本发明的目的是提供一种基于自适应无迹卡尔曼滤波的超短基线定位方法,其拥有成本低,定位精度高,操作简洁等特点。
本发明的目的是这样实现的:一种基于自适应无迹卡尔曼滤波的超短基线定位方法,包括以下步骤:
步骤1:利用超短基线进行水下定位;
步骤2:通过光电混合缆将母船位置信息和超短基线定位到的水下机器人位置信息发送给水下机器人;
步骤3:水下机器人接收到母船发送的位置信息;
步骤4:水下机器人将位置信息融合自身携带的加速度计、惯导、深度计等传感器,根据自适应无迹卡尔曼滤波算法进行噪声的削弱。
作为本发明的进一步限定,步骤1中利用超短基线对水下机器人进行定位具体为:通过超短基线基阵与水下机器人搭载的应答器进行声通信得到水下机器人的位置信息;超短基线定位方法为:
水下机器人深度可以通过自身携带的深度计测得,三个基阵单元的坐标分别(x1,y1,z1)、(x2,y2,z2)、(x3,y3,z3),基阵单元与水下机器人的距离分别为s1、s2、s3,深度计测得水下机器人所处深度为h;
其中,z1,z2,z3均可由深度计直接测量,则hi=h-zi可视为已知量,即求解量为目标的xy平面坐标(x,y)。
作为本发明的进一步限定,步骤4中融合超短基线定位数据与惯导、加速度计、深度计信息的自适应无迹卡尔曼滤波算法具体如下:
通过对加速度计积分求得水下机器人速度,对速度进行分解可获得速度在地图坐标系的X轴Y轴速度分量,结合水下机器人运动模型,可对水下机器人运动速度进行推算;
其中,XY是地图坐标系,xy是水下机器人运动坐标系,选取的惯导测得航向角与地图坐标系间的角度差为θ,速度分量的求取为:
其中,VX是水下机器人在地图坐标系的X轴速度分量,VY是水下机器人在地图坐标系的Y轴速度分量;V是水下水下机器人通过对加速度计求积分得到的速度;假设水下机器人在水下做匀速运动,则***方程可以表示为:
其中,(x(k),y(k))为水下机器人k时刻的坐标,T为单位采样时间,wθ(k)为航向角在转向中受到的外部扰动,aX(k)为目标运动过程中地图坐标系中的X轴加速度,aY(k)为目标运动过程中地图坐标系中的Y轴加速度,为k时刻的航向角速度,加速度由水下机器人本身的加速度u(k)和外界扰动w(k)构成;
a(k)=u(k)+w(k);
对于不同时刻k,由具有高斯白噪声W(k)的随机变量X和具有高斯白噪声V(k)的观测变量Z构成的非线性***可以由下式描述,
式中,f是非线性状态方程函数;h是非线性观测方程函数,x为状态向量,X(K)、Z(k)、x(k)分别为随机变量X、观测变量Z、状态向量x在不同时刻k的映射;
根据无迹卡尔曼滤波算法进行信号滤波后,求得卡尔曼增益矩阵:
其中,p为状态向量x的方差;
最后计算***状态更新和协方差更新:
上述UKF基于***噪声W(k)与观测噪声V(k)已知的基础上;在实际应用中,W(k)与V(k)的噪声特性通常是未知的;Sage-Husa自适应滤波算法在已知***噪声特性或者观测噪声特性其中之一的情况下,可动态更新另一噪声的统计特性;如已知***高斯白噪声W(k),可用下式来动态更新观测噪声V(k)的统计特性:
其中:b为遗忘因子,一般取0<b<1,Hk为***的量测矩阵;k时刻的自适应因子dk由遗忘因子b和时刻k计算得到,并由1向1-b收敛;并且,自适应滤波算法的自适应程度有自适应参数dk或者遗忘因子的选取决定;
在更新观测噪声前,通过下式更新观测噪声协方差矩阵:
作为本发明的进一步限定,水下机器人深度信息由水下机器人本身深度计提供。
与现有技术相比,本发明的有益效果在于,本发明使用超短基线定位技术并通光电混合缆将定位信息发送给水下机器人,减小了信号损耗,并通过多种传感器进行组合导航;使用自适应无迹卡尔曼滤波算法滤除噪声,融合超短基线定位,提升了定位精度。
附图说明
图1为本发明流程图。
图2为本发明组成示意图。
具体实施方式
下面结合附图和实施例对本发明做进一步的详细说明。
本发明由有缆水下机器人、母船、超短基线定位基阵、上位机监控***组成,其中有缆水下机器人搭载惯导、加速度计,组成如图2所示。
超短基线基阵发出定位信号,水下机器人的应答器接收到定位信号后返回应答信号,由超短基线接收基阵采集到应答信号后,融合母船位置信息发送给上位机监控***,上位机监控***将定位信息通过光电混合缆发送回水下机器人;水下机器人将超短基线定位信号融合加速度计与惯导信号,计算出本身的水下位置信息并反馈回上位机监控***。
所述的利用超短基线对水下机器人进行定位具体为:通过超短基线基阵与水下机器人搭载的应答器进行声通信得到水下机器人的位置信息。
如图1所示,所述融合多种传感器的自适应无迹卡尔曼滤波算法流程包括以下步骤:
1、水下机器人深度可以通过自身携带的深度计测得,三个基阵单元的坐标分别(x1,y1,z1)、(x2,y2,z2)、(x3,y3,z3),基阵单元与水下机器人的距离分别为s1、s2、s3,深度计测得水下机器人所处深度为h;
所以有,
其中,z1,z2,z3均可由深度计直接测量,则hi=h-zi可视为已知量,即求解量为目标的xy平面坐标(x,y)。
2、通过对加速度计积分求得水下机器人速度,对速度进行分解可获得速度在地图坐标系的X轴Y轴速度分量,结合水下机器人运动模型,可对水下机器人运动速度进行推算;
其中,XY是地图坐标系,xy是水下机器人运动坐标系,选取的惯导测得航向角与地图坐标系间的角度差为θ,速度分量的求取为:
其中,VX是水下机器人在地图坐标系的X轴速度分量,VY是水下机器人在地图坐标系的Y轴速度分量;V是水下水下机器人通过对加速度计求积分得到的速度;假设水下机器人在水下做匀速运动,则***方程可以表示为:
其中,(x(k),y(k))为水下机器人k时刻的坐标,T为单位采样时间,wθ(k)为航向角在转向中受到的外部扰动,aX(k)为目标运动过程中地图坐标系中的X轴加速度,aY(k)为目标运动过程中地图坐标系中的Y轴加速度,为k时刻的航向角速度,加速度由水下机器人本身的加速度u(k)和外界扰动w(k)构成;
a(k)=u(k)+w(k) (5)
通过惯导及加速度计推导出的水下机器人坐标会因为累积误差而无法精准测量,所以水下机器人位置信息可以采用超短基线定位进行测量,通过融合加速度计及惯导信息进行数据矫正,提高定位精准度。
3、融合定位算法
标准的卡尔曼滤波是针对线性***提出的,而实际水下机器人***一般是较为复杂的非线性***。针对非线性***,可以使用扩展卡尔曼滤波(EKF)或者无迹卡尔曼滤波(UKF)进行融合估计;前者是对非线性的***方程或者观测方程进行泰勒展开并保留其一阶近似项,这样不可避免地引入了线性化误差,具有估计精度低、稳定性差的缺陷;后者使用无迹变换(UT)来处理均值和协方差的非线性传递问题,即对一个随机变量按分布进行Sigma点采样,对这些点进行非线性变换,得到的点去描述变量非线性变换后的变量的分布;对于非线性程度较高的***,UKF比EKF具有更好的滤波效果。
对于不同时刻k,由具有高斯白噪声W(k)的随机变量X和具有高斯白噪声V(k)的观测变量Z构成的非线性***可以由式(6)描述,
式中,f是非线性状态方程函数;h是非线性观测方程函数,x为状态向量,X(K)、Z(k)、x(k)分别为随机变量X、观测变量Z、状态向量x在不同时刻k的映射;设W(k)具有协方差阵Q,V(k)具有协方差阵R。随机变量X在不同时刻k的无迹Kalman滤波算法基本步骤如下:
计算2n+1个Sigma点,即采样点,这里的n指的是状态的维数。
计算这些采样点相应的权值
式中,下标m为均值,c为协方差,上标为第几个采样点。参数λ=α2(n+κ)-n是一个缩放比例函数,用来降低总的预测误差,α的选取控制了采样点的分布状态,κ为待选参数,其具体取值虽然没有界限,但通常应确保矩阵(n+λ)P为半正定矩阵,待选参数β≥0是一个非负的权系数。
利用式(7)和(8)获得一组采样点(称为Sigma点集)及其对应权值
(2)计算2n+1个Sigma点集的一步预测,i=1,2,…,2n+1。
X(i)(k+1|k)=f[k,X(i)(k|k)] (10)。
(3)计算***状态量的一步预测及协方差矩阵,它由Sigma点集的预测值加权求和得到,其中权值ω(i)通过式(8)得到;
(4)根据一步预测值,再次使用UT变换,产生新的Sigma点集;
(5)将由步骤(4)预测的Sigma点集代入观测方程,得到预测的观测量,i=1,2,…,2n+1;
Z(i)(k+1|k)=h[X(i)(k+1|k)] (13)。
(6)由式(13)得到Sigma点集的观测预测值,通过加权求和得到***预测的均值及协方差;
(7)计算Kalman增益矩阵
(8)最后计算***状态更新和协方差更新
上述UKF基于***噪声W(k)与观测噪声V(k)已知的基础上。在实际应用中,W(k)与V(k)的噪声特性通常是未知的;Sage-Husa自适应滤波算法在已知***噪声特性或者观测噪声特性其中之一的情况下,可动态更新另一噪声的统计特性;如已知***高斯白噪声W(k),可用式(21)来动态更新观测噪声V(k)的统计特性;
其中:b为遗忘因子,一般取0<b<1;k时刻的自适应因子dk由遗忘因子b和时刻k计算得到,并由1向1-b收敛;Hk为***的量测矩阵,并且,自适应滤波算法的自适应程度有自适应参数dk或者遗忘因子b的选取决定;
在更新观测噪声前,通过式(22)和式(23)更新观测噪声协方差矩阵:
本发明并不局限于上述实施例,在本发明公开的技术方案的基础上,本领域的技术人员根据所公开的技术内容,不需要创造性的劳动就可以对其中的一些技术特征作出一些替换和变形,这些替换和变形均在本发明的保护范围内。
Claims (4)
1.一种基于自适应无迹卡尔曼滤波的超短基线定位方法,其特征在于,包括以下步骤:
步骤1:利用超短基线进行水下定位;
步骤2:通过光电混合缆将母船位置信息和超短基线定位到的水下机器人位置信息发送给水下机器人;
步骤3:水下机器人接收到母船发送的位置信息;
步骤4:水下机器人将位置信息融合自身携带的加速度计、惯导、深度计等传感器,根据自适应无迹卡尔曼滤波算法进行噪声的削弱。
2.根据权利要求1所述的基于自适应无迹卡尔曼滤波的超短基线定位方法,其特征在于,步骤1中利用超短基线对水下机器人进行定位具体为:通过超短基线基阵与水下机器人搭载的应答器进行声通信得到水下机器人的位置信息;超短基线定位方法为:
水下机器人深度可以通过自身携带的深度计测得,三个基阵单元的坐标分别(x1,y1,z1)、(x2,y2,z2)、(x3,y3,z3),基阵单元与水下机器人的距离分别为s1、s2、s3,深度计测得水下机器人所处深度为h;
其中,式中:c为声波在水中的传播速度,di为传播时间,ni为声波噪声,在此视为高斯白噪声,
其中,z1,z2,z3均可由深度计直接测量,则hi=h-zi可视为已知量,即求解量为目标的xy平面坐标(x,y)。
3.根据权利要求1所述的基于自适应无迹卡尔曼滤波的超短基线定位方法,其特征在于,步骤4中融合超短基线定位数据与惯导、加速度计、深度计信息的自适应无迹卡尔曼滤波算法具体如下:
通过对加速度计积分求得水下机器人速度,对速度进行分解可获得速度在地图坐标系的X轴Y轴速度分量,结合水下机器人运动模型,可对水下机器人运动速度进行推算;
其中,XY是地图坐标系,xy是水下机器人运动坐标系,选取的惯导测得航向角与地图坐标系间的角度差为θ,速度分量的求取为:
其中,VX是水下机器人在地图坐标系的X轴速度分量,VY是水下机器人在地图坐标系的Y轴速度分量;V是水下水下机器人通过对加速度计求积分得到的速度;假设水下机器人在水下做匀速运动,则***方程可以表示为:
其中,(x(k),y(k))为水下机器人k时刻的坐标,T为单位采样时间,wθ(k)为航向角在转向中受到的外部扰动,aX(k)为目标运动过程中地图坐标系中的X轴加速度,aY(k)为目标运动过程中地图坐标系中的Y轴加速度,为k时刻的航向角速度,加速度由水下机器人本身的加速度u(k)和外界扰动w(k)构成;
a(k)=u(k)+w(k);
对于不同时刻k,由具有高斯白噪声W(k)的随机变量X和具有高斯白噪声V(k)的观测变量Z构成的非线性***可以由下式描述,
式中,f是非线性状态方程函数;h是非线性观测方程函数,x为状态向量,X(K)、Z(k)、x(k)分别为随机变量X、观测变量Z、状态向量x在不同时刻k的映射;
根据无迹卡尔曼滤波算法进行信号滤波后,求得卡尔曼增益矩阵:
其中,p为状态向量x的方差;
最后计算***状态更新和协方差更新:
上述UKF基于***噪声W(k)与观测噪声V(k)已知的基础上;在实际应用中,W(k)与V(k)的噪声特性通常是未知的;Sage-Husa自适应滤波算法在已知***噪声特性或者观测噪声特性其中之一的情况下,可动态更新另一噪声的统计特性;如已知***高斯白噪声W(k),可用下式来动态更新观测噪声V(k)的统计特性:
其中:b为遗忘因子,一般取0<b<1,Hk为***的量测矩阵;k时刻的自适应因子dk由遗忘因子b和时刻k计算得到,并由1向1-b收敛;并且,自适应滤波算法的自适应程度有自适应参数dk或者遗忘因子的选取决定;
在更新观测噪声前,通过下式更新观测噪声协方差矩阵:
4.根据权利要求1所述基于自适应无迹卡尔曼滤波的超短基线定位方法,其特征在于,水下机器人深度信息由水下机器人本身深度计提供。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910971966.2A CN110703205B (zh) | 2019-10-14 | 2019-10-14 | 基于自适应无迹卡尔曼滤波的超短基线定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910971966.2A CN110703205B (zh) | 2019-10-14 | 2019-10-14 | 基于自适应无迹卡尔曼滤波的超短基线定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110703205A true CN110703205A (zh) | 2020-01-17 |
CN110703205B CN110703205B (zh) | 2023-05-02 |
Family
ID=69199275
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910971966.2A Active CN110703205B (zh) | 2019-10-14 | 2019-10-14 | 基于自适应无迹卡尔曼滤波的超短基线定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110703205B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111625009A (zh) * | 2020-06-05 | 2020-09-04 | 上海中车艾森迪海洋装备有限公司 | 水下机器人在布放回收过程中的自动运动控制方法及装置 |
CN112399366A (zh) * | 2020-05-27 | 2021-02-23 | 南京邮电大学 | 基于Hankel矩阵及WKNN方差提取的室内定位法 |
CN112907644A (zh) * | 2021-02-03 | 2021-06-04 | 中国人民解放军战略支援部队信息工程大学 | 一种面向机器地图的视觉定位方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1779485A (zh) * | 2004-11-17 | 2006-05-31 | 中国科学院沈阳自动化研究所 | 载人潜水器的组合导航定位方法 |
CN102052924A (zh) * | 2010-11-25 | 2011-05-11 | 哈尔滨工程大学 | 一种小型水下机器人组合导航定位方法 |
CN102495420A (zh) * | 2011-12-13 | 2012-06-13 | 大连海事大学 | 一种水下目标精确定位***及方法 |
CN107015201A (zh) * | 2017-06-09 | 2017-08-04 | 国家深海基地管理中心 | 一种超短基线定位***应急对钟方法及*** |
CN108490396A (zh) * | 2018-03-16 | 2018-09-04 | 哈尔滨工业大学(威海) | 一种基于水声信号卡尔曼滤波的超短基线定位方法 |
CN109737956A (zh) * | 2018-12-17 | 2019-05-10 | 东南大学 | 一种基于双应答器的sins/usbl相位差紧组合导航定位方法 |
CN109782323A (zh) * | 2018-12-24 | 2019-05-21 | 中国船舶重工集团公司第七一0研究所 | 一种深海水下自主航行器导航定位及校准方法 |
CN110006433A (zh) * | 2019-04-22 | 2019-07-12 | 哈尔滨工程大学 | 海底油气管检测机器人的组合导航定位***及方法 |
-
2019
- 2019-10-14 CN CN201910971966.2A patent/CN110703205B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1779485A (zh) * | 2004-11-17 | 2006-05-31 | 中国科学院沈阳自动化研究所 | 载人潜水器的组合导航定位方法 |
CN102052924A (zh) * | 2010-11-25 | 2011-05-11 | 哈尔滨工程大学 | 一种小型水下机器人组合导航定位方法 |
CN102495420A (zh) * | 2011-12-13 | 2012-06-13 | 大连海事大学 | 一种水下目标精确定位***及方法 |
CN107015201A (zh) * | 2017-06-09 | 2017-08-04 | 国家深海基地管理中心 | 一种超短基线定位***应急对钟方法及*** |
CN108490396A (zh) * | 2018-03-16 | 2018-09-04 | 哈尔滨工业大学(威海) | 一种基于水声信号卡尔曼滤波的超短基线定位方法 |
CN109737956A (zh) * | 2018-12-17 | 2019-05-10 | 东南大学 | 一种基于双应答器的sins/usbl相位差紧组合导航定位方法 |
CN109782323A (zh) * | 2018-12-24 | 2019-05-21 | 中国船舶重工集团公司第七一0研究所 | 一种深海水下自主航行器导航定位及校准方法 |
CN110006433A (zh) * | 2019-04-22 | 2019-07-12 | 哈尔滨工程大学 | 海底油气管检测机器人的组合导航定位***及方法 |
Non-Patent Citations (6)
Title |
---|
LIU KAI-ZHOU ET AL.: "Navigation system of a class of underwater vehicle based on adaptive unscented Kalman fiter algorithm", 《JOURNAL OF CENTRAL SOUTH UNIVERSITY》 * |
张涛 等: "一种 SINS/超短基线组合定位***安装误差标定算法", 《中国惯性技术学报》 * |
洪宇等: "基于自适应无迹卡尔曼的机器人室内定位算法", 《计算机测量与控制》 * |
邢志伟 等: "基于超短基线/多普勒的水下机器人位置估计", 《机器人》 * |
马剑等: "卡尔曼滤波算法在自主式水下机器人超短基线定位中的应用", 《舰船科学技术》 * |
黄玉龙 等: "自主水下航行器导航方法综述", 《水下无人***学报》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112399366A (zh) * | 2020-05-27 | 2021-02-23 | 南京邮电大学 | 基于Hankel矩阵及WKNN方差提取的室内定位法 |
CN111625009A (zh) * | 2020-06-05 | 2020-09-04 | 上海中车艾森迪海洋装备有限公司 | 水下机器人在布放回收过程中的自动运动控制方法及装置 |
CN111625009B (zh) * | 2020-06-05 | 2021-06-25 | 上海中车艾森迪海洋装备有限公司 | 水下机器人在布放回收过程中的自动运动控制方法及装置 |
CN112907644A (zh) * | 2021-02-03 | 2021-06-04 | 中国人民解放军战略支援部队信息工程大学 | 一种面向机器地图的视觉定位方法 |
CN112907644B (zh) * | 2021-02-03 | 2023-02-03 | 中国人民解放军战略支援部队信息工程大学 | 一种面向机器地图的视觉定位方法 |
Also Published As
Publication number | Publication date |
---|---|
CN110703205B (zh) | 2023-05-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109737956B (zh) | 一种基于双应答器的sins/usbl相位差紧组合导航定位方法 | |
CN110703205B (zh) | 基于自适应无迹卡尔曼滤波的超短基线定位方法 | |
CN111596333B (zh) | 一种水下定位导航方法及*** | |
CN110132308B (zh) | 一种基于姿态确定的usbl安装误差角标定方法 | |
CN110954132B (zh) | Grnn辅助自适应卡尔曼滤波进行导航故障识别的方法 | |
CN110794409A (zh) | 一种可估计未知有效声速的水下单信标定位方法 | |
CN109579850B (zh) | 基于对水速度辅助惯导的深水智能导航方法 | |
CN112710304B (zh) | 一种基于自适应滤波的水下自主航行器导航方法 | |
CN112197765B (zh) | 一种实现水下机器人精细导航的方法 | |
Kinsey et al. | Towards in-situ calibration of gyro and doppler navigation sensors for precision underwater vehicle navigation | |
CN104316025A (zh) | 一种基于船体姿态信息估计海浪浪高的*** | |
CN110702110A (zh) | 一种基于无迹卡尔曼滤波的舰船升沉运动测量方法 | |
CN114265047B (zh) | 一种大潜深auv的定位基阵联合标校方法 | |
CN107063300B (zh) | 一种基于反演的水下导航***动力学模型中扰动估计方法 | |
CN115096302A (zh) | 捷联惯性基导航***信息滤波鲁棒对准方法、***及终端 | |
CN110873813B (zh) | 一种水流速度估算方法、组合导航方法及装置 | |
CN113218421A (zh) | 北斗拒止条件下捷联惯导***鲁棒自适应动态对准方法 | |
CN116202492A (zh) | 一种基于高低频分离的随船波浪测量方法 | |
CN115950423A (zh) | 一种基于自适应滤波的舰船升沉运动测量方法 | |
CN113503891B (zh) | 一种sinsdvl对准校正方法、***、介质及设备 | |
CN115469314A (zh) | 一种均匀圆环阵稳健水下目标方位跟踪方法及*** | |
Helgesen et al. | Inertial navigation aided by ultra-wideband ranging for ship docking and harbor maneuvering | |
CN107664499B (zh) | 一种船用捷联惯导***的加速度计在线降噪方法 | |
CN115657667B (zh) | 航行器控制方法、装置、终端设备及计算机可读存储介质 | |
CN108562269A (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 |