CN109945895A - 基于渐消平滑变结构滤波的惯性导航初始对准方法 - Google Patents
基于渐消平滑变结构滤波的惯性导航初始对准方法 Download PDFInfo
- Publication number
- CN109945895A CN109945895A CN201910281718.5A CN201910281718A CN109945895A CN 109945895 A CN109945895 A CN 109945895A CN 201910281718 A CN201910281718 A CN 201910281718A CN 109945895 A CN109945895 A CN 109945895A
- Authority
- CN
- China
- Prior art keywords
- error
- equation
- inertial navigation
- fades
- structure changes
- 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
Landscapes
- Navigation (AREA)
Abstract
本发明提出了一种基于渐消平滑变结构滤波的惯性导航初始对准方法,具体步骤为:根据捷联惯性导航***的速度误差方程、姿态误差方程,以速度误差为量测量,建立大方位失准角下的非线性连续***模型;将非线性连续***模型离散化,形成非线性离散***模型;根据建立的非线性离散***模型构建用于初始对准的渐消平滑变结构滤波模型,并求解滤波模型中的渐消因子;将惯性元件采集到的导航参数代入渐消平滑变结构滤波模型中,完成惯性导航的初始对准。本发明能提供高精度的初始姿态信息,提高了惯性导航初始对准的精度。
Description
技术领域
本发明属于制导技术,具体为一种基于渐消平滑变结构滤波的惯性导航初始对准方法。
背景技术
近些年惯性导航的民用领域逐渐扩大,在民用飞机,船舶,汽车运输,以及农业播种,施肥等领域都发挥着重要作用。惯性导航***采取推算式导航方式,即通过对惯性测量组件(Inertial Navigation System,IMU)测量的加速度、角速度信号的连续积分运算,获得运载器的位置、速度、姿态信息。因此在惯导***开始工作之前,需要为惯导***提供运载器初始位置、速度、姿态信息。获得准确导航的一个关键因素就是在惯导***开始工作前对其进行初始对准,即向惯导***提供准确的运载器位置、速度和姿态信息。因为任何初始信息中的误差将随着惯导***工作时间增加产生输出误差。此外,由于捷联算法结构缘故,这些初始误差在很短的时间内将引起惯导***输出误差的快速积累,最终有可能导致最终输出的位置、速度、姿态信息变得误差巨大。所以初始对准是惯性导航***的关键技术之一,初始对准的精度直接关系到惯导***的工作精度。
惯性导航***主要分为平台式惯性导航***(Gimbaled INS,GINS)和捷联式惯性导航***(Strap-down INS,SINS)两种类型。SINS具有***结构简单、可靠性高、体积小、重量轻、成本低、易维修等优点,已成为惯性技术中的一个主要发展方向,在许多应用领域中已经取代了GINS。捷联式惯性导航***摒弃了稳定平台和常平架***,而将陀螺仪和加速度计直接与载体固连的惯性导航***。在捷联惯导***中经常采用卡尔曼滤波(KalmanFilter,KF)技术,但是该技术要求能够提供***精确的状态方程和量测方程,并且***噪声和量测噪声是均值为零、协方差已知的高斯噪声,否则难以满足要求,甚至发散。针对此问题,不同的研究者提出了很多滤波算法如扩展卡尔曼滤波(Extended Kalman Filter,EKF)、无迹卡尔曼滤波(Unscented Kalman Filter,UKF)、正交卡尔曼滤波算法(Quadrature Kalman Filter,QKF)、容积卡尔曼滤波(Cubature Kalman Filter,CKF),但仍存在诸多不足,如:模型误差作为过程噪声来处理,且假设为高斯白噪声,这与惯性导航***的实际噪声情况并不相符,***模型鲁棒性差。
发明内容
本发明的目的在于提出了一种基于渐消平滑变结构滤波的惯性导航初始对准方法,以解决现有捷联惯导***滤波发散,稳定性差的问题。
实现本发明的技术解决方案为:一种基于渐消平滑变结构滤波的惯性导航初始对准方法,具体步骤为:
步骤1、根据捷联惯性导航***的速度误差方程、姿态误差方程,以速度误差为量测量,建立大方位失准角下的非线性连续***模型;
步骤2、将步骤1中的非线性连续***模型离散化,形成非线性离散***模型;
步骤3、根据步骤2中建立的非线性离散***模型构建用于初始对准的渐消平滑变结构滤波模型,并求解滤波模型中的渐消因子;
步骤4、将惯性元件采集到的导航参数代入渐消平滑变结构滤波模型中,完成惯性导航的初始对准。
优选地,步骤3构建的用于初始对准的渐消平滑变结构滤波模型具体为:
渐消平滑变结构滤波的非线性状态方程和非线性量测方程为:
式中,f(·)为状态转移函数;h(·)为量测转移函数;xk为***状态;uk是***的相对输入;wk是***噪声;zk+1是量测值;xk+1为状态值,vk+1是量测噪声;
先验状态估计方程和协方差方程分别为:
式中,为预测先验状态估计,Pk+1|k为先验状态估计协方差,为前一刻的状态估计,Pk|k为前一时刻的状态估计方差,Qk为***噪声协方差阵,λk为渐消因子,为状态矩阵;
先验量测估计方程和量测误差变量方程分别为:
式中,为量测估计方程,ez,k+1|k为量测误差变量。
后验状态估计方程和增益方程分别为:
式中,为后验状态估计,KK+1为增益,为状态矩阵;为量测矩阵;Ak+1=|ez,k+1|k|+γ|ez,k|k|;ez,k+1|k为先验量测误差变量;ez,k+1|k+1为后验量测误差变量;ez,k|k为量测误差变量;ψ为平滑有界层的宽度;γ为记忆或收敛速度因子,0<γ<1;
ψi为给定的噪声上限值;
新息方差方程以及平滑有界层矩阵方程分别为:
式中,Sk+1为新息方差,ψk+1为平滑有界层矩阵,Rk为量测噪声协方差阵;
后验状态估计方差方程、后验量测估计方程和后验量测误差变量方程分别为:
式中:Pk+1|k+1为后验状态估计方差,为后验量测估计。
本发明与现有技术相比,其显著优点为:
(1)本发明的渐消平滑变结构滤波模型在模型不确定、量测噪声非高斯白噪声的情形下,能够提供高精度的初始姿态信息,提高了惯性导航初始对准的精度;
(2)本发明构建的渐消平滑变结构滤波模型,具有较好的稳定性和鲁棒性;
(3)通本发明过引入渐消因子对协方差预报方程进行调整,能抑制滤波发散,滤波效果更佳。
下面结合附图对本发明做进一步详细的描述。
附图说明
图1是基于渐消平滑变结构滤波的惯性导航初始对准方法的流程图。
具体实施方式
如图1所示,基于渐消平滑变结构滤波的惯性导航初始对准方法,具体步骤为:
步骤1、根据捷联惯性导航***的速度误差方程、姿态角误差方程,以导航系速度为量测量,建立大方位失准角下的非线性连续***模型,具体为:
以地理坐标系作为导航坐标系n,由惯性导航***解算的位置建立的坐标系为计算坐标系g,以载体实际位置为载体坐标系b,姿态和速度误差误差分别为:
式中,φ是姿态误差矢量;δv是速度误差矢量;是导航坐标系到计算坐标系的转换矩阵;是载体坐标系到计算坐标系的方向余弦矩阵,每个元素表示为C’ij(i=1,2,3;j=1,2,3),是载体坐标系到导航坐标系的方向余弦矩阵,每个元素表示为Cij i=1,2,3;j=1,2,3),为加速度计的实际输出;δfb为加速度计误差;为陀螺测量误差;为解算出的数学平台旋转角速度;为地球旋转角速度;为解算出的数学平台相对于地球的旋转角速度;为对应的的计算误差;δg为重力加速度的计算误差;[·]T表示矩阵转置。
设静基座下的v=0,忽略重力加速度的计算误差δg,则:加速度计误差δfb主要来源于常值零偏和零均值白噪声陀螺量测误差主要来源于常值漂移εb和零均值白噪声加速度计输出在计算坐标系上的投影为其中fx、fy、fz为投影在x、y、z轴的分量。
将上述速度误差方程、姿态误差方程详细展开组成初始对准非线性模型方程,具体形式如下:
式中,惯导***的俯仰、横滚和航向的姿态误差角分别为下标N、E、U分别表示北向、东向和天向分量;L为载体所在的地理纬度;东向、北向的速度误差为δVE、δVN;***噪声向量为其中为北向和东向的速度误差的***噪声;为俯仰、横滚和航向的姿态误差角的***噪声。取两个水平速度误差δVE和δVN为观测量。在***精度和可观测性基础上,考虑和等不可观状态,对设计的滤波影响不大,因而可以忽略,因此构建惯性导航***的非线性误差模型为:
式中,状态向量f(X)、G(X)分别具体为:
式中,Z=[Z1 Z2]T=[δVN δVE]T为观测矢量,H=[I2×2 O2×3]为观测矩阵,v为观测方程的量测噪声。
步骤2、将步骤1中的非线性连续***模型离散化,形成非线性离散***模型,具体过程为:
步骤1中构建的非线性连续***模型是非线性连续的,将非线性连续***模型通过四阶龙格库塔方法进行离散化处理,即以采样周期Tf作为滤波周期,并以Tf为步长将非线性连续***模型进行离散化后,非线性离散***模型为:
式中,wk和vk分别表示k时刻离散的***噪声和量测噪声,并且wk和vk满足:
E[·]表示均值,Cov[·]表示协方差,Qk为离散***噪声wk的方差强度阵,Rk为离散量测噪声vk的方差强度阵,具体为:Rk=R/Tf,R为连续***噪声v的方差强度阵;Tf为滤波周期;δkj为Kronecker-δ函数。
步骤3、根据步骤2中建立的非线性离散***模型构建用于初始对准的渐消平滑变结构滤波模型,并求解滤波模型中的渐消因子,渐消平滑变结构滤波模型具体为:
渐消平滑变结构滤波的非线性状态方程和非线性量测方程为:
式中,f(·)为状态转移函数;h(·)为量测转移函数;xk为***状态;uk是***的相对输入;wk是***噪声;zk+1是量测值;xk+1为状态值vk+1是量测噪声。
在忽略***噪声的情况下,采用非线性状态方程预测先验状态估计和协方差方程为:
式中,预测先验状态估计,Pk+1|k为先验状态估计协方差,为前一刻的状态估计,Pk|k为前一时刻的状态估计方差,Qk为***噪声协方差阵,λk为渐消因子,为状态矩阵。
在忽略量测噪声的情况下,采用非线性量测方程预测先验量测估计,并计算量测误差变量:
式中,为量测估计方程,ez,k+1|k为量测误差变量。
然后计算渐消平滑变结构滤波器的增益用来改善***后验状态估计方程分别为:
式中,为后验状态估计
对于渐消平滑变结构滤波器来说,能够有效估计***状态的前提是:|ez,k+1|k+1|<|ez,k|k|即前一周期的误差大于后一周期的估计误差,***误差是收敛的。基于上述前提,得到滤波器的增益方程为:
式中,KK+1为增益,为状态矩阵,为量测矩阵,Ak+1=|ez,k+1|k|+γ|ez,k|k|,ez,k+1|k为先验量测误差变量,ez,k+1|k+1为后验量测误差变量,ez,k|k为量测误差变量,ψ为平滑有界层的宽度,γ为记忆或收敛速度因子,0<γ<1;
ψi为给定的噪声上限值;
然后,计算***的新息方差以及平滑有界层矩阵方程分别为:
式中,Sk+1为新息方差,ψk+1为平滑有界层矩阵,Rk为量测噪声协方差阵。
最后计算后验状态估计方差、更新后的量测估计和其对应的后验量测误差变量方程分别为:
式中:Pk+1|k+1为后验状态估计方差,为后验量测估计。
求解滤波模型中的渐消因子:
渐消平滑变结构滤波器就是采用遗忘因子限制平滑变结构滤波器的记忆长度,充分利用现时的测量数据,加重现时数据在状态估计中的作用,从而避免了滤波发散。
由于渐消平滑变结构滤波在计算Pk+1|k时乘了渐消因子λk,因此需要对其求解,渐消因子λk是基于新息向量的统计特性来确定的,滤波器中每一步预的新息向量为:
Vk+1=zk+1-Hk+1xk+1|k
在滤波最优的情况下,其新息序列协方差阵为:
新息序列自相关函数:
式中,E[·]是对[·]取均值符号;Pk+1|k为***协方差;Kk+1为滤波增益;Hk+1为量测矩阵;
通过开窗法得到新息序列协方差阵的估计值为:
式中,V0为k=0时刻新息序列向量;λk-1为k-1时刻渐消因子;
如果残差自相关函数等于零,即残差序列不相关或者说残差序列保持相互正交,则Kk+1是最优的。实际情况是,由于模型误差,实际的残差方差阵Co(k+1)与计算出的理论值不一样,因此,残差自相关函数不一定等于0。基于以上情况,可以实时地调整滤波增益阵Kk+1,强迫残差序列保持相互正交,即使Co(k+1)等于零成立。根据上述分析,求解得到渐消因子λk:
式中,max{·}表示取{·}中最大的值;trace代表矩阵的迹
步骤4、将惯性元件采集到的导航参数代入渐消平滑变结构滤波模型中,使平台进入导航工作状态时的对准精度符合惯导要求,完成惯性导航的初始对准。
本发明中提出了一种新的基于渐消平滑变结构滤波模型,其基本思想是基于变结构和滑模控制概念,采用变结构的增益,使得预测状态趋近于***真实轨迹,因此是一种“预测-校正”的估计器,其对于建模的不确定性和给定上限但无法建模的扰动噪声等引起的初始对准精度下降问题,具有较好的稳定性和鲁棒性。同时采用渐消因子限制平滑变结构滤波器的记忆长度,充分利用现时的测量数据,加重现时数据在状态估计中的作用,从而避免了滤波发散。
Claims (7)
1.一种基于渐消平滑变结构滤波的惯性导航初始对准方法,其特征在于,具体步骤为:
步骤1、根据捷联惯性导航***的速度误差方程、姿态误差方程,以速度误差为量测量,建立大方位失准角下的非线性连续***模型;
步骤2、将步骤1中的非线性连续***模型离散化,形成非线性离散***模型;
步骤3、根据步骤2中建立的非线性离散***模型构建用于初始对准的渐消平滑变结构滤波模型,并求解滤波模型中的渐消因子;
步骤4、将惯性元件采集到的导航参数代入渐消平滑变结构滤波模型中,完成惯性导航的初始对准。
2.根据权利要求1所述的基于渐消平滑变结构滤波的惯性导航初始对准方法,其特征在于,步骤1中速度误差方程、姿态误差方程为:
式中,φ是姿态误差矢量;δv是速度误差矢量;是导航坐标系到计算坐标系的转换矩阵是载体坐标系到计算坐标系的方向余弦矩阵,每个元素表示为C′ij,i=1,2,3;j=1,2,3;是载体坐标系到导航坐标系的方向余弦矩阵,每个元素表示为Cij,i=1,2,3;j=1,2,3;为加速度计的实际输出;δfb为加速度计误差;为陀螺测量误差;为解算出的数学平台旋转角速度;为地球旋转角速度;为解算出的数学平台相对于地球的旋转角速度;为对应的计算误差;δg为重力加速度的计算误差;[·]T表示矩阵转置。
3.根据权利要求1所述的基于渐消平滑变结构滤波的惯性导航初始对准方法,其特征在于,步骤1中建立的大方位失准角下的非线性连续***模型为:
式中,状态向量f(X)、G(X)分别具体为:
式中,Z=[Z1 Z2]T=[δVN δVE]T为观测矢量,L为载体所在的地理纬度,H=[I2×2 O2×3]为观测矩阵,v为观测方程的量测噪声;分别为惯导***俯仰、横滚和航向的姿态误差角,下标N、E、U分别表示北向、东向和天向分量;δVE为东向速度误差,δVN为北向速度误差,为***噪声向量,为北向和东向的速度误差的***噪声;为俯仰、横滚和航向的姿态误差角的***噪声。
4.根据权利要求1所述的基于渐消平滑变结构滤波的惯性导航初始对准方法,其特征在于,步骤2中形成的非线性离散***模型为:
式中,wk和vk分别表示k时刻离散的***噪声和量测噪声,并且wk和vk满足:
E[·]表示均值,Cov[·]表示协方差,Qk为离散***噪声wk的方差强度阵,Rk为离散量测噪声vk的方差强度阵,具体为:Rk=R/Tf,R为连续***噪声v的方差强度阵;Tf为滤波周期;δkj为Kronecker-δ函数。
5.根据权利要求1所述的基于渐消平滑变结构滤波的惯性导航初始对准方法,其特征在于,步骤3构建的用于初始对准的渐消平滑变结构滤波模型具体为:
渐消平滑变结构滤波的非线性状态方程和非线性量测方程为:
式中,f(·)为状态转移函数;h(·)为量测转移函数;xk为***状态;uk是***的相对输入;wk是***噪声;zk+1是量测值;xk+1为状态值,vk+1是量测噪声;
先验状态估计方程和协方差方程分别为:
式中,为预测先验状态估计,Pk+1|k为先验状态估计协方差,为前一刻的状态估计,Pk|k为前一时刻的状态估计方差,Qk为***噪声协方差阵,λk为渐消因子,为状态矩阵;
先验量测估计方程和量测误差变量方程分别为:
式中,为量测估计方程,ez,k+1|k为量测误差变量。
后验状态估计方程和增益方程分别为:
式中,为后验状态估计,KK+1为增益,为状态矩阵;为量测矩阵;Ak+1=|ez,k+1|k|+γ|ez,k|k|;ez,k+1|k为先验量测误差变量;ez,k+1|k+1为后验量测误差变量;ez,k|k为量测误差变量;ψ为平滑有界层的宽度;γ为记忆或收敛速度因子,0<γ<1;
ψi为给定的噪声上限值;
新息方差方程以及平滑有界层矩阵方程分别为:
式中,Sk+1为新息方差,ψk+1为平滑有界层矩阵,Rk为量测噪声协方差阵;
后验状态估计方差方程、后验量测估计方程和后验量测误差变量方程分别为:
式中:Pk+1|k+1为后验状态估计方差,为后验量测估计。
6.根据权利要求1所述的基于渐消平滑变结构滤波的惯性导航初始对准方法,其特征在于,步骤3中渐消因子λk的计算公式为:
式中,max{·}表示取{·}中最大的值;trace代表矩阵的迹,为k+1时刻新息序列协方差阵的估计值,C0(k+1)为k+1时刻新息序列协方差阵。
7.根据权利要求6所述的基于渐消平滑变结构滤波的惯性导航初始对准方法,其特征在于,新息序列协方差阵的估计值具体为:
V0为k=0时刻新息序列向量;λk-1为k-1时刻渐消因子;Vk+1为k+1时刻新息序列向量,k+1时刻新息序列向量具体为Vk+1=zk+1-Hk+1xk+1|k。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910281718.5A CN109945895B (zh) | 2019-04-09 | 2019-04-09 | 基于渐消平滑变结构滤波的惯性导航初始对准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910281718.5A CN109945895B (zh) | 2019-04-09 | 2019-04-09 | 基于渐消平滑变结构滤波的惯性导航初始对准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109945895A true CN109945895A (zh) | 2019-06-28 |
CN109945895B CN109945895B (zh) | 2020-11-06 |
Family
ID=67012823
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910281718.5A Active CN109945895B (zh) | 2019-04-09 | 2019-04-09 | 基于渐消平滑变结构滤波的惯性导航初始对准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109945895B (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111795708A (zh) * | 2020-06-16 | 2020-10-20 | 湖南跨线桥航天科技有限公司 | 晃动基座条件下陆用惯性导航***的自适应初始对准方法 |
CN112230195A (zh) * | 2020-09-02 | 2021-01-15 | 清华大学 | 基于非线性最优平滑层策略的平滑变结构滤波方法及*** |
CN112393741A (zh) * | 2020-08-21 | 2021-02-23 | 扬州大学 | 基于有限时间滑模的sins/bds组合导航***空中对准方法 |
CN112683270A (zh) * | 2020-12-07 | 2021-04-20 | 中国矿业大学 | 一种基于平滑变结构滤波的gnss/sins/磁力计的组合方法 |
CN113137977A (zh) * | 2021-04-21 | 2021-07-20 | 扬州大学 | 一种sins/偏振光组合导航初始对准滤波方法 |
CN115451952A (zh) * | 2022-08-29 | 2022-12-09 | 南京航空航天大学 | 一种故障检测及抗差自适应滤波的多***组合导航方法和装置 |
CN112230195B (zh) * | 2020-09-02 | 2024-07-30 | 清华大学 | 基于非线性最优平滑层策略的平滑变结构滤波方法及*** |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101572533A (zh) * | 2009-06-18 | 2009-11-04 | 北京航空航天大学 | 一种复合分层抗干扰滤波器 |
CN103471616A (zh) * | 2013-09-04 | 2013-12-25 | 哈尔滨工程大学 | 一种动基座sins大方位失准角条件下初始对准方法 |
CN104655131A (zh) * | 2015-02-06 | 2015-05-27 | 东南大学 | 基于istssrckf的惯性导航初始对准方法 |
CN106840211A (zh) * | 2017-03-24 | 2017-06-13 | 东南大学 | 一种基于kf和stupf组合滤波的sins大方位失准角初始对准方法 |
US9772186B1 (en) * | 2010-05-28 | 2017-09-26 | Tanenhaus & Associates, Inc. | Miniaturized inertial measurement and navigation sensor device and associated methods |
CN107270892A (zh) * | 2017-05-22 | 2017-10-20 | 扬州大学 | 一种惯性导航***抗干扰容错初始对准方法 |
CN108195400A (zh) * | 2017-12-22 | 2018-06-22 | 清华大学 | 捷联式微机电惯性导航***的动基座对准方法 |
-
2019
- 2019-04-09 CN CN201910281718.5A patent/CN109945895B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101572533A (zh) * | 2009-06-18 | 2009-11-04 | 北京航空航天大学 | 一种复合分层抗干扰滤波器 |
US9772186B1 (en) * | 2010-05-28 | 2017-09-26 | Tanenhaus & Associates, Inc. | Miniaturized inertial measurement and navigation sensor device and associated methods |
CN103471616A (zh) * | 2013-09-04 | 2013-12-25 | 哈尔滨工程大学 | 一种动基座sins大方位失准角条件下初始对准方法 |
CN104655131A (zh) * | 2015-02-06 | 2015-05-27 | 东南大学 | 基于istssrckf的惯性导航初始对准方法 |
CN106840211A (zh) * | 2017-03-24 | 2017-06-13 | 东南大学 | 一种基于kf和stupf组合滤波的sins大方位失准角初始对准方法 |
CN107270892A (zh) * | 2017-05-22 | 2017-10-20 | 扬州大学 | 一种惯性导航***抗干扰容错初始对准方法 |
CN108195400A (zh) * | 2017-12-22 | 2018-06-22 | 清华大学 | 捷联式微机电惯性导航***的动基座对准方法 |
Non-Patent Citations (1)
Title |
---|
郭士荦等: "基于平滑算法的惯导***误差校正技术", 《***工程与电子技术》 * |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111795708A (zh) * | 2020-06-16 | 2020-10-20 | 湖南跨线桥航天科技有限公司 | 晃动基座条件下陆用惯性导航***的自适应初始对准方法 |
CN112393741A (zh) * | 2020-08-21 | 2021-02-23 | 扬州大学 | 基于有限时间滑模的sins/bds组合导航***空中对准方法 |
CN112230195A (zh) * | 2020-09-02 | 2021-01-15 | 清华大学 | 基于非线性最优平滑层策略的平滑变结构滤波方法及*** |
CN112230195B (zh) * | 2020-09-02 | 2024-07-30 | 清华大学 | 基于非线性最优平滑层策略的平滑变结构滤波方法及*** |
CN112683270A (zh) * | 2020-12-07 | 2021-04-20 | 中国矿业大学 | 一种基于平滑变结构滤波的gnss/sins/磁力计的组合方法 |
CN113137977A (zh) * | 2021-04-21 | 2021-07-20 | 扬州大学 | 一种sins/偏振光组合导航初始对准滤波方法 |
CN115451952A (zh) * | 2022-08-29 | 2022-12-09 | 南京航空航天大学 | 一种故障检测及抗差自适应滤波的多***组合导航方法和装置 |
CN115451952B (zh) * | 2022-08-29 | 2023-11-07 | 南京航空航天大学 | 一种故障检测及抗差自适应滤波的多***组合导航方法和装置 |
Also Published As
Publication number | Publication date |
---|---|
CN109945895B (zh) | 2020-11-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109945895A (zh) | 基于渐消平滑变结构滤波的惯性导航初始对准方法 | |
CN107314718B (zh) | 基于磁测滚转角速率信息的高速旋转弹姿态估计方法 | |
WO2020087845A1 (zh) | 基于gpr与改进的srckf的sins初始对准方法 | |
Wu et al. | Velocity/position integration formula part I: Application to in-flight coarse alignment | |
CN104344837B (zh) | 一种基于速度观测的冗余惯导***加速度计***级标定方法 | |
CN102706366B (zh) | 一种基于地球自转角速率约束的sins初始对准方法 | |
CN104655131B (zh) | 基于istssrckf的惯性导航初始对准方法 | |
CN103900565B (zh) | 一种基于差分gps的惯导***姿态获取方法 | |
CN103776446B (zh) | 一种基于双mems-imu的行人自主导航解算算法 | |
CN105091907B (zh) | Sins/dvl组合中dvl方位安装误差估计方法 | |
CN103344260B (zh) | 基于rbckf的捷联惯导***大方位失准角初始对准方法 | |
CN101949703A (zh) | 一种捷联惯性/卫星组合导航滤波方法 | |
CN103575299A (zh) | 利用外观测信息的双轴旋转惯导***对准及误差修正方法 | |
CN102937450B (zh) | 一种基于陀螺测量信息的相对姿态确定方法 | |
CN103822633A (zh) | 一种基于二阶量测更新的低成本姿态估计方法 | |
CN103674064B (zh) | 捷联惯性导航***的初始标定方法 | |
CN103557864A (zh) | Mems捷联惯导自适应sckf滤波的初始对准方法 | |
CN107015259A (zh) | 采用多普勒测速仪计算伪距/伪距率的紧组合方法 | |
CN106840211A (zh) | 一种基于kf和stupf组合滤波的sins大方位失准角初始对准方法 | |
Sun et al. | In-motion attitude and position alignment for odometer-aided SINS based on backtracking scheme | |
CN109959374A (zh) | 一种行人惯性导航全时全程逆向平滑滤波方法 | |
CN103697878A (zh) | 一种单陀螺单加速度计旋转调制寻北方法 | |
CN105988129A (zh) | 一种基于标量估计算法的ins/gnss组合导航方法 | |
CN105300407B (zh) | 一种用于单轴调制激光陀螺惯导***的海上动态启动方法 | |
CN103901459B (zh) | 一种mems/gps组合导航***中量测滞后的滤波方法 |
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 |