Multiple Vehicle Cooperative Localization with Spatial Registration Based on a Probability Hypothesis Density Filter

This paper studies the problem of multiple vehicle cooperative localization with spatial registration in the formulation of the probability hypothesis density (PHD) filter. Assuming vehicles are equipped with proprioceptive and exteroceptive sensors (with biases) to cooperatively localize positions, a simultaneous solution for joint spatial registration and state estimation is proposed. For this, we rely on the sequential Monte Carlo implementation of the PHD filtering. Compared to other methods, the concept of multiple vehicle cooperative localization with spatial registration is first proposed under Random Finite Set Theory. In addition, the proposed solution also addresses the challenges for multiple vehicle cooperative localization, e.g., the communication bandwidth issue and data association uncertainty. The simulation result demonstrates its reliability and feasibility in large-scale environments.

[1]  Raja Sengupta,et al.  Kalman Filter-Based Integration of DGPS and Vehicle Sensors for Localization , 2005, IEEE Transactions on Control Systems Technology.

[2]  Jun Luo,et al.  A Survey of Inter-Vehicle Communication , 2004 .

[3]  Hauke Stahle,et al.  Multiple vehicle cooperative localization under random finite set framework , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[4]  Roland Chapuis,et al.  Accurate Vehicle Positioning on a Numerical Map , 2005 .

[5]  Ba-Ngu Vo,et al.  A Random-Finite-Set Approach to Bayesian SLAM , 2011, IEEE Transactions on Robotics.

[6]  D. Clark,et al.  Multi-target state estimation and track continuity for the particle PHD filter , 2007, IEEE Transactions on Aerospace and Electronic Systems.

[7]  Christian Lundquist,et al.  A Gaussian mixture PHD filter for extended target tracking , 2010, 2010 13th International Conference on Information Fusion.

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

[9]  Peter Willett,et al.  MCMC methods for tracking two closely spaced targets using monopulse radar channel signals , 2007 .

[10]  Vijay Kumar,et al.  Cooperative multi-target localization with noisy sensors , 2013, 2013 IEEE International Conference on Robotics and Automation.

[11]  Giuseppe Oriolo,et al.  Mutual localization in a multi-robot system with anonymous relative position measures , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[12]  Jeffrey K. Uhlmann,et al.  A non-divergent estimation algorithm in the presence of unknown correlations , 1997, Proceedings of the 1997 American Control Conference (Cat. No.97CH36041).

[13]  Byung Kook Kim,et al.  A Robust Localization Algorithm for Mobile Robots with Laser Range Finders , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[14]  Yacine Khaleda,et al.  A Usage Oriented Analysis of Vehicular Networks: from Technologies to Applications , 2009 .

[15]  Raman K. Mehra,et al.  Covariance intersection algorithm for distributed spacecraft state estimation , 2001, Proceedings of the 2001 American Control Conference. (Cat. No.01CH37148).

[16]  Stergios I. Roumeliotis,et al.  A communication-bandwidth-aware hybrid estimation framework for multi-robot cooperative localization , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[17]  Stergios I. Roumeliotis,et al.  Cooperative multi-robot localization under communication constraints , 2009, 2009 IEEE International Conference on Robotics and Automation.

[18]  Giuseppe Oriolo,et al.  Relative localization and identification in a heterogeneous multi-robot system , 2013, 2013 IEEE International Conference on Robotics and Automation.

[19]  Hao Chen,et al.  Joint spatial registration and multi-target tracking using an extended probability hypothesis density filter , 2011 .

[20]  Hauke Stahle,et al.  Visual odometry based on Random Finite Set Statistics in urban environment , 2012, 2012 IEEE Intelligent Vehicles Symposium.

[21]  José Santa,et al.  A Usage Oriented Analysis of Vehicular Networks: from Technologies to Applications , 2009, J. Commun..

[22]  Stergios I. Roumeliotis,et al.  Distributed Maximum A Posteriori Estimation for Multi-robot Cooperative Localization , 2009 .

[23]  John-Olof Nilsson,et al.  Recursive Bayesian initialization of localization based on ranging and dead reckoning , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[24]  Stergios I. Roumeliotis,et al.  A hybrid estimation framework for Cooperative Localization under communication constraints , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[25]  R. Chapuis,et al.  Cooperative Multi-Vehicle Localization , 2006, 2006 IEEE Intelligent Vehicles Symposium.

[26]  Gaurav S. Sukhatme,et al.  Localization for mobile robot teams using maximum likelihood estimation , 2002, IEEE/RSJ International Conference on Intelligent Robots and Systems.

[27]  Gamini Dissanayake,et al.  Feature based SLAM using laser sensor data with maximized information usage , 2011, 2011 IEEE International Conference on Robotics and Automation.

[28]  Wei-Wen Kao,et al.  Integration of GPS and dead-reckoning navigation systems , 1991, Vehicle Navigation and Information Systems Conference, 1991.

[29]  Bharath Kalyan,et al.  FISST-SLAM: Finite Set Statistical Approach to Simultaneous Localization and Mapping , 2010, Int. J. Robotics Res..

[30]  Romuald Aufrère,et al.  Localization of a Group of Communicating Vehicles by State Exchange , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[31]  S.J. Julier,et al.  Using multiple SLAM algorithms , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

[32]  Fawzi Nashashibi,et al.  Cooperative Multi-Vehicle Localization Using Split Covariance Intersection Filter , 2013, IEEE Intelligent Transportation Systems Magazine.

[33]  Rémy Guyonneau,et al.  A visibility information for multi-robot localization , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[34]  I. R. Goodman,et al.  Mathematics of Data Fusion , 1997 .

[35]  Giuseppe Oriolo,et al.  Mutual localization in multi-robot systems using anonymous relative measurements , 2013, Int. J. Robotics Res..

[36]  Gaurav S. Sukhatme,et al.  Putting the 'I' in 'team': an ego-centric approach to cooperative localization , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[37]  Stergios I. Roumeliotis,et al.  Analysis of multirobot localization uncertainty propagation , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

[38]  W. Burgard,et al.  Markov Localization for Mobile Robots in Dynamic Environments , 1999, J. Artif. Intell. Res..