带非线性等式约束无迹卡尔曼滤波方法

doi:10.11772/j.issn.1001-9081.2017102472

计算机应用 ›› 2018, Vol. 38 ›› Issue (5): 1481-1487.DOI: 10.11772/j.issn.1001-9081.2017102472

带非线性等式约束无迹卡尔曼滤波方法

汤启, 何腊梅

四川大学数学学院, 成都 610064

收稿日期:2017-10-18 修回日期:2017-12-20 出版日期:2018-05-10 发布日期:2018-05-24
通讯作者: 何腊梅
作者简介:汤启(1990-),男,湖北孝昌人,硕士研究生,主要研究方向:非线性滤波;何腊梅(1971-),女,四川仪陇人,副教授,博士,主要研究方向:极值理论、信息融合。
基金资助:
国家自然科学基金资助项目（61374027）。

Unscented Kalman filtering method with nonlinear equality constraint

TANG Qi, HE Lamei

College of Mathematics, Sichuan University, Chengdu Sichuan 610064, China

Received:2017-10-18 Revised:2017-12-20 Online:2018-05-10 Published:2018-05-24
Contact: 何腊梅
Supported by:
This work is partially supported by the National Natural Science Foundation of China (61374027).

摘要/Abstract

摘要： 针对带非线性等式约束的非线性系统的状态估计问题，给出了一种新形式的基于无迹卡尔曼滤波及伪观测手段的处理约束的状态估计方法（SPUKF）。在该方法中原动态系统被虚拟地分离成两个并行的子系统，各时刻的状态估计由基于这两个子系统构建的两套滤波链交替得到。相对于伪观测法中的序贯形式估计器，SPUKF无需事先确定观测及约束的处理次序且能获得更好的估计结果，故可以用来解决序贯方法中观测与约束的处理次序问题。由钟摆运动的实例仿真结果看到，SPUKF不仅有好于序贯形式无迹卡尔曼滤波的估计效果，误差改善比达到22%左右，而且算法运行时间与序贯形式估计器相近。此外，其估计效果还与批处理无迹卡尔曼滤波相当。

关键词: 状态估计, 无迹卡尔曼滤波, 非线性等式约束, 批处理, 序贯处理

Abstract: A new constrained filtering method based on Unscented Kalman Filter (UKF) and pseudo-observation called SPUKF (Sub-system Parallel Unscented Kalman Filter) was proposed for state estimation of nonlinear system with nonlinear constraints. In the proposed method, the system and constraint equations were fictitiously divided and reconstructed into two sub-systems, and then the state estimation was obtained from two concurrent filtering processes which were established on these two sub-systems alternately. Compared to sequential processing method of pseudo-measurement, SPUKF did not need to determine the processing order between measurement and constraint, but achieved better performances, so as to address the problem of deciding processing order beforehand in sequential processing method. In the simulation of pendulum motion, it is verified that SPUKF gets better estimation performance and less running time than the two forms of sequential processing method, and enhances the estimation error improvement ratio by 22 percentage points than UKF. Furthermore, it obtains comparable estimation results with batch processing way.

Key words: state estimation, Unscented Kalman Filter (UKF), nonlinear equality constraint, batch processing, sequential processing

中图分类号:

TN713

汤启, 何腊梅. 带非线性等式约束无迹卡尔曼滤波方法[J]. 计算机应用, 2018, 38(5): 1481-1487.

TANG Qi, HE Lamei. Unscented Kalman filtering method with nonlinear equality constraint[J]. Journal of Computer Applications, 2018, 38(5): 1481-1487.

参考文献

[1] STRAKA O, DUNÍK J, ŠIMANDL M. Truncation nonlinear filters for state estimation with nonlinear inequality constraints[J]. Automatica, 2012, 48(2):273-286.
[2] VACHHANI P, NARASIMHAN S, RENGASWAMY R. Robust and reliable estimation via unscented recursive nonlinear dynamic data reconciliation[J]. Journal of Process Control, 2006, 16(10):1075-1086.
[3] 姬晓琴, 高晓颖. 低轨卫星紧组合导航UKF方法[J]. 哈尔滨工业大学学报, 2012, 44(7):135-138.(JI X Q, GAO X Y. UKF for tightly coupled integration in LEO[J]. Journal of Harbin Institute of Technology, 2012, 44(7):135-138.)
[4] DUNÍK J, ŠIMANDL M, STRAKA O. Unscented Kalman filter:aspects and adaptive setting of scaling parameter[J]. IEEE Transactions on Automatic Control, 2012, 57(9):2411-2416.
[5] STRAKA O, DUNÍK J, ŠIMANDL M. Unscented Kalman filter with advanced adaptation of scaling parameter[J]. Automatica, 2014, 50(10):2657-2664.
[6] 张勇刚, 黄玉龙, 武哲民,等. 一种高阶无迹卡尔曼滤波方法[J]. 自动化学报, 2014, 40(5):838-848.(ZHANG Y G, HUANG Y L, WU Z M, et al. A high order unscented Kalman filtering method[J]. Acta Automatica Sinica, 2014, 40(5):838-848.)
[7] 黄铫, 张天骐, 高清山,等. 一种提高无迹卡尔曼滤波精确度的方法[J]. 计算机仿真, 2010, 27(3):348-352.(HUANG Y, ZHANG T Q, GAO Q S, et al. A method improving the accuracy of UKF[J]. Computer Simulation, 2010, 27(3):348-352.)
[8] KOLÅS S, FOSS B A, SCHEI T S. Constrained nonlinear state estimation based on the UKF approach[J]. Computers & Chemical Engineering, 2009, 33(8):1386-1401.
[9] DOUCET A, FREITAS N D, WAN E. The unscented particle filter[C]//Proceedings of the 13th International Conference on Neural Information Processing Systems. Cambridge, MA:MIT Press, 2001:584-590.
[10] SIMON D. Kalman filtering with state constraints:a survey of linear and nonlinear algorithms[J]. IET Control Theory & Applications, 2010, 4(8):1303-1318.
[11] 陈金广, 李洁, 高新波. 一种迭代收缩非线性状态约束滤波算法[J]. 西安电子科技大学学报(自然科学版), 2011, 38(1):104-109.(CHEN J G, LI J, GAO X B. Iterative shrinking filtering algorithm with nonlinear state constraints[J]. Journal of Xidian University:Natural Science Edition,2011,38(1):104-109.)
[12] 吴鑫辉, 黄高明, 高俊. 一种不等式状态约束最优滤波算法[J]. 西安电子科技大学学报(自然科学版), 2013, 40(1):148-154.(WU X H, HUANG G M, GAO J. Approach for optimal filtering of the nonlinear system with inequality constraints[J]. Journal of Xidian University:Natural Science Edition, 2013, 40(1):148-154.)
[13] KOTTAKKI K K, BHUSHAN M, BHARTIYA S. Constrained unscented Gaussian sum filter for state estimation of nonlinear dynamical systems[J]. Computers & Chemical Engineering, 2016, 91:352-364.
[14] TEIXEIRA B O S, TȎRRES L A B, AGUIRRE L A, et al. On unscented Kalman filtering with state interval constraints[J]. Journal of Process Control, 2010, 20(1):45-57.
[15] 贺姗, 师昕. 基于内点法的不敏卡尔曼滤波算法[J]. 软件导刊, 2017, 16(6):40-44.(HE S, SHI X. Unscented Kalman filter based on interior point method[J]. Software Guide, 2017, 16(6):40-44.)
[16] DUAN Z, LI X R. The role of pseudo measurements in equality-constrained state estimation[J]. IEEE Transactions on Aerospace & Electronic Systems, 2013, 49(3):1654-1666.
[17] LI X R. Measure of nonlinearity for stochastic systems[C]//Proceedings of the 201215th International Conference on Information Fusion. Piscataway, NJ:IEEE, 2012:1073-1080.
[18] MALLICK M, SCALA B F L, ARULAMPALAM M S. Differential geometry measures of nonlinearity for the bearing-only tracking problem[J]. Proceedings of SPIE on Signal Processing, Sensor Fusion and Target Recognition. Bellingham, WA:SPIE, 2005, 5809:288-300.
[19] ZHU Y M. Multisensor Decision and Estimation Fusion[M]. Amsterdam:Kluwer Academic Publishers, 2002:136-138.
[20] MERWE R V D, WAN E A. The square-root unscented Kalman filter for state and parameter-estimation[C]//Proceedings of the 2001 IEEE International Conference on Acoustics, Speech, and Signal Processing. Washington, DC:IEEE Computer Society, 2002:3461-3464.
[21] DAN S. Optimal State Estimation:Kalman, H∞, and Nonlinear Approaches[M]. New York:Wiley-Interscience, 2006:448-450.
[22] TEIXEIRA B, CHANDRASEKAR J, TȎRRES L, et al. State estimation for linear and non-linear equality-constrained systems[J]. International Journal of Control, 2009, 82(5):918-936.
[23] DUAN Z, LI X R, HAN C, et al. Sequential unscented Kalman filter for radar target tracking with range rate measurements[C]//Proceedings of the 20058th International Conference on Information Fusion. Piscataway, NJ:IEEE, 2006:130-137.

带非线性等式约束无迹卡尔曼滤波方法

Unscented Kalman filtering method with nonlinear equality constraint

PDF

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 9

编辑推荐

Metrics

[1]	隗千千, 董兴业, 王焕政. 染缸排产建模及滑动时间窗启发式调度算法[J]. 计算机应用, 2020, 40(1): 292-298.
[2]	游路瑶, 黄庆卿, 段斯静. 基于卡尔曼滤波估计的一致性时钟同步算法[J]. 计算机应用, 2017, 37(8): 2177-2183.
[3]	田继伟, 王布宏, 尚福特. 基于鲁棒主成分分析的智能电网虚假数据注入攻击[J]. 计算机应用, 2017, 37(7): 1943-1947.
[4]	曹帅, 王布宏, 刘新波, 沈海鸥. 基于Earley算法的多功能雷达文法概率快速学习算法[J]. 计算机应用, 2016, 36(9): 2636-2641.
[5]	石刚, 赵伟, 刘珊珊. 基于无迹卡尔曼滤波估算电池SOC[J]. 计算机应用, 2016, 36(12): 3492-3498.
[6]	袁磊, 梁丁文, 蔡之华, 吴钊, 谷琼. 基于正交差分演化无迹卡尔曼滤波的短时交通流量预测算法[J]. 计算机应用, 2015, 35(11): 3151-3156.
[7]	梁丁文袁磊蔡之华谷琼. 基于无迹卡尔曼滤波传感器信息融合的车辆导航算法[J]. 计算机应用, 2013, 33(12): 3444-3448.
[8]	胡银娥许志闻杨华元曹大洲. 基于补丁算法的流媒体代理缓存的研究与实现[J]. 计算机应用, 2007, 27(7): 1817-1820.
[9]	田海生陈立军 . 基于大纲的数据流自适应聚集算子的实现[J]. 计算机应用, 2007, 27(10): 2383-2387.