Student’s t滤波框架下的信息融合算法
Information fusion algorithm with Student’s t filtering framework
通讯作者:
收稿日期: 2019-04-17
Received: 2019-04-17
作者简介 About authors
吴骁航(1990—),男,博士生,从事导航、非线性滤波、数据融合研究.orcid.org/0000-0002-0291-9155.E-mail:
针对多传感器系统的观测噪声为非高斯噪声的问题,通过Student’s t滤波框架和四元数特性相结合,以无迹变换计算Student’s t加权积分函数,设计基于Student’s t分布的无迹四元数滤波算法,作为局部滤波算法. 利用拉格朗日乘子法计算最优融合权重系数,通过线性加权融合的方式,对各局部滤波结果进行融合. 采用基于四元数的目标姿态运动模型进行仿真,利用3个星敏感器同时对同一目标进行观测,通过与已有的鲁棒无迹Student’s t滤波(RSTUF)算法对比,验证所提算法的有效性. 仿真结果表明:所提算法在对目标姿态的估计精度、滤波收敛速度及收敛后的数值稳定性方面均高于RSTUF算法;通过多个观测信息互补,提高了估计精度及容错性.
关键词:
Considering the problem of non-Gaussian measurement noises in multi-sensor system, an unscented quaternion filtering algorithm was designed based on Student's t distribution as a local filtering algorithm, by combining the Student’s t filtering framework with the characteristics of quaternion and calculating the Student’s t weighted integral function by unscented transformation. The optimal fusion weight coefficients were calculated by Lagrange multiplier method, and the local filtering results were fused by linear weighted fusion method. Quaternion was applied for simulation of the target attitude motion model. Three star sensors were used to observe the same target at the same time. The effectiveness of the proposed algorithm was verified through the comparison with the existing robust unscented Student's t filtering (RSTUF) algorithm. The simulation results show that the proposed distributed information fusion algorithm based on Student’s t filtering framework has higher estimation accuracy, convergence speed and numerical stability than RSTUF algorithm, which improves the estimation accuracy and fault tolerance of the algorithm by the complementarity of multi-observation information.
Keywords:
本文引用格式
吴骁航, 马克茂.
WU Xiao-hang, MA Ke-mao.
在实际导航系统中,单个传感器可能会出现故障或零位漂移等特性导致无法正常工作. 例如,GPS因受遮挡等影响无法接收定位信号[1-2],惯性导航传感器由于物理上的限制而存在漂移误差[3],视觉传感器由于特征点被遮挡无法观测等. 因此,为了保证导航系统的正常运行,需要利用2种或2种以上的观测方式,构成多传感器组合导航系统. Bian等[4]提出了一种INS/GPS自适应组合导航系统,利用GPS作为惯性导航系统(inertial navigation system,INS)的辅助观测系统,同时设计自适应卡尔曼滤波(adaptive Kalman filte,AKF),用于解决GPS时变的观测噪声. Gao等[5]使用GPS和激光雷达(LiDAR)对INS进行周期性修正,设计了基于INS/GPS/LiDAR的组合导航系统. Li等[6]为了保证火星探测器实现精确和安全的火星着陆,设计了基于微型相干高度计、测速仪(miniature coherent altimeter velocimeter,MCAV)和INS的组合导航系统,该系统通过MCAV对惯性偏差和漂移进行校正,提高了组合导航的性能.
组合导航系统中由于观测数据数量大,存在冗余现象,需要设计相应的信息融合算法对所有观测数据进行融合以获得最优状态估计值. 根据对多传感器观测信息的处理方法不同,可以将信息融合系统的体系结构分成2种,分别是集中式融合结构、分布式融合结构和混合式融合结构. 集中式融合算法是将所有观测信息整合,然后将其共同作为观测输入量,用于进行状态的量测更新. 该方法已经比较成熟,也有较多研究成果[7-9]. 集中式融合算法具有估计精度高的特点,但是随着观测量的增加,观测矩阵维度增大,会带来巨大的计算负担,因此,近些年,分布式融合算法得到了学者们的广泛关注. 分布式融合算法对每个传感的观测信息进行单独处理,然后将处理后的结果通过适当的方法融合. 常用的融合方式有线性加权融合[10-11]、协方差交互融合[12-13]等,混合式融合算法是将集中式融合和分布式融合相结合的方法, 可以继承前2种融合算法的优势,但计算负担大,实时性低.
在航天任务(例如:轨道的确定和自主导航任务)中,通常存在非高斯噪声[14]. Student’s t分布噪声作为非高斯噪声的一种特殊形式,由于其属于广义高斯分布,更适合于模拟非高斯噪声[15]. 针对Student’s t分布噪声,Huang等[16]提出了一个基于Student’s t的滤波框架. 与高斯滤波(Gaussian filter,GF)框架类似,Student’s t的滤波框架需要计算Student’s t的加权积分函数. 因此,Huang等[17-18]又提出了采用不同算法计算加权积分的多种滤波算法. 此外,Roth等[19]针对过程噪声和观测噪声均是Student’s t分布的问题,提出了基于Student’s t的鲁棒滤波器.
综上所述,在导航任务中,如果传感器的观测噪声为非高斯噪声,则需要导航系统中的信息融合算法对噪声具有一定的鲁棒性. 本文考虑系统噪声为Student’s t分布的特殊情况,以已有的Student’s t的滤波框架为基础,利用线型加权融合的方法,设计对Student’s t分布噪声具有鲁棒性的多传感器信息融合算法,以提高组合导航系统的导航精度和对特殊情况的适应能力.本文基于组合导航系统的运动模型和观测模型,选取观测噪声为满足Student’s t分布的噪声,设计基于Student’s t分布的无迹四元数局部滤波算法;设计最优权重计算方法及线型加权信息融合算法;利用仿真分析验证所设计算法的有效性和鲁棒性.
1. 问题描述
考虑航天器运动系统存在Student’s t分布噪声的情况,采用四元数描述的航天器运动学模型如下:
式中:
其中,
四元数乘法
本节所研究的系统为含有Student’s t分布噪声的惯导和多个星敏感器组合导航系统,导航系统框图具体如图1所示.
图 1
图 1 星敏感器/惯性测量单元(IMU)组合导航系统框架图
Fig.1 Frame diagram of star sensor/inertial measurement unit(IMU)integrated navigation system
假设陀螺安装在航天器上,且安装方向与航天器本体坐标系重合,则陀螺的输出模型表示如下:
式中:
其中,
如果星敏感器的安装方向与航天器本体坐标系完全重合,则星光矢量在体系下的观测方程为
式中:
其中,
在
式中:
假设1 系统的初始状态
2. 基于Student’s t分布的无迹四元数滤波
2.1. 基于Student’s t分布的滤波框架
针对系统中存在Student’s t分布噪声的情况,文献[16]中提出基于Student’s t分布的滤波框架. 为方便设计,提出以下2个假设.
假设2 系统状态和观测的联合预测PDF满足Student’s t分布,即
假设3 当前状态和一步预测状态向量的联合PDF满足Student’s t分布,即
基于假设2和3设计滤波算法如下.
1)系统状态一步预测及相关协方差计算.
式中:
2)系统状态的量测更新值及协方差计算.
式中:
2.2. 基于Student’s t分布的无迹四元数滤波
假设初始量
式中:
1)系统状态一步预测及相关协方差计算.
由于EMRP在描述姿态时,容易产生奇异问题,通过式(25)将EMRPs转化为误差四元数
由
通过式(5)对Sigma点传播,可得
由
通过式(29)将误差四元数转换为EMRPs,则系统一步预测值及协方差如下:
则一步预测状态为
2)系统状态的量测更新值及协方差计算.
以第
式中:
根据一步预测状态
然后,由Student’s t滤波框架计算观测协方差
式中:
最后,计算滤波增益矩阵
式中:
由式(38)求得
3. 分布式信息融合算法
当多个星敏感器对同一目标进行测量时,会获得多个观测值
信息融合后估计结果可表示为
式中:
其中,
为保证融合结果的无偏性,则权重因子应满足:
由式(41)可得
由于当
则将
需要在式(44)为限制条件下,获得使
令
式(49)等式两侧同乘
令
将式(51)代入式(49)可得
定义变量如下:
则式(52)可改写为
最后,将式(54)代入式(41)可得融合状态估计值如下:
将式(54)代入式(46)可得估计误差协方差矩阵如下:
4. 仿真验证
目标星轨道高度为350 km,轨道角速率为0.065 6 deg/s. 假设航天器的体坐标系和轨道坐标系是完全重合的. 陀螺输出的随机漂移标准差
图 2
图 2 容积四元数分布式融合(CQDF)滤波角度估计误差曲线
Fig.2 Curve for angle estimated error of cubature quaternion distribution fusion(CQDF)
图 3
图 3 鲁棒无迹Student’s t滤波角度估计误差曲线
Fig.3 Curve for angle estimated error of robust Student’s t unscented filter(RSTUF)
图 4
图 4 Student’s t滤波框架下的无迹四元数分布式融合滤波角度估计误差曲线
Fig.4 Angle estimated error of Student’s t unscented quaternion distribution fusion(STUDF)
图 5
图 6
图 7
图 7 Student’s t滤波框架下的无迹四元数分布式融合滤波漂移估计误差曲线
Fig.7 Curve for bias estimated error of STUDF
图 8
图 9
从图2~7可以看出,由于受到非高斯噪声的影响,高斯滤波算法的假设条件无法得到满足,CQDF的估计误差最大,角度估计误差都无法收敛到−0.02 ~0.02. RSTUF由于对Student’s t分布噪声具有一定的鲁棒性,角度估计误差可以收敛到−2×10−3~2×10−3,但是波动较大. 这是由于单个滤波器可能因为某时刻观测误差较大的影响导致估计精度下降. STUDF算法的估计误差远小于RSTUF算法,并且曲线波动小.证明所设计算法对Student’s t分布噪声具有鲁棒性. 由于采用多传感器测量时,不同的传感器估计精度不同,多个传感器信息融合滤波,可以通过高精度估计结果弥补观测误差大造成的低精度估计结果,证明了多传感器融合具有互补性.
从图8和9可以看出,CQDF由于受到非高斯噪声的影响,角度误差2范数无法收敛到10−2以下. 其他2种算法的误差2范数可以达到10−4 ~10−2,但是STUDF算法的估计误差范数小于RSTUF算法,且收敛速度更快.证明所设计融合算法对Student’s t分布噪声具有鲁棒性,且多传感器融合可以提高系统容错性,保证估计结果稳定,不易产生较大波动. 另外,单个RSTUF的平均仿真运行时间为0.149 8 s,而所设计的融合算法STUDF的平均仿真运行时间为0.204 9 s. 融合算法耗时增加了25%,并未增加过多的计算时间,这也是分布式融合算法的优势,保证了所设计算法在组合导航系统中的实时性.
5. 结 语
本文考虑多传感器组合导航系统存在观测噪声为Student’s t分布的情况,设计了Student’s t滤波框架下的无迹四元数融合滤波算法. 为验证所设计算法的性能,以目标的四元数姿态模型为仿真模型,将所设计融合滤波算法同已有的RSTUF及CQDF算法进行滤波性能对比. 仿真结果表明,当噪声为Student’s t分布时,传统的高斯滤波算法,即CQDF算法已无法正常运行,甚至存在滤波结果发散的情况. 单个滤波器RSTUF虽然对非高斯噪声具有鲁棒性,但仍存在由于单个传感器噪声偏大而导致的结果波动大,收敛速度慢的问题. 所设计的STUDF即对Student’s t分布噪声具有鲁棒性,可以精确估计导航系统的目标姿态信息,并利用多传感器信息融合技术的互补性和容错性,减小了估计结果的波动,并且提高了收敛速度. 仿真时间对比结果证明,所设计融合算法并未增加过多计算量,保证了导航系统的实时性. 本文假设多传感器为同步观测的理想情况,但实际的多传感器组合导航系统中还存在传感器观测频率不一致的问题,因此需要在后续研究中提出相应的解决方案.
参考文献
A derivative UKF for tightly coupled INS/GPS integrated navigation
[J].DOI:10.1016/j.isatra.2014.10.006 [本文引用: 1]
Multi-sensor optimal data fusion for INS/GPS/SAR integrated navigation system
[J].
Iae-Adaptive Kalman filter for INS/GPS integrated navigation system
[J].DOI:10.1016/S1004-4132(06)60086-8 [本文引用: 1]
INS/GPS/LiDAR integrated navigation system for urban and indoor environments using hybrid scan matching algorithm
[J].DOI:10.3390/s150923286 [本文引用: 1]
MCAV/IMU integrated navigation for the powered descent phase of mars EDL
[J].DOI:10.1016/j.asr.2010.04.028 [本文引用: 1]
Centralized fusion algorithms based on EKF for multisensor non-linear systems
[J].
Multi-sensor centralized fusion tracking with correlated measurement noises
[J].
Centralized fusion approach to the estimation problem with multi-packet processing under uncertainty in outputs and transmissions
[J].DOI:10.1109/JSEN.2018.2805427 [本文引用: 1]
Multi-sensor distributed fusion filtering for networked systems with different delay and loss rates
[J].
Distributed fusion filter for multi-sensor systems with finite-step correlated noises
[J].
Distributed fusion with multi-bernoulli filter based on generalized covariance intersection
[J].
Control-theoretical and topological analysis of covariance intersection based distributed Kalman filter
[J].DOI:10.1109/LCSYS.2018.2844734 [本文引用: 1]
Robust information filter based on maximum correntropy criterion
[J].
Robust Student's t based stochastic cubature filter for nonlinear systems with heavy-Tailed process and measurement noises
[J].DOI:10.1109/ACCESS.2017.2700428 [本文引用: 1]
Robust Student’st based nonlinear filter and smoother
[J].DOI:10.1109/TAES.2016.150722 [本文引用: 3]
Design of high-degree Student’s t-based cubature filters
[J].
A novel robust Student's t-based Kalman filter
[J].DOI:10.1109/TAES.2017.2651684 [本文引用: 1]
A survey of attitude representations
[J].
Survey of nonlinear attitude estimation methods
[J].
/
〈 |
|
〉 |
