Approximate Distributed Kalman Filtering for Cooperative Multi-agent Localization

We consider the problem of estimating the locations of mobile agents by fusing the measurements of displacements of the agents as well as relative position measurements between pairs of agents. We propose an algorithm that computes an approximation of the centralized optimal (Kalman filter) estimates. The algorithm is distributed in the sense each agent can estimate its own position by communication only with nearby agents. The problem of distributed Kalman filtering for this application is reformulated as a parameter estimation problem. The graph structure underlying the reformulated problem makes it computable in a distributed manner using iterative methods of solving linear equations. With finite memory and limited number of iterations before new measurements are obtained, the algorithm produces an approximation of the Kalman filter estimates. As the memory of each agent and the number of iterations between each time step are increased, the approximation improves. Simulations are presented that show that even with small memory size and few iterations, the estimates are quite close to the centralized optimal. The error covariances of the location estimates produced by the proposed algorithm are significantly lower than what is possible if inter-agent relative position measurements are not available.

[1]  J. Mendel.  Lessons in Estimation Theory for Signal Processing, Communications, and Control , 1995 .

[2]  James R. Bergen,et al.  Visual odometry , 2004, Proceedings of the 2004 IEEE Computer Society Conference on Computer Vision and Pattern Recognition, 2004. CVPR 2004..

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

[4]  Anders Rantzer,et al.  Experimental Evaluation of a Distributed Kalman Filter Algorithm , 2007, 2007 46th IEEE Conference on Decision and Control.

[5]  B. Anderson,et al.  Optimal Filtering , 1979, IEEE Transactions on Systems, Man, and Cybernetics.

[6]  Kostas Daniilidis,et al.  Correspondenceless Ego-Motion Estimation Using an IMU , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[7]  Gregory Dudek,et al.  Multi-robot cooperative localization: a study of trade-offs between efficiency and accuracy , 2002, IEEE/RSJ International Conference on Intelligent Robots and Systems.

[8]  Margaret Martonosi,et al.  LOCALE: Collaborative Localization Estimation for Sparse Mobile Sensor Networks , 2008, 2008 International Conference on Information Processing in Sensor Networks (ipsn 2008).

[9]  Gene H. Golub,et al.  Matrix computations , 1983 .

[10]  Supun Samarasekera,et al.  Visual Odometry System Using Multiple Stereo Cameras and Inertial Measurement Unit , 2007, 2007 IEEE Conference on Computer Vision and Pattern Recognition.

[11]  Richard M. Murray,et al.  Approximate distributed Kalman filtering in sensor networks with quantifiable performance , 2005, IPSN 2005. Fourth International Symposium on Information Processing in Sensor Networks, 2005..

[12]  Ryo Kurazume,et al.  Cooperative positioning with multiple robots , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[13]  J. Hespanha,et al.  Distributed Estimation from Relative Measurements in Sensor Networks , 2005, 2005 3rd International Conference on Intelligent Sensing and Information Processing.

[14]  Ruggero Carli,et al.  Distributed Kalman filtering using consensus strategies , 2007, 2007 46th IEEE Conference on Decision and Control.

[15]  Clark F. Olson,et al.  Rover navigation using stereo ego-motion , 2003, Robotics Auton. Syst..

[16]  Stergios I. Roumeliotis,et al.  Performance analysis of multirobot Cooperative localization , 2006, IEEE Transactions on Robotics.

[17]  A. Rantzer,et al.  Distributed Kalman Filtering Using Weighted Averaging , 2006 .

[18]  Joao P. Hespanha,et al.  Estimation and control with relative measurements: algorithms and scaling laws , 2007 .

[19]  J. Hespanha,et al.  Estimation on graphs from relative measurements , 2007, IEEE Control Systems.

[20]  Joao P. Hespanha,et al.  from Relative Measurements , 2007 .

[21]  I. Rhodes.  A tutorial introduction to estimation and filtering , 1971 .

[22]  Gene H. Golub,et al.  Matrix computations (3rd ed.) , 1996 .

[23]  João Pedro Hespanha,et al.  Error Scaling Laws for Linear Optimal Estimation From Relative Measurements , 2009, IEEE Transactions on Information Theory.

[24]  Stergios I. Roumeliotis,et al.  Distributed multirobot localization , 2002, IEEE Trans. Robotics Autom..

[25]  Hobart R. Everett,et al.  Mobile robot positioning: Sensors and techniques , 1997, J. Field Robotics.

[26]  Giuseppe Serazzi,et al.  Computer virus propagation models , 2004 .

[27]  R. Varga,et al.  Block diagonally dominant matrices and generalizations of the Gerschgorin circle theorem , 1962 .

[28]  Dipak Ghosal,et al.  Multipath Routing in Mobile Ad Hoc Networks: Issues and Challenges , 2003, MASCOTS Tutorials.

[29]  Olfati-Saber.  [IEEE 2007 46th IEEE Conference on Decision and Control - New Orleans, LA, USA (2007.12.12-2007.12.14)] 2007 46th IEEE Conference on Decision and Control - Distributed Kalman filtering for sensor networks , 2007 .

[30]  João Pedro Hespanha,et al.  Distributed Optimal Estimation from Relative Measurements for Localization and Time Synchronization , 2006, DCOSS.

[31]  Oskar Maria Baksalary,et al.  The Bulletin of the International Linear Algebra Society , 2008 .