Distributed extended Kalman filter with nonlinear consensus estimate

Abstract This paper is concerned with the distributed filtering problem for discrete-time nonlinear systems over a sensor network. In contrast with the distributed filters with linear consensus estimate, a distributed extended Kalman filter (EKF) is developed with nonlinear consensus estimate. Specifically, a new nonlinear consensus protocol with polynomial form is proposed to generate the consensus estimate. By using the variance-constrained approach, the Kalman gain matrix is determined for each node to guarantee an optimized upper bound on the state estimation error covariance despite consensus terms and linearization errors. It is shown that the Kalman gain matrix can be derived by solving two Riccati-like difference equations. The effectiveness of the proposed filter is evaluated on an indoor localization of a mobile robot with visual tracking systems.

[1]  Ruggero Carli,et al.  Distributed Kalman filtering based on consensus strategies , 2008, IEEE Journal on Selected Areas in Communications.

[2]  Junping Du,et al.  Distributed Kalman consensus filter with intermittent observations , 2015, J. Frankl. Inst..

[3]  R. Olfati-Saber,et al.  Distributed Kalman Filter with Embedded Consensus Filters , 2005, Proceedings of the 44th IEEE Conference on Decision and Control.

[4]  Kai Xiong,et al.  Robust Extended Kalman Filtering for Nonlinear Systems With Stochastic Uncertainties , 2010, IEEE Transactions on Systems, Man, and Cybernetics - Part A: Systems and Humans.

[5]  Ling Shi,et al.  Stochastic sensor activation for distributed state estimation over a sensor network , 2014, Autom..

[6]  Jun Hu,et al.  Quantised recursive filtering for a class of nonlinear systems with multiplicative noises and missing measurements , 2013, Int. J. Control.

[7]  Giorgio Battistelli,et al.  Kullback-Leibler average, consensus on probability densities, and distributed state estimation with guaranteed stability , 2014, Autom..

[8]  Giuseppe Carlo Calafiore,et al.  Reliable localization using set-valued nonlinear filters , 2005, IEEE Transactions on Systems, Man, and Cybernetics - Part A: Systems and Humans.

[9]  Chao Yang,et al.  Stochastic link activation for distributed filtering under sensor power constraint , 2017, Autom..

[10]  Soummya Kar,et al.  Consensus + innovations distributed inference over networks: cooperation and sensing in networked systems , 2013, IEEE Signal Processing Magazine.

[11]  Amit K. Roy-Chowdhury,et al.  Information Weighted Consensus Filters and Their Application in Distributed Camera Networks , 2013, IEEE Transactions on Automatic Control.

[12]  Giorgio Battistelli,et al.  Parallel Consensus on Likelihoods and Priors for Networked Nonlinear Filtering , 2014, IEEE Signal Processing Letters.

[13]  R. Olfati-Saber,et al.  Consensus Filters for Sensor Networks and Distributed Sensor Fusion , 2005, Proceedings of the 44th IEEE Conference on Decision and Control.

[14]  Zongyu Zuo,et al.  Distributed robust finite-time nonlinear consensus protocols for multi-agent systems , 2016, Int. J. Syst. Sci..

[15]  Soummya Kar,et al.  Distributed Kalman Filtering : Weak Consensus Under Weak Detectability , 2011 .

[16]  Jun Hu,et al.  A variance-constrained approach to recursive state estimation for time-varying complex networks with missing measurements , 2016, Autom..

[17]  Reza Olfati-Saber,et al.  Consensus and Cooperation in Networked Multi-Agent Systems , 2007, Proceedings of the IEEE.

[18]  Uri Shaked,et al.  Robust discrete-time minimum-variance filtering , 1996, IEEE Trans. Signal Process..

[19]  Reza Olfati-Saber,et al.  Kalman-Consensus Filter : Optimality, stability, and performance , 2009, Proceedings of the 48h IEEE Conference on Decision and Control (CDC) held jointly with 2009 28th Chinese Control Conference.

[20]  Yingmin Jia,et al.  Indoor localization for mobile robots using lampshade corners as landmarks: Visual system calibration, feature extraction and experiments , 2014 .

[21]  José M. F. Moura,et al.  Distributed Kalman Filtering With Dynamic Observations Consensus , 2015, IEEE Transactions on Signal Processing.

[22]  Zongyu Zuo,et al.  A new class of finite-time nonlinear consensus protocols for multi-agent systems , 2014, Int. J. Control.

[23]  Reza Olfati-Saber,et al.  Distributed Kalman filtering for sensor networks , 2007, 2007 46th IEEE Conference on Decision and Control.

[24]  Junping Du,et al.  Event-triggered Kalman consensus filter over sensor networks , 2016 .

[25]  Giorgio Battistelli,et al.  Consensus-Based Linear and Nonlinear Filtering , 2015, IEEE Transactions on Automatic Control.

[26]  Jun Hu,et al.  Extended Kalman filtering with stochastic nonlinearities and multiple missing measurements , 2012, Autom..

[27]  Junping Du,et al.  Distributed consensus extended Kalman filter: a variance-constrained approach , 2017 .

[28]  Lihua Xie,et al.  Robust Kalman filtering for uncertain discrete-time systems , 1994, IEEE Trans. Autom. Control..

[29]  Giorgio Battistelli,et al.  Stability of consensus extended Kalman filter for distributed state estimation , 2016, Autom..

[30]  Luca Schenato,et al.  A Survey on Distributed Estimation and Control Applications Using Linear Consensus Algorithms , 2010 .

[31]  Long Wang,et al.  Finite-Time Consensus Problems for Networks of Dynamic Agents , 2007, IEEE Transactions on Automatic Control.