一种改进的强跟踪容积卡尔曼滤波组合导航方法

    公开(公告)号:CN109000642A

    公开(公告)日:2018-12-14

    申请号:CN201810545646.6

    申请日:2018-05-25

    Abstract: 本发明是一种改进的强跟踪容积卡尔曼滤波组合导航方法。收集SINS系统和GPS系统输出;选择状态量和观测量,建立SINS/GPS组合导航系统状态空间模型;SINS/GPS组合导航系统初始化;在k时刻进行标准CKF的时间更新和量测更新,得到一步状态预测的误差协方差值和一步预测的互协方差值;利用引入强跟踪算法的改进的强跟踪容积卡尔曼滤波算法,计算改进后的渐消因子并对一步状态预测的误差协方差值进行校正;利用校正后的一步状态预测的误差协方差值进行CKF的量测更新,得到k+1时刻的状态估计值和和状态误差协方差。本发明能提高系统的滤波精度,提高滤波器对系统状态发生突变时的跟踪能力,增强SINS/GPS组合导航系统的鲁棒性。

Patent Agency Ranking