Active decentralized scale estimation for bearing-based localization

In this paper, we propose a novel decentralized active perception strategy that maximizes the convergence rate in estimating the (unmeasurable) formation scale in the context of bearing-based formation localization for robots evolving in ℝ3 × S1. The proposed algorithm does not assume presence of a global reference frame and only requires bearing-rigidity of the formation (for the localization problem to admit a unique solution), and presence of (at least) one pair of robots in mutual visibility. Two different scenarios are considered in which the active scale estimation problem is treated either as a primary task or as a secondary objective with respect to the constraint of attaining a desired bearing formation. The theoretical results are validated by realistic simulations.

[1]  Kurt Konolige,et al.  Distributed Multirobot Exploration and Mapping , 2005, Proceedings of the IEEE.

[2]  Shiyu Zhao,et al.  Bearing Rigidity and Almost Global Bearing-Only Formation Stabilization , 2014, IEEE Transactions on Automatic Control.

[3]  Frank Dellaert,et al.  Rigid components identification and rigidity control in bearing-only localization using the graph cycle basis , 2015, 2015 American Control Conference (ACC).

[4]  Brian D. O. Anderson,et al.  Stabilization of rigid formations with direction-only constraints , 2011, IEEE Conference on Decision and Control and European Control Conference.

[5]  Roland Siegwart,et al.  Path planning for motion dependent state estimation on micro aerial vehicles , 2013, 2013 IEEE International Conference on Robotics and Automation.

[6]  Brian D. O. Anderson,et al.  Analysis of Noisy Bearing-Only Network Localization , 2013, IEEE Transactions on Automatic Control.

[7]  Mac Schwager,et al.  Distributed formation control without a global reference frame , 2014, 2014 American Control Conference.

[8]  Ming Cao,et al.  Controlling Rigid Formations of Mobile Agents Under Inconsistent Measurements , 2015, IEEE Transactions on Robotics.

[9]  Gordon F. Royle,et al.  Algebraic Graph Theory , 2001, Graduate texts in mathematics.

[10]  Mireille E. Broucke,et al.  Stabilisation of infinitesimally rigid formations of multi-robot networks , 2009, Int. J. Control.

[11]  Stergios I. Roumeliotis,et al.  Determining 3-D Relative Transformations for Any Combination of Range and Bearing Measurements , 2013, IEEE Transactions on Robotics.

[12]  Antonio Franchi,et al.  Modeling and Control of UAV Bearing Formations with Bilateral High-level Steering , 2012, Int. J. Robotics Res..

[13]  Antonio Franchi,et al.  Decentralized rigidity maintenance control with range measurements for multi-robot systems , 2013, Int. J. Robotics Res..

[14]  Vijay Kumar,et al.  Towards a swarm of agile micro quadrotors , 2012, Autonomous Robots.

[15]  Riccardo Marino,et al.  Nonlinear control design: geometric, adaptive and robust , 1995 .

[16]  P. Giordano,et al.  Rigidity theory in SE(2) for unscaled relative position estimation using only bearing measurements , 2013, 2014 European Control Conference (ECC).

[17]  G. Whelan,et al.  Cooperative search and rescue with a team of mobile robots , 1997, 1997 8th International Conference on Advanced Robotics. Proceedings. ICAR'97.

[18]  Riccardo Spica,et al.  A framework for active estimation: Application to Structure from Motion , 2013, 52nd IEEE Conference on Decision and Control.

[19]  Majid Khabbazian,et al.  Scale-Free Coordinates for Multi-robot Systems with Bearing-Only Sensors , 2012, WAFR.

[20]  Giuseppe Oriolo,et al.  Feature Depth Observation for Image-based Visual Servoing: Theory and Experiments , 2008, Int. J. Robotics Res..

[21]  Frank Dellaert,et al.  Rigid Components Identification and Rigidity Enforcement in Bearing-Only Localization using the Graph Cycle Basis , 2015 .

[22]  Antonio Franchi,et al.  A passivity-based decentralized strategy for generalized connectivity maintenance , 2013, Int. J. Robotics Res..

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

[24]  Andrea Cristofaro,et al.  Optimal trajectories for multi robot localization , 2010, 49th IEEE Conference on Decision and Control (CDC).

[25]  Antonio Franchi,et al.  Bearing-only formation control using an SE(2) rigidity theory , 2015, 2015 54th IEEE Conference on Decision and Control (CDC).

[26]  J. Hendrickx,et al.  Rigid graph control architectures for autonomous formations , 2008, IEEE Control Systems.

[27]  Vijay Kumar,et al.  Cooperative manipulation and transportation with aerial robots , 2009, Auton. Robots.

[28]  Antonio Franchi,et al.  A rigidity-based decentralized bearing formation controller for groups of quadrotor UAVs , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[29]  Peng Yang,et al.  Stability and Convergence Properties of Dynamic Average Consensus Estimators , 2006, Proceedings of the 45th IEEE Conference on Decision and Control.

[30]  Fabio Morbidi,et al.  Active Target Tracking and Cooperative Localization for Teams of Aerial Vehicles , 2013, IEEE Transactions on Control Systems Technology.