CN106017460B - 一种地形辅助惯导紧组合的水下潜器导航定位方法 - Google Patents
一种地形辅助惯导紧组合的水下潜器导航定位方法 Download PDFInfo
- Publication number
- CN106017460B CN106017460B CN201610338941.5A CN201610338941A CN106017460B CN 106017460 B CN106017460 B CN 106017460B CN 201610338941 A CN201610338941 A CN 201610338941A CN 106017460 B CN106017460 B CN 106017460B
- Authority
- CN
- China
- Prior art keywords
- moment
- latent device
- systems
- navigation
- distance
- 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.)
- Active
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/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
Abstract
本发明公开了一种地形辅助惯导紧组合的水下潜器导航定位方法,主要步骤包括:初始化组合导航***;利用非线性离散状态方程进行状态量一步预测;利用非线性离散量测方程计算粒子滤波器的重要性权值;归一化重要性权值并估计潜器的导航参数;进行重要性重采样;完成非线性粒子滤波算法。本发明方法能有效、充分地利用各子***的信息,相比地形辅助惯导松组合方式,定位的精度有明显提高,保证了水下潜器的长航时导航定位精度。
Description
技术领域
本发明涉及一种水下潜器组合导航定位方法,具体涉及一种地形辅助惯导紧组合的水下潜器导航定位方法。
背景技术
水下潜器经过长时间航行后,惯性导航***输出的位置已经积累较大误差。考虑到安全性、隐蔽性和长时间水下作业的实际情况,采用地球物理场辅助惯性导航的无源导航技术,主要包括惯性/地形、惯性/重力和惯性/地磁组合导航。其基本原理都是通过潜器装备的传感器测量航行轨迹上的地球物理场数据,再与已有的海图数据库进行匹配,确定水下潜器的最佳位置。
地形导航最早应用在航空领域,作为战机和巡航导弹的一种辅助导航方法,其中最著名的有TERCOM和SITAN。目前,水下地形辅助惯性组合导航的研究多用于装备有高精度惯性***、多波束测深仪和高分辨率高精度海图数据库的高成本水下潜器。G.T.Donovan采用高成本水下潜器,比较了多波束测深仪、四波束DVL测深仪和单波束测深仪的导航定位效果。D.K.Meduna采用低成本水下潜器,研究了基于四波束多普勒测深仪的地形辅助惯导紧组合导航定位。单波束测深仪具有成本低、使用方便的优点,但其波束数量太少,采用单波束测深仪的低成本水下潜器的导航定位往往不能满足导航需求,基于单波束测深仪的低成本水下潜器地形辅助惯导紧组合研究还尚未见。
发明内容
技术问题:本发明的目的是为了解决当采用单波束测深仪时,地形辅助惯导松组合方式不能满足低成本水下潜器的导航定位要求,导致组合导航定位精度下降的问题,提供一种地形辅助惯导紧组合的水下潜器导航定位方法。由于单波束测深仪每次观测的波束数仅为单个,在粒子滤波的重要性权值的计算中不仅考虑水深误差,而且引入水平距离误差,从而可以提高低成本水下潜器组合导航的定位精度和收敛速度。
技术方案:本发明的一种地形辅助惯导紧组合的水下潜器导航定位方法,包括以下步骤:
步骤1)初始化地形辅助惯导组合导航定位***,为***的导航参数更新提供初始值:通过全球导航卫星***获取潜器的初始位置参数;根据惯性测量单元采集的潜器角速率和比力信息,以及多普勒测速仪测得的载体系速度,进行捷联惯性导航***的初始对准,获取潜器的初始姿态矩阵和导航系初始速度信息;初始时刻k=0,初始化M个粒子,根据先验概率分布进行粒子初始化;
步骤2)令k:=k+1,利用以潜器位置、姿态角和陀螺漂移为状态量的非线性离散状态方程进行一步预测,得到k时刻的一步预测状态量xk;
步骤3)利用非线性离散量测方程处理水深数据并提取水平距离,计算波束投影点水深误差、潜器的东向距离误差和北向距离误差,然后计算重要性权值;
步骤4)归一化重要性权值,得到k时刻状态量的最小均方估计为将其作为组合后的潜器导航参数输出;
步骤5)进行重要性重采样:得到新的粒子集合
步骤6)判断潜器航行时间是否结束,若是则结束本方法,否则返回步骤2)。
进一步的,本发明方法中,步骤2)中的非线性离散状态方程为:
式中:为k-1时刻的状态量估计值,当k=1时,为初始化的状态量,xk为k时刻的一步预测状态量,状态量的通用表达式为x=[p,q,ε]T;
p为n系下潜器的位置向量,p=[xE,xN,z]T,xE和xN分别为潜器的东向位置和北向位置分量,z是采用压力传感器测得的潜器的下潜深度,n系为导航坐标系,是东北天地理坐标系;
q为潜器的姿态角向量,q=[θ,γ,ψ]T,θ、γ和ψ分别为俯仰角、横滚角和航向角;
ε为b系下陀螺的常值漂移向量,ε=[εx,εy,εz]T,εx、εy和εz分别为对应于x轴、y轴和z轴的角速率常值漂移,b系为载体坐标系,是以潜器右前上方向矢量右手定则构成的坐标系;
为k-1时刻估计的潜器的姿态角,分别为估计的俯仰角、横滚角和航向角,为捷联惯性导航***计算的k-1时刻潜器由b系到n系的姿态矩阵;
υk-1是k-1时刻多波束测深仪测得的潜器在b系的速度;
ωx,k-1、ωy,k-1和ωz,k-1分别为k-1时刻三个轴向陀螺输出的角速率,εx,k-1,εy,k-1,εz,k-1分别为对应轴向角速率的常值漂移;
Δt为水深测量的采样时间;ek-1是***噪声,Σe为***噪声方差;[·]T表示矩阵转置。
进一步的,本发明方法中,所述步骤3)中的非线性离散量测方程为:
式中:yk为k时刻波束投影点到潜器的天向距离,yk=[0 0 1]R(qk)ark;
qk为一步预测姿态角,R(qk)为捷联惯性导航***计算的潜器由b系到n系的一步预测姿态矩阵;
rk为k时刻单波束测深仪测量的波束距离,在b系下为负值,a为b系下波束方位向量;
为波束投影点在海图上的水深值,通过双线性插值获取该水深值;
xE,k和xN,k分别表示k时刻一步预测状态量xk中的东向位置和北向位置分量;
zk是k时刻压力传感器测得的潜器的下潜深度;
dk为多普勒测速仪推算的潜器在k和k-1相邻水深测量时刻的水平距离,d=[dE,dN]T,dE和dN分别为相邻水深测量时刻潜器的东向距离和北向距离分量;
为第i个粒子一步预测的水平位置和k-1时刻潜器的水平位置估计值之间的距离,包括东向距离和北向距离分量;
为第i个粒子的一步预测状态量,这里具体指其中的东向位置和北向位置分量;
为k-1时刻潜器的状态量估计值,这里具体指其中的东向位置和北向位置估计值;
ηk是距离测量噪声,Ση为距离噪声方差。
进一步的,本发明方法中,所述步骤3)中根据下式计算重要性权值:
式中:为第i个粒子在k时刻的重要性权值;表示在和rk数据上的似然函数;
k=1时,
k>1时,有
式中:yk为k时刻波束投影点到潜器的天向距离,yk=[0 0 1]R(qk)ark;
dk为多普勒测速仪推算的潜器在k和k-1相邻水深测量时刻的水平距离;
为第i个粒子的一步预测状态量,这里具体指其中的东向位置和北向位置分量;
rk为k时刻单波束测深仪测量的波束距离,在b系下为负值,a为b系下波束方位向量;
是采用双线性插值法计算粒子的波束投影点在海图上的水深值;
zk是k时刻压力传感器测得的潜器的下潜深度;
dE,k和dN,k分别表示多普勒测速仪推算的潜器在k和k-1相邻水深测量时刻的东向距离和北向距离分量;
和分别表示第i个粒子一步预测的水平位置和k-1时刻潜器的水平位置估计值之间的东向距离和北向距离分量;
和分别表示k时刻第i个粒子的东向距离差和北向距离差。
本发明在D.K.Meduna紧组合研究的基础上,提出基于单波束测深仪的地形辅助惯导紧组合方式水下潜器导航定位方法。该方法能有效、充分地利用各子***的信息,相比地形辅助惯导松组合,定位精度有明显提高,保证了水下潜器的长航时导航定位精度。
有益效果:本发明与现有技术相比,具有以下优点:
(1)本发明中的地形辅助惯导紧组合导航***直接采用水深误差作为外观测量之一,将潜器的位置、姿态估计与水深值紧密结合,能有效、充分地利用各子***的信息,相比采用位置误差作为外观测量的地形辅助惯导松组合方式,定位的精度有明显提高。
(2)粒子滤波中重要性权值的计算不仅考虑水深误差,而且引入潜器的水平距离误差,在不增加任何***设备的前提下,增加外观测量有助于提高了水下潜器组合导航的定位精度和收敛速度。
附图说明
图1为一种地形辅助惯导紧组合的水下潜器导航定位结构框图;
图2为用Matlab仿真得到的潜器分别在地形粗糙区域(A区)和地形平坦区域(B区)的真实航行轨迹平面投影以及海图等深线分布图。
图3为用Matlab仿真得到的潜器在A区分别采用地形辅助惯导松/紧组合的导航定位结果图;
图4为用Matlab仿真得到的潜器在B区分别采用地形辅助惯导松/紧组合的导航定位结果图。
具体实施方式
下面结合实施例和说明书附图对本发明作进一步的说明。
如图1所示,本发明的一种地形辅助惯导紧组合的水下潜器导航定位方法,具体步骤如下:
步骤1)初始化地形辅助惯导组合导航定位***,为***的导航参数更新提供初始值:通过全球导航卫星***获取潜器的初始位置参数;根据惯性测量单元采集的潜器角速率和比力信息,以及多普勒测速仪测得的载体系速度,进行捷联惯性导航***的初始对准,获取潜器的初始姿态矩阵和导航系初始速度信息;初始时刻k=0,初始化M个粒子,根据先验概率分布进行粒子初始化;
步骤2)令k:=k+1,利用以潜器位置、姿态角和陀螺漂移为状态量的非线性离散状态方程(1)进行一步预测,得到k时刻的一步预测状态量xk;
式中:为k-1时刻的状态量估计值,当k=1时,为初始化的状态量,xk为k时刻的一步预测状态量,状态量的通用表达式为x=[p,q,ε]T;
p为n系下潜器的位置向量,p=[xE,xN,z]T,xE和xN分别为潜器的东向位置和北向位置分量,z是采用压力传感器测得的潜器下潜深度,n系为导航坐标系,是东北天地理坐标系;
q为潜器姿态角向量,q=[θ,γ,ψ]T,θ、γ和ψ分别为俯仰角、横滚角和航向角;
ε为b系下陀螺的常值漂移向量,ε=[εx,εy,εz]T,εx、εy和εz分别为对应于x轴、y轴和z轴的角速率常值漂移,b系为载体坐标系,是以潜器右前上方向矢量右手定则构成的坐标系;
为k-1时刻估计的潜器的姿态角,和分别为估计的俯仰角、横滚角和航向角,为捷联惯性导航***计算的k-1时刻潜器由b系到n系的姿态矩阵;
υk-1是k-1时刻多波束测深仪测得的潜器在b系的速度;
ωx,k-1、ωy,k-1和ωz,k-1分别为k-1时刻三个轴向陀螺输出的角速率,εx,k-1,εy,k-1,εz,k-1分别为对应轴向角速率的常值漂移;
Δt为水深测量的采样时间;ek-1是***噪声,Σe为***噪声方差;[·]T表示矩阵转置;
步骤3)利用非线性离散量测方程(2)处理水深数据并提取水平距离,计算波束投影点水深误差、潜器的东向距离误差和北向距离误差,然后计算重要性权值;
式中:yk为k时刻波束投影点到潜器的天向距离,yk=[0 0 1]R(qk)ark;
qk为一步预测姿态角,R(qk)为捷联惯性导航***计算的潜器由b系到n系的一步预测姿态矩阵;
rk为k时刻单波束测深仪测量的波束距离,在b系下为负值,a为b系下波束方位向量;
为波束投影点在海图上的水深值,通过双线性插值获取该水深值;
xE,k和xN,k分别表示k时刻一步预测状态量xk中的东向位置和北向位置分量;
zk是k时刻压力传感器测得的潜器的下潜深度;
dk为多普勒测速仪推算的潜器在k和k-1相邻水深测量时刻的水平距离,d=[dE,dN]T,dE和dN分别为相邻水深测量时刻潜器的东向距离和北向距离分量;
为第i个粒子一步预测的水平位置和k-1时刻潜器的水平位置估计值之间的距离,包括东向距离和北向距离分量;
为第i个粒子的一步预测状态量,这里具体指其中的东向位置和北向位置分量;
为k-1时刻载体的状态量估计值,这里具体指其中的东向位置和北向位置估计值;
ηk是距离测量噪声,Ση为距离噪声方差;
式中:为第i个粒子在k时刻的重要性权值;表示在和rk数据上的似然函数;
k=1时,
k>1时,有
式中:yk为k时刻波束投影点到潜器的天向距离,yk=[0 0 1]R(qk)ark;
dk为多普勒测速仪推算的潜器在k和k-1相邻水深测量时刻的水平距离;
为第i个粒子的一步预测状态量,这里具体指其中的东向位置和北向位置分量;
rk为k时刻单波束测深仪测量的波束距离,在b系下为负值,a为b系下波束方位向量;
是采用双线性插值法计算粒子的波束投影点在海图上的水深值;
zk是k时刻压力传感器测得的潜器的下潜深度;
dE,k和dN,k分别表示多普勒测速仪推算的潜器在k和k-1相邻水深测量时刻的东向距离和北向距离分量;
和分别表示第i个粒子一步预测的水平位置和k-1时刻潜器的水平位置估计值之间的东向距离和北向距离分量;
和分别表示k时刻第i个粒子的东向距离差和北向距离差;
步骤4)归一化重要性权值,得到k时刻状态量的最小均方估计为将其作为组合后的潜器导航参数输出;
步骤5)进行重要性重采样:得到新的粒子集合
步骤6)判断潜器航行时间是否结束,若是则结束本方法,否则返回步骤2)。
本发明的可行性通过如下仿真加以验证:
(1)地形辅助导航和捷联惯性导航***,构成以捷联惯导为主、地形导航为辅的地形辅助惯导组合导航定位***,水下潜器分别在地形粗糙区域(A区)和地形平坦区域(B区)两个区域以2节速度航行,潜器实际航迹平面投影如图2所示;
(2)根据选用的惯性测量单元精度,设置陀螺随机常值漂移0.05°/h,随机白噪声0.05°/√hr,加速度计随机常值偏置0.2mg,随机白噪声0.2m/sec/√hr,多普勒测速仪测量误差0.05m/s,潜器在A区的初始位置(667.1m,300.2m,0m),潜器在B区的初始位置(2223.6m,66.7m,0m),初始水平位置误差100m,初始航向角误差0.5°,初始纵摇角误差0.05°,初始横摇角误差0.02°;
(3)海图范围:3000m×1200m,海图分辨率分为10m,水深量程范围:-241.7m~0m,海图水深误差为20cm,单波束测深仪量程范围0.3m~300m,测量精度±1cm+0.1%(×水深值),压力传感器测深范围0.1m~300m,测量精度为深度的0.01%,水深测量误差±1m;
(4)惯性传感器数据更新周期为50ms,水深测量的采样时间和滤波周期均为1s,航行时间3500s;
(5)粒子滤波器选用2000个粒子。
在不同地形区域(A区和B区)下,分别采用地形辅助惯导松/紧组合实现水下潜器导航定位。通过50次蒙特卡洛(MC)实验,取50次实验的平均值,得到组合导航定位结果如图3和图4所示,导航统计结果见表1。从结果中可以看出,本发明所提方法无论在地形粗糙区域还是地形平坦区域,导航的结果均优于传统松组合方法。
表1 50次MC仿真结果
上述实施例仅是本发明的优选实施方式,应当指出:对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和等同替换,这些对本发明权利要求进行改进和等同替换后的技术方案,均落入本发明的保护范围。
Claims (3)
1.一种地形辅助惯导紧组合的水下潜器导航定位方法,其特征在于,该方法包括以下步骤:
步骤1)初始化地形辅助惯导组合导航定位***,为***的导航参数更新提供初始值:通过全球导航卫星***获取潜器的初始位置参数;根据惯性测量单元采集的潜器角速率和比力信息,以及多普勒测速仪测得的载体系速度,进行捷联惯性导航***的初始对准,获取潜器的初始姿态矩阵和导航系初始速度信息;初始时刻k=0,初始化M个粒子,根据先验概率分布进行粒子初始化;
步骤2)令k:=k+1,利用以潜器位置、姿态角和陀螺漂移为状态量的非线性离散状态方程进行一步预测,得到k时刻的一步预测状态量xk;
步骤3)利用非线性离散量测方程处理水深数据并提取水平距离,计算波束投影点水深误差、潜器的东向距离误差和北向距离误差,然后计算重要性权值,所述非线性离散量测方程为:
式中:yk为k时刻波束投影点到潜器的天向距离,yk=[0 0 1]R(qk)ark;
qk为一步预测姿态角,R(qk)为捷联惯性导航***计算的潜器由b系到n系的一步预测姿态矩阵;
rk为k时刻单波束测深仪测量的波束距离,在b系下为负值,a为b系下波束方位向量;
为波束投影点在海图上的水深值,通过双线性插值获取该水深值;
xE,k和xN,k分别表示k时刻一步预测状态量xk中的东向位置和北向位置分量;
zk是k时刻压力传感器测得的潜器的下潜深度;
dk为多普勒测速仪推算的潜器在k和k-1相邻水深测量时刻的水平距离,d=[dE,dN]T,dE和dN分别为相邻水深测量时刻潜器的东向距离和北向距离分量;
为第i个粒子一步预测的水平位置和k-1时刻潜器的水平位置估计值之间的距离,包括东向距离和北向距离分量;
为第i个粒子的一步预测状态量,这里具体指其中的东向位置和北向位置分量;
为k-1时刻潜器的状态量估计值,这里具体指其中的东向位置和北向位置估计值;
ηk是距离测量噪声,ηk~Ν(0,Ση),Ση为距离噪声方差;
步骤4)归一化重要性权值,得到k时刻状态量的最小均方估计为将其作为组合后的潜器导航参数输出;
步骤5)进行重要性重采样:得到新的粒子集合
步骤6)判断潜器航行时间是否结束,若是则结束本方法,否则返回步骤2)。
2.根据权利要求1所述的一种地形辅助惯导紧组合的水下潜器导航定位方法,其特征在于,所述步骤2)中的非线性离散状态方程为:
式中:为k-1时刻的状态量估计值,当k=1时,初始化的状态量,xk为k时刻的一步预测状态量,状态量的通用表达式为x=[p,q,ε]T;
p为n系下潜器的位置向量,p=[xE,xN,z]T,xE和xN分别为潜器的东向位置和北向位置分量,z是采用压力传感器测得的潜器的下潜深度,n系为导航坐标系,是东北天地理坐标系;
q为潜器的姿态角向量,q=[θ,γ,ψ]T,θ、γ和ψ分别为俯仰角、横滚角和航向角;
ε为b系下陀螺的常值漂移向量,ε=[εx,εy,εz]T,εx、εy和εz分别为对应于x轴、y轴和z轴的角速率常值漂移,b系为载体坐标系,是以潜器右前上方向矢量右手定则构成的坐标系;
为k-1时刻估计的潜器的姿态角, 和分别为估计的俯仰角、横滚角和航向角,为捷联惯性导航***计算的k-1时刻潜器由b系到n系的姿态矩阵;
vk-1是k-1时刻多波束测深仪测得的潜器在b系的速度;
ωx,k-1、ωy,k-1和ωz,k-1分别为k-1时刻三个轴向陀螺输出的角速率,εx,k-1,εy,k-1,εz,k-1分别为对应轴向角速率的常值漂移;
Δt为水深测量的采样时间;ek-1是***噪声,ek-1~Ν(0,Σe),Σe为***噪声方差;[·]T表示矩阵转置。
3.根据权利要求1或2所述的一种地形辅助惯导紧组合的水下潜器导航定位方法,其特征在于,所述步骤3)中根据下式计算重要性权值:
式中:为第i个粒子在k时刻的重要性权值;表示在和rk数据上的似然函数;
k=1时,
k>1时,有
式中:yk为k时刻波束投影点到潜器的天向距离,yk=[0 0 1]R(qk)ark;
dk为多普勒测速仪推算的潜器在k和k-1相邻水深测量时刻的水平距离;
为第i个粒子的一步预测状态量,这里具体指其中的东向位置和北向位置分量;
rk为k时刻单波束测深仪测量的波束距离,在b系下为负值,a为b系下波束方位向量;
是采用双线性插值法计算粒子的波束投影点在海图上的水深值;
zk是k时刻压力传感器测得的潜器的下潜深度;
dE,k和dN,k分别表示多普勒测速仪推算的潜器在k和k-1相邻水深测量时刻的东向距离和北向距离分量;
和分别表示第i个粒子一步预测的水平位置和k-1时刻潜器的水平位置估计值之间的东向距离和北向距离分量;
和分别表示k时刻第i个粒子的东向距离差和北向距离差。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610338941.5A CN106017460B (zh) | 2016-05-20 | 2016-05-20 | 一种地形辅助惯导紧组合的水下潜器导航定位方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610338941.5A CN106017460B (zh) | 2016-05-20 | 2016-05-20 | 一种地形辅助惯导紧组合的水下潜器导航定位方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106017460A CN106017460A (zh) | 2016-10-12 |
CN106017460B true CN106017460B (zh) | 2018-08-14 |
Family
ID=57095447
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610338941.5A Active CN106017460B (zh) | 2016-05-20 | 2016-05-20 | 一种地形辅助惯导紧组合的水下潜器导航定位方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106017460B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108562287A (zh) * | 2018-01-08 | 2018-09-21 | 哈尔滨工程大学 | 一种基于自适应采样粒子滤波的水下地形辅助导航方法 |
CN109813316B (zh) * | 2019-01-14 | 2022-07-29 | 东南大学 | 一种基于地形辅助的水下载体紧组合导航方法 |
CN110487276B (zh) * | 2019-08-20 | 2021-01-12 | 北京理工大学 | 一种基于相关分析的采样矢量匹配定位方法 |
CN112653992B (zh) * | 2019-10-12 | 2022-01-07 | 中国科学院声学研究所 | 一种无需时钟同步的移动编队相对自定位方法 |
CN111238483A (zh) * | 2020-02-12 | 2020-06-05 | 上海海事大学 | 基于sir粒子滤波方法的低功耗地形辅助导航***及方法 |
CN114545471A (zh) * | 2022-02-16 | 2022-05-27 | 武汉元生创新科技有限公司 | 一种用于水下导航的智能线缆定位***及方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103745123A (zh) * | 2014-01-23 | 2014-04-23 | 国家***第二海洋研究所 | 基于移动子窗与可变算子的多波束测深数据自动处理方法 |
CN104390646A (zh) * | 2014-09-15 | 2015-03-04 | 东南大学 | 水下潜器地形辅助惯性导航***的位置匹配方法 |
CN104820993A (zh) * | 2015-03-27 | 2015-08-05 | 浙江大学 | 一种联合粒子滤波和跟踪置前检测的水下弱目标跟踪方法 |
CN105424036A (zh) * | 2015-11-09 | 2016-03-23 | 东南大学 | 一种低成本水下潜器地形辅助惯性组合导航定位方法 |
-
2016
- 2016-05-20 CN CN201610338941.5A patent/CN106017460B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103745123A (zh) * | 2014-01-23 | 2014-04-23 | 国家***第二海洋研究所 | 基于移动子窗与可变算子的多波束测深数据自动处理方法 |
CN104390646A (zh) * | 2014-09-15 | 2015-03-04 | 东南大学 | 水下潜器地形辅助惯性导航***的位置匹配方法 |
CN104820993A (zh) * | 2015-03-27 | 2015-08-05 | 浙江大学 | 一种联合粒子滤波和跟踪置前检测的水下弱目标跟踪方法 |
CN105424036A (zh) * | 2015-11-09 | 2016-03-23 | 东南大学 | 一种低成本水下潜器地形辅助惯性组合导航定位方法 |
Non-Patent Citations (3)
Title |
---|
基于约束粒子群优化的海底地形辅助惯性导航定位方法;周玲等;《中国惯性技术学报》;20150630;第23卷(第3期);369-384 * |
多波束水深测量误差源分析与成果质量评定;黄辰虎等;《海洋测绘》;20140331;第34卷(第2期);1-6 * |
多波束粒子群深度零点轨迹信息搜索效率优化;李颖等;《科技通报》;20150630;第31卷(第6期);97-99 * |
Also Published As
Publication number | Publication date |
---|---|
CN106017460A (zh) | 2016-10-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106017460B (zh) | 一种地形辅助惯导紧组合的水下潜器导航定位方法 | |
US10107627B2 (en) | Adaptive navigation for airborne, ground and dismount applications (ANAGDA) | |
Gade | The seven ways to find heading | |
CN104075715B (zh) | 一种结合地形和环境特征的水下导航定位方法 | |
CN102829777B (zh) | 自主式水下机器人组合导航***及方法 | |
Hong et al. | A car test for the estimation of GPS/INS alignment errors | |
CN106643709B (zh) | 一种海上运载体的组合导航方法及装置 | |
CN107314768A (zh) | 水下地形匹配辅助惯性导航定位方法及其定位*** | |
CN111829512B (zh) | 一种基于多传感器数据融合的auv导航定位方法及*** | |
CN104049269B (zh) | 一种基于激光测距和mems/gps组合导航***的目标导航测绘方法 | |
CN105424036A (zh) | 一种低成本水下潜器地形辅助惯性组合导航定位方法 | |
CN105841698B (zh) | 一种无需调零的auv舵角精确实时测量*** | |
CN104390646A (zh) | 水下潜器地形辅助惯性导航***的位置匹配方法 | |
CN103076026B (zh) | 一种捷联惯导***中确定多普勒计程仪测速误差的方法 | |
CN202209953U (zh) | 用于水下载体的地磁辅助惯性导航*** | |
CN107015259A (zh) | 采用多普勒测速仪计算伪距/伪距率的紧组合方法 | |
Troni et al. | Preliminary experimental evaluation of a Doppler-aided attitude estimator for improved Doppler navigation of underwater vehicles | |
CN105547289A (zh) | 一种水下航行器组合导航***及导航信息融合方法 | |
CN106123917B (zh) | 考虑外杆臂效应的捷联惯导***罗经对准方法 | |
US20140249750A1 (en) | Navigational and location determination system | |
CN105371853A (zh) | 基于tds与轨道器的火星动力下降段导航方法 | |
CN109813316A (zh) | 一种基于地形辅助的水下载体紧组合导航方法 | |
CN105180928B (zh) | 一种基于惯性系重力特性的船载星敏感器定位方法 | |
CN103616026A (zh) | 一种基于h∞滤波的auv操纵模型辅助捷联惯导组合导航方法 | |
Zhou et al. | Geomagnetic matching algorithm based on the probabilistic neural network |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |