CN104019817A - 一种用于卫星姿态估计的范数约束强跟踪容积卡尔曼滤波方法 - Google Patents
一种用于卫星姿态估计的范数约束强跟踪容积卡尔曼滤波方法 Download PDFInfo
- Publication number
- CN104019817A CN104019817A CN201410234807.1A CN201410234807A CN104019817A CN 104019817 A CN104019817 A CN 104019817A CN 201410234807 A CN201410234807 A CN 201410234807A CN 104019817 A CN104019817 A CN 104019817A
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- msubsup
- mtd
- variance
- 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 32
- 238000005562 fading Methods 0.000 claims abstract description 19
- 238000005259 measurement Methods 0.000 claims description 41
- 238000001914 filtration Methods 0.000 claims description 32
- 239000011159 matrix material Substances 0.000 claims description 18
- 238000012546 transfer Methods 0.000 claims description 6
- 230000008030 elimination Effects 0.000 claims description 3
- 238000003379 elimination reaction Methods 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 3
- 230000000750 progressive effect Effects 0.000 claims description 2
- 238000004422 calculation algorithm Methods 0.000 description 29
- 238000004088 simulation Methods 0.000 description 6
- 230000009286 beneficial effect Effects 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 230000035772 mutation Effects 0.000 description 3
- 238000000354 decomposition reaction Methods 0.000 description 2
- 230000010354 integration Effects 0.000 description 2
- 239000000470 constituent Substances 0.000 description 1
- 230000002950 deficient Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
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/24—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for cosmonautical navigation
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Astronomy & Astrophysics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种用于卫星姿态估计的范数约束强跟踪容积卡尔曼滤波方法。包括以下几个步骤:采集陀螺与星敏感器的输出数据;确定卫星姿态估计***的状态变量和量测量;在k时刻进行标准的容积卡尔曼率波时间更新和量测更新,得到一步状态预测方差、一步量测预测方差及互协方差;利用多重次渐消因子对一步状态预测方差进行校正;重新进行容积卡尔曼滤波量测更新,求得k+1时刻的状态估计和状态估计方差;姿态估计非线性离散***的结束时刻为M,若k+1=M,则输出k+1时刻的状态估计的姿态四元数及陀螺漂移,完成姿态估计,若k+1<M,令k=k+1则重复步骤三至步骤五。本发明具有高估计精度和强鲁棒性的优点。
Description
技术领域
本发明属于卫星姿态估计的技术领域,特别涉及一种用于卫星姿态估计的范数约束强跟踪容积卡尔曼滤波方法。
背景技术
卫星姿态估计技术是航天技术的关键技术之一,由陀螺与星敏感器组成的卫星姿态估计***由于测姿精度高、可靠性好以及自主性强等优点得到了广泛的应用。针对该姿态估计***,四元数由于计算简单,无三角函数的运算,同时又能避免欧拉角的奇异性问题,因此被作为***的姿态描述参数。为提高姿态估计的精度以及姿态估计***的适应能力和鲁棒性,非线性滤波算法提供了强有力的基础保障。扩展卡尔曼滤波(Extended Kalman Filter,EKF)由于其结构简单、易于实现等优点被广泛应用于姿态估计中。但是,EKF存在理论上的局限性:1)模型线性化引入了截断误差,导致滤波精度下降,同时要计算雅克比矩阵,计算复杂;2)模型失配、未知干扰或状态突变等情况下,鲁棒性差;3)四元数作为状态变量存在范数约束,影响滤波精度。
为了克服EKF算法的局限性,无迹卡尔曼滤波算法(Unscented Kalman Filter,UKF)被提出,该滤波算法的核心思想是利用UT变换(Unscented Transformation,UT)产生一组确定性的Sigma点来近似非线性函数的后验均值和方差,精度能够达到二阶。随着非线性滤波算法的深入研究,在UKF算法的基础上,Ienkaran Arasaratnam和Simon Haykin在2009年提出了一种新的非线性滤波—容积卡尔曼滤波算法(Cubature Kalman filter,CKF)。CKF算法也是基于最优的高斯滤波框架,采用三阶球面相径容积规则来近似非线性函数的均值和方差,可以保证在理论上以三阶多项式逼近任何非线性高斯状态的后验均值和方差,相比较于UKF,具有实现简单,在高维情况下滤波精度高,收敛性好等优点。与EKF类似,CKF算法不足也在于在状态突变或模型不准确的情况下鲁棒性差,跟踪能力差,同时也没有考虑状态变量存在约束的情况。为了提高滤波算法在模型参数变化或***发生突变时的跟踪能力,一种强跟踪扩展卡尔曼滤波(Strong Tracking EKF)被提出。此后,有学者将强跟踪思想与CKF算法结合,提出了强跟踪CKF(STCKF)算法,但该算法只是通过引入单重次渐消因子对预测误差协方差阵进行调整,虽然具有好的跟踪能力,但是对复杂的多变量***,无法保证对每个变量都具有好的跟踪能力,同时也没有考虑状态变量存在约束的情况。
发明内容
本发明的目的是提供具有高估计精度和强鲁棒性的一种用于卫星姿态估计的范数约束强跟踪容积卡尔曼滤波方法。
本发明是通过以下技术方案实现的:
一种用于卫星姿态估计的范数约束强跟踪容积卡尔曼滤波方法,包括以下几个步骤:
步骤一:采集陀螺与星敏感器的输出数据;
步骤二:利用输出数据确定卫星姿态估计***的状态变量和量测量;
步骤三:在k时刻进行标准的容积卡尔曼率波时间更新和量测更新,得到一步状态预测方差、一步量测预测方差及互协方差;
步骤四:利用多重次渐消因子对一步状态预测方差进行校正;
步骤五:利用矫正后的一步状态预测方差,重新进行容积卡尔曼滤波量测更新,求得k+1时刻的状态估计和状态估计方差;
步骤六:姿态估计非线性离散***的结束时刻为M,若k+1=M,则输出k+1时刻的状态估计的姿态四元数及陀螺漂移,完成姿态估计,若k+1<M,令k=k+1则重复步骤三至步骤五。
本发明一种用于卫星姿态估计的范数约束强跟踪容积卡尔曼滤波方法还可以包括:
1、状态变量 qk为姿态四元数,βk为陀螺漂移,
建立卫星姿态估计***的状态方程:
其中: ω=[ω1 ω2 ω3]T,则 为k时刻陀螺的输出值,Δt为陀螺的采样周期, 其均值为 方差为 σv为陀螺的测量噪声,σu为陀螺漂移的测量噪声,和为k时刻四元数的估计值和方差;
将星敏感器的输出作为量测量:
式中,i为星敏感器观测到的恒星个数,为第i个量测量,为对应的参考矢量,为量测噪声,vk为零均值并且方差为的高斯白噪声,σs为星敏感器量测噪声,A(qk)为四元数描述的载体姿态矩阵,表示为:
式中,
3、2、得到一步状态预测方差、一步量测预测方差及互协方差的方法为:
步骤3.1:时间更新,求得一步状态预测方差;
由k时刻的状态估计和状态估计方差Pk|k,求取容积点为:
其中,n为状态变量的维数,是第i个容积点,其产生方式为:n维单位向量为e=[1 0 … 0]T,使用符号[1]表示对e的元素进行全排列和改变元素符号所产生的点集,称为完整全对称点集,[1]i表示点集中[1]的第i个点;
容积点经过状态方程的传递值为:
一步状态预测和一步状态预测方差为:
步骤3.2:量测更新,得到一步量测预测方差及互协方差;
由一步状态预测方差Pk+1|k,求取更新后的容积点:
其中,一步状态预测方差Pk+1|k分解可得:
容积点经过量测的传递值为:
一步量测预测一步量测预测方差Pzz,k+1|k及互协方差Pxz,k+1|k为:
3、多重次渐消因子满足以下方程:
其中,Λk+1=diag(λ1,k+1,λ2,k+1,…λn,k+1)为多重次渐消因子,Vk+1为残差输出序列的协方差阵,残差为ρ为遗忘因子,令
多重次渐消因子Λk+1中的元素为:
其中,Lii和Nii分别为矩阵Lk+1和Nk+1对角线上的元素,
利用多重次渐消因子,得到矫正后的一步状态预测方差:
4、求得k+1时刻的状态估计和状态估计方差的方法为:
步骤5.1:利用矫正后的一步状态预测方差进行量测更新;
更新后的一步量测预测、更新后的一步量测预测方差及更新后的互协方差为:
其中二次更新后的容积点为:
二次更新后的容积点经过量测的传递值为:
步骤5.2:求解满足四元数范数约束条件的滤波增益;
将更新后的互协方差 分为四元数部分和陀螺漂移部分满足四元数范数约束条件的滤波增益Kk+1为:
式中, 为一步状态预测估计值中的四元数部分;
步骤5.3:利用滤波增益,求得k+1时刻的状态估计和状态估计方差为:
5、陀螺测量噪声为σv=0.35°/h,陀螺漂移的两侧噪声为星敏感器测量噪声为σs=18″,初始陀螺漂移β=[1 1 1]T°/h,初始状态估计值为 初始方差阵设为P0|0=diag([(0.2°)2 (0.2°)2 (0.2°)2 (0.2°)2 (1.2°/h)2 (1.2°/h)2 (1.2°/h)2]。
本发明的有益效果为:
(1)本发明采用容积数值积分理论近似非线性函数的均值与方差,不需要对非线性函数进行线性化,避免了雅克比矩阵的计算,有利于提高估计精度;
(2)本发明用多重次渐消因子代替单一的渐消因子,不仅使得各个滤波通道具有不同的调节能力,同时也能保证预测误差协方差阵的对称性,使得滤波器具有在***发生突变情况下的鲁棒性,提高了姿态估计***的跟踪能力。
(3)本发明利用四元数范数约束条件,在最小均方误差意义下对滤波增益进行校正,保证了状态估计中的四元数成分满是范数约束条件,有利于提高姿态估计的精度。
附图说明
图1是本发明的方法流程图。
图2是现有的MEKF算法的一次独立实验姿态误差和陀螺漂移误差结果图;
图3是现有的STCKF算法的一次独立实验姿态误差和陀螺漂移误差结果图;
图4是本发明的NSTCKF算法的一次独立实验姿态误差和陀螺漂移误差结果图;
图5是本发明的NSTCKF算法与MEKF,STCKF算法的姿态角均方根误差结果对比图;
图6是本发明的NSTCKF算法与MEKF,STCKF算法的陀螺漂移均方根误差结果对比图。
具体实施方式
下面结合附图对本发明做进一步详细说明。
本发明提出了一种用于卫星姿态估计的范数约束强跟踪容积卡尔曼滤波方法(Norm-constrained Strong Tracking Cubature Kalman Filter,NSTCKF)。本发明采用容积数值积分理论近似非线性函数的均值与方差,并通过引入两个多重次渐消因子对预测误差协方差阵进行调整,使得不同的滤波通道具有不同的调节能力,保证预测误差协方差阵的对称性,从而实现滤波算法强跟踪性,同时根据四元数范数约束条件,设计最小均方误差意义下的最优滤波增益。
本发明是一种用于卫星姿态估计的范数约束强跟踪容积卡尔曼滤波方法,流程如图1所示,包括以下几个步骤:
步骤一:采集陀螺与星敏感器的输出数据,并将其作为量测量;
步骤二:建立卫星姿态估计***的状态空间模型;
将姿态四元数qk和陀螺漂移βk组成状态变量 建立基于四元数的卫星姿态估计***离散状态方程:
式中: 若ω=[ω1 ω2 ω3]T,则 为k时刻陀螺的输出值;Δt为陀螺的采样周期; 其均值为 方差为 σv为陀螺的测量噪声;σu为陀螺漂移的测量噪声;和为k时刻四元数的估计值和方差;
假设星敏感器观测到多颗恒星,以星敏感器的输出作为量测量,卫星姿态估计***的离散量测方程为:
式中,i为星敏感器观测到的恒星个数;为第i个测量矢量;为对应的参考矢量;为量测噪声;vk为零均值,方差为的高斯白噪声;σs为星敏感器量测噪声;A(qk)为四元数描述的载体姿态矩阵,可表示为:
式中,
由式(1)和(2)就构成了卫星姿态估计***的状态空间模型;
步骤三:针对上述状态空间模型,在已知k时刻的状态估计和估计方差情况下,利用标准的容积卡尔曼滤波进行时间更新和量测更新,得到未引入渐消因子前的一步状态预测方差、量测预测方差以及互协方差;
步骤3.1时间更新;
已知k时刻状态估计为和估计方差为Pk|k,求取容积点为:
式中,n为状态变量的维数;是第i个容积点,其产生方式为:设n维单位向量为e=[1 0 … 0]T,使用符号[1]表示对e的元素进行全排列和改变元素符号所产生的点集,称为完整全对称点集,[1]i表示点集中[1]的第i个点;
容积点经过状态非线性函数传递为:
一步状态预测的估计与估计方差为:
步骤3.2量测更新;
将状态预测估计方差Pk+1|k,进行Cholesky分解可得:相应的容积点可以求取为:
容积点经过量测非线性函数传递得:
量测一步预测、预测方差及互协方差为:
步骤四:引入多重次渐消因子对上述一步状态预测方差进行校正;
步骤4.1多重次渐消因子的求取;
利用式(7)和式(12)所示的一步状态预测方差和互协方差,求得:
由强跟踪理论可以得出:
式中,Λk+1=diag(λ1,k+1,λ2,k+1,…λn,k+1)为多重次渐消因子;Vk+1为残差输出序列的协方差阵,令残差为ρ为遗忘因子,通常设为ρ=0.95,则有:
根据式(13)-(15),令 多重次渐消因子Λk+1中的元素为:
式中,Lii和Nii分别为矩阵Lk+1和Nk+1对角线上的元素;
步骤4.1一步状态预测方差的校正;
利用上述求得的多重次渐消因子,对一步状态预测方差进行校正:
步骤五:利用上述校正的状态预测方差,重新进行容积卡尔曼滤波量测更新,然后在最小均方误差意义下利用四元数范数约束条件求得滤波增益,最后得到已知k+1时刻的状态估计值和方差;
步骤5.1利用进行量测更新;
将修正的状态预测估计方差进行Cholesky分解可得:相应的容积点可以求取为:
容积点经过量测非线性函数传递得:
量测一步预测、预测方差及互协方差为:
步骤5.2四元数范数约束条件滤波增益的求解;
将互协方差 分为四元数部分和陀螺漂移部分则满足四元数范数约束条件且使得估计方差最小的滤波增益Kk+1为:
式中, 为一步状态预测估计值中的四元数部分;
步骤5.3k+1时刻的状态估计值和方差的求取;
利用上述滤波增益,求取k+1时刻的状态估计值和方差为:
步骤六:姿态估计非线性离散***的运行时间为M,若k=M,则输出姿态四元数及陀螺漂移的结果,完成姿态估计;若k<M,表示滤波过程未完成,则重复步骤三至步骤五,直至姿态估计***运行结束。
本发明提出的一种用于卫星姿态估计的范数约束强跟踪容积卡尔曼滤波方法是通过Matlab仿真软件进行仿真实验,与现有滤波算法的估计性能进行比较,如乘性扩展卡尔曼滤波(Multiplicative Extended Kalman Filter,MEKF)以及单渐消因子的强跟踪容积卡尔曼滤波(STCKF)。仿真硬件环境均为Intel (R) Core (TM) i5-2410M CPU2.30GHz,4G RAM,Windows7操作***。如图2到图4所示,在200秒时引入状态突变量,MEKF算法估计的不论是姿态角误差还是陀螺漂移误差的精度都急剧下降,而STCKF算法估计的姿态角误差不受状态突变量的影响,但是陀螺漂移误差的精度急剧下降,相比较于MEKF算法,其收敛速度较快。本文提出的NSTCKF算法估计的姿态角误差和陀螺漂移误差都不受状态突变量的影响,具有很好的鲁棒性和稳定性。从图5到图6所示的均方根误差比较,NSTCKF算法不论是姿态角误差估计还是陀螺漂移误差估计都比MEKF和STCKF算法,具有更高的稳态估计精度。
MATLAB仿真实验,在以下的仿真条件下,对该方法进行仿真实验:
陀螺测量噪声标准差为σv=0.35°/h,陀螺漂移噪声标准差为输出频率为100Hz;星敏感器测量噪声标准差为σs=18″,输出频率为1Hz;初始陀螺漂移β=[1 1 1]T°/h;仿真时间400s,在200s处引入状态突变;初始状态估计为 初始方差阵为P0|0=diag([(0.2°)2 (0.2°)2 (0.2°)2 (0.2°)2 (1.2°/h)2 (1.2°/h)2 (1.2°/h)2]。
Claims (6)
1.一种用于卫星姿态估计的范数约束强跟踪容积卡尔曼滤波方法,其特征在于,包括以下几个步骤:
步骤一:采集陀螺与星敏感器的输出数据;
步骤二:利用输出数据确定卫星姿态估计***的状态变量和量测量;
步骤三:在k时刻进行标准的容积卡尔曼率波时间更新和量测更新,得到一步状态预测方差、一步量测预测方差及互协方差;
步骤四:利用多重次渐消因子对一步状态预测方差进行校正;
步骤五:利用矫正后的一步状态预测方差,重新进行容积卡尔曼滤波量测更新,求得k+1时刻的状态估计和状态估计方差;
步骤六:姿态估计非线性离散***的结束时刻为M,若k+1=M,则输出k+1时刻的状态估计的姿态四元数及陀螺漂移,完成姿态估计,若k+1<M,令k=k+1则重复步骤三至步骤五。
2.根据权利要求1所述的一种用于卫星姿态估计的范数约束强跟踪容积卡尔曼滤波方法,其特征在于:所述的状态变量qk为姿态四元数,βk为陀螺漂移,
建立卫星姿态估计***的状态方程:
其中:ω=[ω1 ω2 ω3]T,则 为k时刻陀螺的输出值,Δt为陀螺的采样周期,其均值为,方差为 σv为陀螺的测量噪声,σu为陀螺漂移的测量噪声,和为k时刻四元数的估计值和方差;
将星敏感器的输出作为量测量:
式中,i为星敏感器观测到的恒星个数,为第i个量测量,为对应的参考矢量,为量测噪声,vk为零均值并且方差为的高斯白噪声,σs为星敏感器量测噪声,A(qk)为四元数描述的载体姿态矩阵,表示为:
式中, 。
3.根据权利要求2所述的一种用于卫星姿态估计的范数约束强跟踪容积卡尔曼滤波方法,其特征在于:所述的得到一步状态预测方差、一步量测预测方差及互协方差的方法为:
步骤3.1:时间更新,求得一步状态预测方差;
由k时刻的状态估计和状态估计方差Pk|k,求取容积点为:
其中,n为状态变量的维数,是第i个容积点,其产生方式为:n维单位向量为e=[1 0 … 0]T,使用符号[1]表示对e的元素进行全排列和改变元素符号所产生的点集,称为完整全对称点集,[1]i表示点集中[1]的第i个点;
容积点经过状态方程的传递值为:
一步状态预测和一步状态预测方差为:
步骤3.2:量测更新,得到一步量测预测方差及互协方差;
由一步状态预测方差Pk+1|k,求取更新后的容积点:
其中,一步状态预测方差Pk+1|k分解可得:
容积点经过量测的传递值为:
一步量测预测一步量测预测方差Pzz,k+1|k及互协方差Pxz,k+1|k为:
。
4.根据权利要求3所述的一种用于卫星姿态估计的范数约束强跟踪容积卡尔曼滤波方法,其特征在于:所述的多重次渐消因子满足以下方程:
其中,Λk+1=diag(λ1,k+1,λ2,k+1,…λn,k+1)为多重次渐消因子,Vk+1为残差输出序列的协方差阵,残差为ρ为遗忘因子,令
多重次渐消因子Λk+1中的元素为:
其中,Lii和Nii分别为矩阵Lk+1和Nk+1对角线上的元素,
利用多重次渐消因子,得到矫正后的一步状态预测方差:
。
5.根据权利要求4所述的一种用于卫星姿态估计的范数约束强跟踪容积卡尔曼滤波方法,其特征在于:所述的求得k+1时刻的状态估计和状态估计方差的方法为:
步骤5.1:利用矫正后的一步状态预测方差进行量测更新;
更新后的一步量测预测、更新后的一步量测预测方差及更新后的互协方差为:
其中二次更新后的容积点为:
二次更新后的容积点经过量测的传递值为:
步骤5.2:求解满足四元数范数约束条件的滤波增益;
将更新后的互协方差分为四元数部分和陀螺漂移部分满足四元数范数约束条件的滤波增益Kk+1为:
式中,为一步状态预测估计值中的四元数部分;
步骤5.3:利用滤波增益,求得k+1时刻的状态估计和状态估计方差为:
。
6.根据权利要求5所述的一种用于卫星姿态估计的范数约束强跟踪容积卡尔曼滤波方法,其特征在于:所述的陀螺测量噪声为σv=0.35°/h,陀螺漂移的两侧噪声为星敏感器测量噪声为σs=18″,初始陀螺漂移β=[1 1 1]T°/h,初始状态估计值为 初始方差阵设为P0|0=diag([(0.2°)2 (0.2°)2 (0.2°)2 (0.2°)2 (1.2°/h)2 (1.2°/h)2 (1.2°/h)2]。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410234807.1A CN104019817B (zh) | 2014-05-30 | 2014-05-30 | 一种用于卫星姿态估计的范数约束强跟踪容积卡尔曼滤波方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410234807.1A CN104019817B (zh) | 2014-05-30 | 2014-05-30 | 一种用于卫星姿态估计的范数约束强跟踪容积卡尔曼滤波方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104019817A true CN104019817A (zh) | 2014-09-03 |
CN104019817B CN104019817B (zh) | 2017-01-04 |
Family
ID=51436699
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410234807.1A Expired - Fee Related CN104019817B (zh) | 2014-05-30 | 2014-05-30 | 一种用于卫星姿态估计的范数约束强跟踪容积卡尔曼滤波方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104019817B (zh) |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105737828A (zh) * | 2016-05-09 | 2016-07-06 | 郑州航空工业管理学院 | 一种基于强跟踪的相关熵扩展卡尔曼滤波的组合导航方法 |
CN105973238A (zh) * | 2016-05-09 | 2016-09-28 | 郑州轻工业学院 | 一种基于范数约束容积卡尔曼滤波的飞行器姿态估计方法 |
CN106767837A (zh) * | 2017-02-23 | 2017-05-31 | 哈尔滨工业大学 | 基于容积四元数估计的航天器姿态估计方法 |
CN108536171A (zh) * | 2018-03-21 | 2018-09-14 | 电子科技大学 | 一种多约束下多无人机协同跟踪的路径规划方法 |
CN109000642A (zh) * | 2018-05-25 | 2018-12-14 | 哈尔滨工程大学 | 一种改进的强跟踪容积卡尔曼滤波组合导航方法 |
CN110109470A (zh) * | 2019-04-09 | 2019-08-09 | 西安电子科技大学 | 基于无迹卡尔曼滤波的联合定姿方法、卫星姿态控制*** |
CN110490273A (zh) * | 2019-09-12 | 2019-11-22 | 河南牧业经济学院 | 噪声方差不精确建模的多传感器***融合滤波算法 |
CN111045040A (zh) * | 2019-12-09 | 2020-04-21 | 北京时代民芯科技有限公司 | 一种适用于动态弱信号的卫星导航信号跟踪***及方法 |
CN111207776A (zh) * | 2020-02-25 | 2020-05-29 | 上海航天控制技术研究所 | 一种适用于火星探测的星敏感器与陀螺联合标定方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0383114B1 (en) * | 1989-02-13 | 1994-08-31 | Hughes Aircraft Company | Measurement and control system for scanning sensors |
CN1987355A (zh) * | 2006-12-22 | 2007-06-27 | 北京航空航天大学 | 一种基于自适应扩展卡尔曼滤波的地球卫星自主天文导航方法 |
CN102506877A (zh) * | 2011-12-08 | 2012-06-20 | 北京控制工程研究所 | 一种对初始误差具有抗扰性的深空探测导航***滤波方法 |
CN102654406A (zh) * | 2012-04-11 | 2012-09-05 | 哈尔滨工程大学 | 基于非线性预测滤波与求容积卡尔曼滤波相结合的动基座初始对准方法 |
CN103090870A (zh) * | 2013-01-21 | 2013-05-08 | 西北工业大学 | 一种基于mems传感器的航天器姿态测量方法 |
-
2014
- 2014-05-30 CN CN201410234807.1A patent/CN104019817B/zh not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0383114B1 (en) * | 1989-02-13 | 1994-08-31 | Hughes Aircraft Company | Measurement and control system for scanning sensors |
CN1987355A (zh) * | 2006-12-22 | 2007-06-27 | 北京航空航天大学 | 一种基于自适应扩展卡尔曼滤波的地球卫星自主天文导航方法 |
CN102506877A (zh) * | 2011-12-08 | 2012-06-20 | 北京控制工程研究所 | 一种对初始误差具有抗扰性的深空探测导航***滤波方法 |
CN102654406A (zh) * | 2012-04-11 | 2012-09-05 | 哈尔滨工程大学 | 基于非线性预测滤波与求容积卡尔曼滤波相结合的动基座初始对准方法 |
CN103090870A (zh) * | 2013-01-21 | 2013-05-08 | 西北工业大学 | 一种基于mems传感器的航天器姿态测量方法 |
Non-Patent Citations (4)
Title |
---|
JONGHEE BAE ET AL: "Nonlinear Estimation for Spacecraft Attitude using Decentralized Unscented Information Filter", 《INTERNATIONAL CONFERENCE ON CONTROL, AUTOMATION AND SYSTEMS 2010》 * |
王宏健: "基于强跟踪CKF的无人水下航行器SLAM", 《仪器仪表学报》 * |
钱华明: "基于四元数平方根容积卡尔曼滤波的姿态估计", 《北京航空航天大学学报》 * |
魏喜庆: "基于容积卡尔曼滤波的卫星姿态估计", 《宇航学报》 * |
Cited By (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105973238A (zh) * | 2016-05-09 | 2016-09-28 | 郑州轻工业学院 | 一种基于范数约束容积卡尔曼滤波的飞行器姿态估计方法 |
CN105737828B (zh) * | 2016-05-09 | 2018-07-31 | 郑州航空工业管理学院 | 一种基于强跟踪的相关熵扩展卡尔曼滤波的组合导航方法 |
CN105737828A (zh) * | 2016-05-09 | 2016-07-06 | 郑州航空工业管理学院 | 一种基于强跟踪的相关熵扩展卡尔曼滤波的组合导航方法 |
CN106767837A (zh) * | 2017-02-23 | 2017-05-31 | 哈尔滨工业大学 | 基于容积四元数估计的航天器姿态估计方法 |
CN106767837B (zh) * | 2017-02-23 | 2019-10-22 | 哈尔滨工业大学 | 基于容积四元数估计的航天器姿态估计方法 |
CN108536171B (zh) * | 2018-03-21 | 2020-12-29 | 电子科技大学 | 一种多约束下多无人机协同跟踪的路径规划方法 |
CN108536171A (zh) * | 2018-03-21 | 2018-09-14 | 电子科技大学 | 一种多约束下多无人机协同跟踪的路径规划方法 |
CN109000642A (zh) * | 2018-05-25 | 2018-12-14 | 哈尔滨工程大学 | 一种改进的强跟踪容积卡尔曼滤波组合导航方法 |
CN110109470A (zh) * | 2019-04-09 | 2019-08-09 | 西安电子科技大学 | 基于无迹卡尔曼滤波的联合定姿方法、卫星姿态控制*** |
CN110109470B (zh) * | 2019-04-09 | 2021-10-29 | 西安电子科技大学 | 基于无迹卡尔曼滤波的联合定姿方法、卫星姿态控制*** |
CN110490273A (zh) * | 2019-09-12 | 2019-11-22 | 河南牧业经济学院 | 噪声方差不精确建模的多传感器***融合滤波算法 |
CN111045040A (zh) * | 2019-12-09 | 2020-04-21 | 北京时代民芯科技有限公司 | 一种适用于动态弱信号的卫星导航信号跟踪***及方法 |
CN111207776A (zh) * | 2020-02-25 | 2020-05-29 | 上海航天控制技术研究所 | 一种适用于火星探测的星敏感器与陀螺联合标定方法 |
Also Published As
Publication number | Publication date |
---|---|
CN104019817B (zh) | 2017-01-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104019817B (zh) | 一种用于卫星姿态估计的范数约束强跟踪容积卡尔曼滤波方法 | |
CN105300384B (zh) | 一种用于卫星姿态确定的交互式滤波方法 | |
CN108225337B (zh) | 基于sr-ukf滤波的星敏感器和陀螺组合定姿方法 | |
CN104020480B (zh) | 一种带自适应因子的交互式多模型ukf的卫星导航方法 | |
CN103940433B (zh) | 一种基于改进的自适应平方根ukf算法的卫星姿态确定方法 | |
CN106767780B (zh) | 基于Chebyshev多项式插值逼近的扩展椭球集员滤波方法 | |
CN110109470A (zh) | 基于无迹卡尔曼滤波的联合定姿方法、卫星姿态控制*** | |
CN103900574A (zh) | 一种基于迭代容积卡尔曼滤波姿态估计方法 | |
CN105973238A (zh) | 一种基于范数约束容积卡尔曼滤波的飞行器姿态估计方法 | |
CN110275193A (zh) | 一种基于因子图的集群卫星协同导航方法 | |
CN103776449B (zh) | 一种提高鲁棒性的动基座初始对准方法 | |
Qiu et al. | Adaptive robust nonlinear filtering for spacecraft attitude estimation based on additive quaternion | |
CN110567455A (zh) | 一种求积更新容积卡尔曼滤波的紧组合导航方法 | |
Kulikov et al. | Accurate state estimation in the Van der Vusse reaction | |
CN108762072A (zh) | 基于核范数子空间法和增广向量法的预测控制方法 | |
CN113587926A (zh) | 一种航天器空间自主交会对接相对导航方法 | |
CN104035110A (zh) | 应用于多模卫星导航***中的快速卡尔曼滤波定位方法 | |
US20240175685A1 (en) | Weight and reference quaternoin correction unscented quaternoin estimation method | |
Qiu et al. | Stochastic stable attitude estimation algorithm using UKF with measurement loss | |
CN108181617A (zh) | 一种基于张量积模型变换的非线性调频***的滤波方法 | |
Scholte et al. | Online nonlinear guaranteed estimation with application to a high performance aircraft | |
CN103106332A (zh) | 一种测量不确定度的分析方法 | |
Gumussoy et al. | Root locus for SISO dead-time systems: A continuation based approach | |
CN113011475A (zh) | 考虑相关噪声和随机参数矩阵的分布式融合算法 | |
Qian et al. | MASGQF with application to SINS alignment |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20170104 |