上海交通大学学报

上海交通大学学报（自然版） ›› 2014, Vol. 48 ›› Issue (07): 893-898.

• 自动化技术、计算机技术 •    下一篇

带有等式状态约束的多传感器数据融合算法

李建，何黎明，蔡云泽
  

  1. (上海交通大学自动化系,系统控制与信息处理教育部重点实验室, 上海 200240)
     
     
     
  • 收稿日期:2011-01-15 出版日期:2014-07-28 发布日期:2014-07-28
  • 基金资助:

    国家自然科学基金(61004088，61374160),上海航天科技创新基金(SAST201237)

Multi-Sensor Data Fusion Algorithm with State Equality Constraints

LI Jian,HE Liming,CAI Yunze
  

  1. (Key Laboratory of System Control and Information Processing of the  Ministry of Education, Department of Automation,  Shanghai Jiaotong University, Shanghai 200240, China)
  • Received:2011-01-15 Online:2014-07-28 Published:2014-07-28

摘要：

在状态估计理论的实际应用中，状态向量常常包含可以预先获知的约束信息，有效地利用这些先验信息可以进一步明确状态元素之间的关系，理论上可以提高对系统的状态估计精度. 针对约束滤波的已有研究成果，将其引入到多传感器系统，提出了约束系统多传感器数据融合算法. 通过建立线性等式约束方程，将传统卡尔曼滤波结果投影到约束子空间，然后对局部传感器的约束滤波结果采用分布式最优加权融合，并且通过协方差匹配技术检测观测数据异常的传感器，使之不参与到数据融合中. 仿真结果表明，约束系统分布式加权融合算法的有效性和可行性，并且比集中式融合算法具有更好的稳定性.
 

关键词: 等式约束, 卡尔曼滤波, 协方差匹配, 数据融合

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

中图分类号: