一种交互式鲁棒滤波的多系统组合导航方法和装置
Abstract:
本发明提供了一种交互式鲁棒滤波的多系统组合导航方法和装置,所述方法包括:根据捷联惯性导航系统误差模型建立状态方程,建立位置速度量测方程;其次基于常规强跟踪滤波(STKF)相同的性能指标函数,提出一种针对量测信息异常的自适应滤波算法(MAKF);然后对滤波初值进行交互并采用STKF滤波器及MAKF滤波器并行滤波进行状态估计;再利用STKF及MAKF滤波结果中的残差构造似然函数,更新滤波概率;最后根据滤波概率对滤波输出进行加权融合,得到状态估计,对导航输出的位置、速度和姿态进行校正。本发明在系统异常和量测异常情况下均取得较好的估计精度,提高组合导航的精度和鲁棒性。
Public/Granted literature
Patent Agency Ranking
0/0