3-D mutual localization with anonymous bearing measurements

We present a decentralized algorithm for estimating mutual 3-D poses in a group of mobile robots, such as a team of UAVs. Our algorithm uses bearing measurements reconstructed, e.g., by a visual sensor, and inertial measurements coming from the robot IMU. Since identification of a specific robot in a group would require visual tagging and may be cumbersome in practice, we simply assume that the bearing measurements are anonymous. The proposed localization method is a non-trivial extension of our previous algorithm for the 2-D case [1], and exhibits similar performance and robustness. An experimental validation of the algorithm has been performed using quadrotor UAVs.

[1]  Vijay Kumar,et al.  Planning and Control of Ensembles of Robots with Non-holonomic Constraints , 2009, Int. J. Robotics Res..

[2]  Mac Schwager,et al.  Optimal coverage for multiple hovering robots with downward facing cameras , 2009, 2009 IEEE International Conference on Robotics and Automation.

[3]  V. Kumar,et al.  Ad hoc networks for localization and control , 2002, Proceedings of the 41st IEEE Conference on Decision and Control, 2002..

[4]  Giuseppe Oriolo,et al.  Mutual localization using anonymous bearing measurements , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[5]  Robert E. Mahony,et al.  Nonlinear Complementary Filters on the Special Orthogonal Group , 2008, IEEE Transactions on Automatic Control.

[6]  Agostino Martinelli,et al.  Vision and IMU Data Fusion: Closed-Form Solutions for Attitude, Speed, Absolute Scale, and Bias Determination , 2012, IEEE Transactions on Robotics.

[7]  Gaurav S. Sukhatme,et al.  Experiments with a Large Heterogeneous Mobile Robot Team: Exploration, Mapping, Deployment and Detection , 2006, Int. J. Robotics Res..

[8]  Vijay Kumar,et al.  Sensing and coverage for a network of heterogeneous robots , 2008, 2008 47th IEEE Conference on Decision and Control.

[9]  Siddhartha S. Srinivasa,et al.  Decentralized estimation and control of graph connectivity in mobile sensor networks , 2008, ACC.

[10]  Randy A. Freeman,et al.  Multi-Agent Coordination by Decentralized Estimation and Control , 2008, IEEE Transactions on Automatic Control.

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

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

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

[14]  Stergios I. Roumeliotis,et al.  Interrobot Transformations in 3-D , 2010, IEEE Transactions on Robotics.

[15]  Siddhartha S. Srinivasa,et al.  Decentralized estimation and control of graph connectivity in mobile sensor networks , 2008, 2008 American Control Conference.

[16]  Stergios I. Roumeliotis,et al.  Determining the robot-to-robot 3D relative pose using combinations of range and bearing measurements (Part II) , 2011, 2011 IEEE International Conference on Robotics and Automation.

[17]  Philippe Martin,et al.  The true role of accelerometer feedback in quadrotor control , 2010, 2010 IEEE International Conference on Robotics and Automation.

[18]  Wolfram Burgard,et al.  A Probabilistic Approach to Collaborative Multi-Robot Localization , 2000, Auton. Robots.

[19]  Giuseppe Oriolo,et al.  Probabilistic mutual localization in multi-agent systems from anonymous position measures , 2010, 49th IEEE Conference on Decision and Control (CDC).

[20]  Vijay Kumar,et al.  Planning and control for cooperative manipulation and transportation with aerial robots , 2011, Int. J. Robotics Res..

[21]  Giuseppe Oriolo,et al.  On the solvability of the Mutual Localization problem with Anonymous Position Measures , 2010, 2010 IEEE International Conference on Robotics and Automation.