第 29 卷 第 2 期
Vol. 29 No. 2
控 制 与 决 策
Control and Decision
2014 年 2 月
Feb. 2014
基于奇异值分解的鲁棒容积卡尔曼滤波
及其在组合导航中的应用
文章编号: 1001-0920 (2014) 02-0341-06 DOI: 10.13195/j.kzyjc.2012.1462
张秋昭
a,b
, 张书毕
a,b
, 刘志平
a
, 卞和方
b
(中国矿业大学 a. 国土环境与灾害监测国家测绘地理信息局重点实验室,b. 环境与测绘学院,江苏 徐州 221116)
摘 要: 为了提高 GPS/INS 组合导航系统对异常观测值的鲁棒性, 引入 𝐻
∞
滤波思想提出一种新的非线性鲁棒滤波.
分析 𝐻
∞
鲁棒容积卡尔曼滤波中不同约束水平对滤波结果的影响, 指出在一定范围内当约束水平越小时, 系统的鲁
棒性越强, 但容易造成 Riccati 不等式无解, 导致滤波发散. 采用奇异值分解代替容积卡尔曼滤波中的 Cholesky 分解,
改善了滤波的稳定性, 放宽了 𝐻
∞
鲁棒容积卡尔曼滤波器对约束水平的要求. GPS/INS 组合导航实验验证了该滤波
方法的正确性和优越性.
关键词: 奇异值分解;容积卡尔曼滤波;鲁棒滤波;组合导航;非线性滤波
中图分类号: TP273 文献标志码: A
Robust cubature Kalman filter based on SVD and its application to
integrated navigation
ZHANG Qiu-zhao
a,b
, ZHANG Shu-bi
a,b
, LIU Zhi-ping
a
, BIAN He-fang
b
(a. Key Laboratory for Land Environment and Disaster Monitoring of the State Bureau of Surveying and Mapping,
b. School of Environment and Spational Informatics,China University of Mining and Technology,Xuzhou 221116,
China.Correspondent:ZHANG Shu-bi,E-mail:zhangsbi@vip.sina.com)
Abstract: A new nonlinear robust filter is proposed to deal with the outlier of GPS/INS integrated navigation system. The
influence of different design parameters for the 𝐻
∞
cubature Kalman filter is analyzed. The design parameter is smaller,
and the robustness of the filter is stronger. But the design parameter is easily out of step with the Riccati inequation and
the filter is easy to diverge. In this respect, the singular value decomposition algorithm is used to take the place of Cholesky
decomposition in 𝐻
∞
cubature Kalman filter. On the wider conditions for the design parameter, the new filter is more robust.
The actual GPS/INS integrated navigation test indicates the correctness and effectiveness of the proposed filter algorithm.
Key words: singular value decomposition;cubature Kalman filter;robust filter;integrated navigation;nonlinear filter
0 引引引 言言言
GPS/INS 组合导航系统一般采用卡尔曼滤波对
系统的状态进行估计
[1]
. 卡尔曼滤波是一种建立在
𝐻
2
准则下的线性最小方差滤波算法, 并且滤波性能
取决于系统模型以及干扰特性假设的精确程度. 在实
际工作中, 异常观测值不可避免地严重影响组合导
航定位系统的精度. 基于抗差估计原理的滤波方法可
以抑制紧组合系统观测异常的影响
[2-3]
, 而 𝐻
∞
滤波
从滤波器的鲁棒性出发, 为线性系统的鲁棒估计提供
了另一条有效途径
[4-6]
. 将扩展卡尔曼滤波
[7]
、Sigma
point 卡尔曼滤波
[8]
和容积卡尔曼滤波(CKF)
[9-10]
等非
线性滤波的思想与标准线性 𝐻
∞
滤波相结合, 形成算
法更优的非线性 𝐻
∞
滤波策略, 既可以适应低成本捷
联惯性导航系统对滤波器非线性的要求
[11]
, 又能抑制
异常观测值的影响.
由于 𝐻
∞
滤波是以一个确定参数 𝛾 表征约束水
平, 它决定了滤波器对估计误差不确定干扰的约束
能力
[12]
. 约束水平 𝛾 越大, 𝐻
∞
滤波越接近标准卡尔
曼滤波, 对异常值的鲁棒性较差; 约束水平 𝛾 越小,
𝐻
∞
滤波的鲁棒性越强
[13]
. 但参数 𝛾 选择较小容易
造成状态协方差阵的非正定性, 导致滤波不稳定甚
至发散
[14]
, 一定程度上限制了 𝐻
∞
滤波的鲁棒性. 文
收稿日期: 2012-10-02;修回日期: 2013-01-14.
基金项目: 国家自然科学基金项目(40904004, 51174206);江苏高校优势学科建设工程项目(PAPD);江苏省普通高校
研究生创新计划项目(CX10B-142Z).
作者简介: 张秋昭(1985−), 男, 博士生, 从事组合导航理论与应用的研究;张书毕(1965−), 男, 教授, 博士生导师, 从事
卫星导航、组合导航等研究.