Monocular Vision based Collaborative Localization for Micro Aerial Vehicle Swarms

In this paper, we present a vision based collaborative localization framework for groups of micro aerial vehicles (MAV). The vehicles are each assumed to be equipped with a forward-facing monocular camera, and to be capable of communicating with each other. This collaborative localization approach is built upon a distributed algorithm where individual and relative pose estimation techniques are combined for the group to localize against surrounding environments. The MAVs initially detect and match salient features between each other to create a sparse reconstruction of the observed environment, which acts as a global map. Once a map is available, each MAV performs feature detection and tracking with a robust outlier rejection process to estimate its own six degree-of-freedom pose. Occasionally, the MAVs can also fuse relative measurements with individual measurements through feature matching and multiple-view geometry based relative pose computation. We present the implementation of this algorithm for MAVs and environments simulated within Microsoft AirSim, and discuss the results and the advantages of collaborative localization.

[1]  Laurent Kneip,et al.  Collaborative monocular SLAM with multiple Micro Aerial Vehicles , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[2]  Ashish Kapoor,et al.  AirSim: High-Fidelity Visual and Physical Simulation for Autonomous Vehicles , 2017, FSR.

[3]  Daniel Cremers,et al.  LSD-SLAM: Large-Scale Direct Monocular SLAM , 2014, ECCV.

[4]  Patrik Schmuck,et al.  Multi-UAV collaborative monocular SLAM , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[5]  Nathan Michael,et al.  Multi-robot pose graph localization and data association from unknown initial relative poses via expectation maximization , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[6]  David Nistér,et al.  An efficient solution to the five-point relative pose problem , 2004, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[7]  Srikanth Saripalli,et al.  Vision based Collaborative Localization for Swarms of Aerial Vehicles , 2017 .

[8]  Ehud Rivlin,et al.  Distributed vision-aided cooperative localization and navigation based on three-view geometry , 2011, 2011 Aerospace Conference.

[9]  Roland Siegwart,et al.  Collaborative stereo , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[10]  Adrien Bartoli,et al.  Fast Explicit Diffusion for Accelerated Features in Nonlinear Scale Spaces , 2013, BMVC.

[11]  Danping Zou,et al.  CoSLAM: Collaborative Visual SLAM in Dynamic Environments , 2013, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[12]  G. Klein,et al.  Parallel Tracking and Mapping for Small AR Workspaces , 2007, 2007 6th IEEE and ACM International Symposium on Mixed and Augmented Reality.

[13]  Julien Marzat,et al.  Collaborative localization and formation flying using distributed stereo-vision , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[14]  Roland Siegwart,et al.  A novel parametrization of the perspective-three-point problem for a direct computation of absolute camera position and orientation , 2011, CVPR 2011.

[15]  Srikanth Saripalli,et al.  Vision based collaborative localization for multirotor vehicles , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[16]  Stergios I. Roumeliotis,et al.  Decentralized multi-robot cooperative localization using covariance intersection , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[17]  Bernhard P. Wrobel,et al.  Multiple View Geometry in Computer Vision , 2001 .

[18]  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).

[19]  Stefano Soatto,et al.  Visual-inertial navigation, mapping and localization: A scalable real-time causal approach , 2011, Int. J. Robotics Res..

[20]  Ehud Rivlin,et al.  Distributed vision-aided cooperative localization and navigation based on three-view geometry , 2011 .

[21]  Prabir Barooah,et al.  Distributed collaborative localization of multiple vehicles from relative pose measurements , 2009, 2009 47th Annual Allerton Conference on Communication, Control, and Computing (Allerton).

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

[23]  Srikanth Saripalli,et al.  Vision Based Collaborative Path Planning for Micro Aerial Vehicles , 2018, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[24]  James M. Rehg,et al.  Adaptive Structure from Motion with a Contrario Model Estimation , 2012, ACCV.