Abstract:Accurate and robust state estimation is critical for autonomous navigation of robot teams. This task is especially challenging for large groups of size, weight, and power (SWAP) constrained aerial robots operating in perceptually-degraded GPS-denied environments. We can, however, actively increase the amount of perceptual information available to such robots by augmenting them with a small number of more expensive, but less resource-constrained, agents. Specifically, the latter can serve as sources of perceptual information themselves. In this paper, we study the problem of optimally positioning (and potentially navigating) a small number of more capable agents to enhance the perceptual environment for their lightweight,inexpensive, teammates that only need to rely on cameras and IMUs. We propose a numerically robust, computationally efficient approach to solve this problem via nonlinear optimization. Our method outperforms the standard approach based on the greedy algorithm, while matching the accuracy of a heuristic evolutionary scheme for global optimization at a fraction of its running time. Ultimately, we validate our solution in both photorealistic simulations and real-world experiments. In these experiments, we use lidar-based autonomous ground vehicles as the more capable agents, and vision-based aerial robots as their SWAP-constrained teammates. Our method is able to reduce drift in visual-inertial odometry by as much as 90%, and it outperforms random positioning of lidar-equipped agents by a significant margin. Furthermore, our method can be generalized to different types of robot teams with heterogeneous perception capabilities. It has a wide range of applications, such as surveying and mapping challenging dynamic environments, and enabling resilience to large-scale perturbations that can be caused by earthquakes or storms.

Spectral Sparsification for Communication-Efficient Collaborative Rotation and Translation Estimation

Robust And Accurate Multiple-Camera Pose Estimation Toward Robotic Applications

Globally Optimal Consensus Maximization for Robust Visual Inertial Localization in Point and Line Map.

Stereo Vision Based SLAM Using Rao-Blackwellised Particle Filter

Collaborative Robot Mapping using Spectral Graph Analysis

Active Collaborative Localization in Heterogeneous Robot Teams

Multi-Irreducible Spectral Synchronization for Robust Rotation Averaging

Local Optimized and Scalable Frame-to-model SLAM

Spectral Measurement Sparsification for Pose-Graph SLAM

Pushing the Envelope of Rotation Averaging for Visual SLAM

A framework for collaborative multi-robot mapping using spectral graph wavelets

Hybrid Rotation Averaging: A Fast and Robust Rotation Averaging Approach

Distributed Multi-Robot SLAM Algorithm with Lightweight Communication and Optimization

Guaranteed Globally Optimal Planar Pose Graph and Landmark SLAM via Sparse-Bounded Sums-of-Squares Programming

Active Rendezvous for Multi-Robot Pose Graph Optimization using Sensing over Wi-Fi

Communication- and Computation-Efficient Distributed Decision-Making in Multi-Robot Networks

Riemannian Optimization for Active Mapping with Robot Teams

Robust Camera Translation Estimation via Rank Enforcement

Distributed Optimization in Sensor Network for Scalable Multi-Robot Relative State Estimation

SlideSLAM: Sparse, Lightweight, Decentralized Metric-Semantic SLAM for Multi-Robot Navigation

Distributed Certifiably Correct Pose-Graph Optimization