GPS/INS松耦合组合导航的自适应卡尔曼滤波算法研究  

Research on adaptive Kalman filter algorithm for GPS/INS loosely coupled integrated navigation

作　　者：周先林 张慧君[1,2,3] 和涛 李孝辉[1,2,3] ZHOU Xian-lin;ZHANG Hui-jun;HE Tao;LI Xiao-hui(National Time Service Center,Chinese Academy of Sciences,Xi’an 710600,China;Key Laboratory of Precise Positioning and Timing Technology,Chinese Academy of Sciences,Xi’an 710600,China;University of Chinese Academy of Sciences,Beijing 100049,China;Kunming Shipborne Equipment Research and Test Center,China State Shipbuilding Corporation Limited,Kunming 650051,China)

机构地区：[1]中国科学院国家授时中心,西安710600 [2]中国科学院精密导航定位与定时技术重点实验室,西安710600 [3]中国科学院大学,北京100049 [4]中国船舶集团有限公司昆明船舶设备研究试验中心,昆明650051

出　　处：《时间频率学报》2020年第3期222-230,共9页Journal of Time and Frequency

基　　金：基础研究重大项目前期研究专项资助(11703030)。

摘　　要：针对常规卡尔曼滤波应用在GPS/INS组合导航时,由于量测数据出现异常值或系统状态模型不准确而造成的滤波精度下降问题,提出了一种基于新息的自适应卡尔曼滤波算法(AKF)。该算法首先通过卡方检验检测出量测异常值,在量测异常值处调整量测噪声方差阵来抑制滤波发散;在此基础上根据新息协方差的计算值与新息协方差的预测值的粗略比率,调整系统噪声方差阵,从而提高整体滤波精度。通过跑车试验,对本文提出的AKF算法进行了验证。试验结果表明:本文提出的AKF算法较常规卡尔曼滤波算法在经度、纬度误差(均方根)上分别降低了67%,34%,在东向速度、北向速度误差(均方根)上分别降低了47%,38%。从而证明了该算法能有效地抑制由量测异常值导致的状态估计误差,防止滤波发散,提高滤波稳定性。Aiming at the reduction of the filtering accuracy when the conventional Kalman filter is used in GPS/INS integrated navigation due to outliers of measurement data or inaccurate system state model,an adaptive Kalman filter algorithm based on innovation is proposed.First,the algorithm detects measured outliers by chi-square test,and adjusts the measurement noise variance matrix at the outliers to suppress filtering divergence.Thereby,the rough ratio between the calculated value and the predicted value of the innovation variance matrix is calculated to adjust the system noise variance matrix and then the overall filtering accuracy will be improved.The AKF algorithm proposed in this paper is verified by a vehicle test. The results show that, the proposed AKFalgorithm in this paper reduces the longitude errors and latitude errors (root mean square) with 67% and 34%comparing with the conventional Kalman filter algorithm, and reduces the eastward velocity errors andnorthward velocity errors (root mean square) with 47% and 38%. It is proved that the algorithm can effectivelysuppress the state estimation error caused by the measured outliers, and further improve the filtering stability.

关 键 词：组合导航 自适应卡尔曼滤波 新息 噪声方差 

分 类 号：TN713[电子电信—电路与系统] TN96