Measurement Scheduling for Cooperative Localization in Resource-Constrained Conditions

This letter studies the measurement scheduling problem for a group of $N$ mobile robots moving on a flat surface that are preforming cooperative localization (CL). We consider a scenario in which due to the limited on-board resources such as battery life and communication bandwidth only a given number of relative measurements per robot are allowed at observation and update stage. Optimal selection of which teammates a robot should take a relative measurement from such that the updated joint localization uncertainty of the team is minimized is an NP-hard problem. In this paper, we propose a suboptimal greedy approach that allows each robot to choose its landmark robots locally in polynomial time. Our method, unlike the known results in the literature, does not assume full-observability of CL algorithm. Moreover, it does not require inter-robot communication at scheduling stage. That is, there is no need for the robots to collaborate to carry out the landmark robot selections. We discuss the application of our method in the context of an state-of-the-art decentralized CL algorithm and demonstrate its effectiveness through numerical simulations. Even though our solution does not come with rigorous performance guarantees, its low computational cost along with no communication requirement makes it an appealing solution for operations with resource constrained robots.

[1]  Stergios I. Roumeliotis,et al.  Optimal sensor scheduling for resource-constrained localization of mobile robot formations , 2006, IEEE Transactions on Robotics.

[2]  Solmaz S. Kia,et al.  A Loosely Coupled Cooperative Localization Augmentation to Improve Human Geolocation in Indoor Environments , 2018, 2018 International Conference on Indoor Positioning and Indoor Navigation (IPIN).

[3]  Min Chen,et al.  Supermodular mean squared error minimization for sensor scheduling in optimal Kalman Filtering , 2017, 2017 American Control Conference (ACC).

[4]  Keith Yu Kit Leung,et al.  The UTIAS multi-robot cooperative localization and mapping dataset , 2011, Int. J. Robotics Res..

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

[6]  Wolfram Burgard,et al.  Recursive decentralized localization for multi-robot systems with asynchronous pairwise communication , 2018, Int. J. Robotics Res..

[7]  William H. Press,et al.  Numerical Recipes 3rd Edition: The Art of Scientific Computing , 2007 .

[8]  Jonathan P. How,et al.  A resource-aware approach to collaborative loop-closure detection with provable performance guarantees , 2019, Int. J. Robotics Res..

[9]  Shreyas Sundaram,et al.  Sensor selection for Kalman filtering of linear dynamical systems: Complexity, limitations and greedy algorithms , 2017, Autom..

[10]  Ryan M. Eustice,et al.  Decentralized Extended Information Filter for Single-Beacon Cooperative Acoustic Navigation: Theory and Experiments , 2013, IEEE Transactions on Robotics.

[11]  Titus Cieslewski,et al.  Data-Efficient Decentralized Visual SLAM , 2017, 2018 IEEE International Conference on Robotics and Automation (ICRA).

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

[13]  J. Bather,et al.  Tracking and data fusion , 2001 .

[14]  Ankur Mehta,et al.  Optimal Scheduling for Resource-Constrained Multirobot Cooperative Localization , 2018, IEEE Robotics and Automation Letters.

[15]  Sonia Martínez,et al.  Cooperative Localization for Mobile Agents: A Recursive Decentralized Algorithm Based on Kalman-Filter Decoupling , 2015, IEEE Control Systems.

[16]  W. Marsden I and J , 2012 .

[17]  Matthew R. Walter,et al.  Consistent cooperative localization , 2009, 2009 IEEE International Conference on Robotics and Automation.

[18]  V. Caglioti,et al.  Cooperative, distributed localization in multi-robot systems: a minimum-entropy approach , 2006, IEEE Workshop on Distributed Intelligent Systems: Collective Intelligence and Its Applications (DIS'06).

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

[20]  D. Harville Matrix Algebra From a Statistician's Perspective , 1998 .

[21]  Lichuan Zhang,et al.  Multi AUVs Cooperative Navigation Based on Information Entropy , 2018, OCEANS 2018 MTS/IEEE Charleston.

[22]  Keith Y. K. Leung,et al.  Cooperative Localization and Mapping in Sparsely-Communicating Robot Networks , 2012 .

[23]  K. V. S. Hari,et al.  Accurate indoor positioning of firefighters using dual foot-mounted inertial sensors and inter-agent ranging , 2014, 2014 IEEE/ION Position, Location and Navigation Symposium - PLANS 2014.

[24]  George J. Pappas,et al.  Scheduling nonlinear sensors for stochastic process estimation , 2017, 2017 American Control Conference (ACC).

[25]  Solmaz S. Kia,et al.  Cooperative Localization Under Limited Connectivity , 2019, IEEE Transactions on Robotics.

[26]  George J. Pappas,et al.  Near-optimal sensor scheduling for batch state estimation: Complexity, algorithms, and limits , 2016, 2016 IEEE 55th Conference on Decision and Control (CDC).

[27]  Sonia Martínez,et al.  Server-Assisted Distributed Cooperative Localization Over Unreliable Communication Links , 2018, IEEE Transactions on Robotics.