Multi-Sensor Data Fusion Algorithm with State Equality Constraints

Abstract

Abstract:

In applications of the state estimation theory, the state vector usually implies some constraints that can be known in advance. Making full use of these constraints will enable researchers to have a better understanding of the relationship between state elements, and theoretically enhance the accuracy of state estimation.Considering the recent achievements in constrained filtering, a brand new data fusion algorithm was provided for systems with constraints. Using linear equalities as constrained functions, the method was implemented by projecting the Kalman filtering results onto the constrained subspace, and using distributed, optimal weighting fusion to process local filtering consequences. With the assistance of covariance matching technique, sensors with abnormal measurements were eliminated during data fusion. Simulation proves the feasibility and efficiency of the algorithm, which shows better stability than the centralized fusion algorithm.

Key words: equality constraint, Kalman filter, covariance-matching, data fusion

CLC Number:

TP 274

LI Jian,HE Liming,CAI Yunze. Multi-Sensor Data Fusion Algorithm with State Equality Constraints[J]. Journal of Shanghai Jiaotong University, 2014, 48(07): 893-898.

References

［1］Kalman R E. A new approach to linear filtering and prediction problems ［J］. Journal of basic Engineering, 1960, 82(1):3545.

［2］Alouani A T, Blair W D. Use of a kinematic constraint in tracking constant speed, maneuvering targets ［J］. IEEE Transactions on Automatic Control, 1993, 38(7): 11071111.

［3］Wang L S, Chiang Y T, Chang F R. Filtering method for nonlinear systems with constraints ［J］. IEEE Proceedings Control Theory Applications, 2002, 149(6): 525531.

［4］Wen W, DurrantWhyte H F. Modelbased multisensor data fusion ［C］∥IEEE International Conference on Robotics and Automation. 1992:1720 1726.

［5］Simon D, Chia T L. Kalman filtering with state equality constraints ［J］. IEEE Transactions on Aerospace and Electronic Systems, 2002, 38(1): 128136.

［6］Simon D, Simon D L. Kalman filtering with inequality constraints for turbofan engine health estimation ［J］. IEE Proceedings Control Theory and Applications, 2006, 153(3): 371378.

［7］Hewett R, Heath M, Butala M, et al. A robust null space method for linear equality state estimation ［J］. IEEE Transactions on Signal Processing, 2010,58(8): 39613971

［8］Xu L F, Li X R, Duan Z S, et al. Modeling and state estimation for dynamic systems with linear equality constraints ［J］. IEEE Transactions on Signal Processing, 2013, 61(11)29272939.

［9］Anderson B D O, Moore J B. Optimal filtering ［M］. Englewood Cliffs, NJ: PrenticeHall, 1979.

［10］韩崇昭, 朱洪艳, 段战胜. 多源信息融合［M］. 北京: 清华大学出版社, 2006.

［11］Barshalom Y. On the tracktotrack correlation problem ［J］. IEEE Transactions on Automatic Control, 1981, 26(2): 571572.

［12］Carlson N A. Federated square root filter for decentralized parallel processes ［J］. IEEE Transactions on Aerospace and Electronic Systems, 1990, 26(3):517525.

［13］Kim K H. Development of track to track fusion algorithm［C］∥Proceeding of the American Control Conference. Baltimore: American Automatic Control Conference, 1994:10371041.

［14］Sun S L, Deng Z L. Multisensor optimal information fusion Kalman filter ［J］. Automatica, 2004, 40(6): 10171023.

［15］OlfatiSaber R, Jalalkamali P. Collaborative target tracking using distributed Kalman filtering on mobile sensor networks［C］∥Proceeding of the American Control Conference. San Francisco: American Automatic Control Conference, 2011:11001105.

［16］Feng J X, Zeng M. Optimal distributed Kalman filtering fusion for a linear dynamic system with crosscorrelated noises［J］. International Journal of Systems Science, 2012, 43(2):385398.

［17］李建,雷延花,蔡云泽，等. 基于模糊自适应Kalman滤波的多传感器数据融合算法研究［C］∥第32届中国控制会议(CCC).西安, 2013: 45234527.

[1]	JIANG Junhao, CHEN Gang. Dynamic Model Predictive Control Method for Steering Control of Driving Robot [J]. Journal of Shanghai Jiao Tong University, 2022, 56(5): 594-603.
[2]	ZHAO Yong, SU Dan. Rogue Wave Prediction Based on Four Combined Long Short-Term Memory Neural Network Models [J]. Journal of Shanghai Jiao Tong University, 2022, 56(4): 516-522.
[3]	DENG Chen, KONG Yinan, WANG Qing, CHEN Gong. Research on Empirical Engineering Correction Algorithm Integrating Physical Laws [J]. Air & Space Defense, 2022, 5(3): 73-79.
[4]	YANG Tao (杨涛), ZHAO Jiankang∗ (赵健康). Solution to Long-Range Continuous and Precise Positioning in Deep Ocean for Autonomous Underwater Vehicles Using Acoustic Range Estimation and Inertial Sensor Measurements [J]. J Shanghai Jiaotong Univ Sci, 2022, 27(3): 281-297.
[5]	GAO Honglian, YOU Jie, CAO Songyin. In-Flight Alignment Method of Integrated SINS/GPS Navigation System Based on Combined PF-UKF Filter [J]. Journal of Shanghai Jiao Tong University, 2022, 56(11): 1447-1452.
[6]	ZHANG Wenjia, MA Xin. A Sliding Window Adaptive Filtering Algorithm for Autonomous Navigation of the Approach Phase of Deep Space Probe [J]. Journal of Shanghai Jiao Tong University, 2022, 56(11): 1461-1469.
[7]	ZHAO Huipan, LIU Huanyu. Low Signature Target Group Detection Based on Multimodal Data Learning Fusion Network [J]. Air & Space Defense, 2021, 4(3): 41-47.
[8]	DONG Xiangxiang, LÜ Runyan, CAI Yunze*. A Variational Bayes-Based Filter with Uncertain Heavy-Tailed Noise [J]. Journal of Shanghai Jiaotong University, 2020, 54(9): 881-889.
[9]	PENG Pai, CHEN Cong , YANG Yongsheng . Particle Swarm Optimization Based on Hybrid Kalman Filter and Particle Filter [J]. J Shanghai Jiaotong Univ Sci, 2020, 25(6): 681-688.
[10]	CUI Naigang , CAI Ligen, RONG Siyuan. High-speed Gliding Target Tracking Algorithm Based on Digraph Switching IMM-CKF [J]. Air & Space Defense, 2020, 3(3): 1-8.
[11]	ZHANG Jihua, WEI Yali, LI Zhi, ZHOU Xiaochuan. Research on Filtering Algorithm of Missileborne Single-base Angular Measurement & Passive Positioning [J]. Air & Space Defense, 2020, 3(1): 34-40.
[12]	HU Bing,YANG Ming,GUO Lindong,WANG Chunxiang,WANG Bing. Global Localization for Intelligent Vehicles Using Ground SURF [J]. Journal of Shanghai Jiaotong University, 2019, 53(2): 203-208.
[13]	LIAO Xin, ZHU Ying, SHI Randong, GUO Zhengyong. Bias Calibration for MEMS Gyro Based on Kalman Filter [J]. Air & Space Defense, 2019, 2(1): 33-36.
[14]	LI Shuoming (李硕明), CHEN Lei (陈磊), CHEN Shihong (陈世鸿). An SNN Ontology Based Environment Monitoring Method for Intelligent Irrigation System [J]. Journal of Shanghai Jiao Tong University (Science), 2018, 23(4): 577-.
[15]	HUANG Yikun,CHEN Meishan,ZHANG Huisheng,WENG Shilie. Gas Path Diagnosis Based on Sigma Point Kalman Filter of Gas Turbine [J]. Journal of Shanghai Jiaotong University, 2016, 50(04): 534-539.