Graduated Non-Convexity for Robust Spatial Perception: From Non-Minimal Solvers to Global Outlier Rejection
arXiv:1909.08605 · doi:10.1109/LRA.2020.2965893
Abstract
Semidefinite Programming (SDP) and Sums-of-Squares (SOS) relaxations have led to certifiably optimal non-minimal solvers for several robotics and computer vision problems. However, most non-minimal solvers rely on least-squares formulations, and, as a result, are brittle against outliers. While a standard approach to regain robustness against outliers is to use robust cost functions, the latter typically introduce other non-convexities, preventing the use of existing non-minimal solvers. In this paper, we enable the simultaneous use of non-minimal solvers and robust estimation by providing a general-purpose approach for robust global estimation, which can be applied to any problem where a non-minimal solver is available for the outlier-free case. To this end, we leverage the Black-Rangarajan duality between robust estimation and outlier processes (which has been traditionally applied to early vision problems), and show that graduated non-convexity (GNC) can be used in conjunction with non-minimal solvers to compute robust solutions, without requiring an initial guess. Although GNC's global optimality cannot be guaranteed, we demonstrate the empirical robustness of the resulting robust non-minimal solvers in applications, including point cloud and mesh registration, pose graph optimization, and image-based object pose estimation (also called shape alignment). Our solvers are robust to 70-80% of outliers, outperform RANSAC, are more accurate than specialized local solvers, and faster than specialized global solvers. We also propose the first certifiably optimal non-minimal solver for shape alignment using SOS relaxation.
arXiv comment10 pages, 5 figures, published at IEEE Robotics and Automation Letters (RA-L), 2020, Best Paper Award in Robot Vision at ICRA 2020
References in corpus (7)
- Past, Present, and Future of Simultaneous Localization And Mapping: Towards the Robust-Perception Age
- Graduated Non-Convexity for Robust Spatial Perception: From Non-Minimal Solvers to Global Outlier Rejection
- Guaranteed Outlier Removal for Point Cloud Registration with Correspondences
- Sparse Representation for 3D Shape Estimation: A Convex Relaxation Approach
- Modeling Perceptual Aliasing in SLAM via Discrete-Continuous Graphical Models
- A Polynomial-time Solution for Robust Registration with Extreme Outlier Rates
- CvxPnPL: A Unified Convex Solution to the Absolute Pose Estimation Problem from Point and Line Correspondences
Cited by in corpus (57)
- Graduated Non-Convexity for Robust Spatial Perception: From Non-Minimal Solvers to Global Outlier Rejection
- Swarm-SLAM : Sparse Decentralized Collaborative Simultaneous Localization and Mapping Framework for Multi-Robot Systems
- The Revisiting Problem in Simultaneous Localization and Mapping: A Survey on Visual Loop Closure Detection
- Semantics for Robotic Mapping, Perception and Interaction: A Survey
- Towards Collaborative Simultaneous Localization and Mapping: a Survey of the Current Research Landscape
- DCL-SLAM: A Distributed Collaborative LiDAR SLAM Framework for a Robotic Swarm
- Point Cloud Registration for LiDAR and Photogrammetric Data: a Critical Synthesis and Performance Analysis on Classic and Deep Learning Algorithms
- Beyond Robustness: A Taxonomy of Approaches towards Resilient Multi-Robot Systems
- An Efficient Solution to Non-Minimal Case Essential Matrix Estimation
- TEASER: Fast and Certifiable Point Cloud Registration
- RANSIC: Fast and Highly Robust Estimation for Rotation Search and Point Cloud Registration using Invariant Compatibility
- Optimal and Robust Category-level Perception: Object Pose and Shape Estimation from 2D and 3D Semantic Keypoints
- TriVoC: Efficient Voting-based Consensus Maximization for Robust Point Cloud Registration with Extreme Outlier Ratios
- Optimal Pose and Shape Estimation for Category-level 3D Object Perception
- RANSAC Back to SOTA: A Two-stage Consensus Filtering for Real-time 3D Registration
- Safe and Smooth: Certified Continuous-Time Range-Only Localization
- Advancing Mixture Models for Least Squares Optimization
- Improving Self-Consistency in Underwater Mapping Through Laser-Based Loop Closure (Extended)
- MULLS: Versatile LiDAR SLAM via Multi-metric Linear Least Square
- Distributed Adaptive Gradient Algorithm with Gradient Tracking for Stochastic Non-Convex Optimization
- CLIPPER+: A Fast Maximal Clique Algorithm for Robust Global Registration
- Monocular visual simultaneous localization and mapping: (r)evolution from geometry to deep learning-based pipelines
- Self-Supervised Domain Calibration and Uncertainty Estimation for Place Recognition
- DynaVINS++: Robust Visual-Inertial State Estimator in Dynamic Environments by Adaptive Truncated Least Squares and Stable State Recovery
- An Addendum to NeBula: Towards Extending TEAM CoSTAR's Solution to Larger Scale Environments
- On Semidefinite Relaxations for Matrix-Weighted State-Estimation Problems in Robotics
- An Adaptive Graduated Nonconvexity Loss Function for Robust Nonlinear Least Squares Solutions
- GMCR: Graph-based Maximum Consensus Estimation for Point Cloud Registration
- Multi-Robot Decentralized Collaborative SLAM in Planetary Analogue Environments: Dataset, Challenges, and Lessons Learned
- Kimera-Multi: a System for Distributed Multi-Robot Metric-Semantic Simultaneous Localization and Mapping
- IRON: Invariant-based Highly Robust Point Cloud Registration
- Gaussian Process Based Message Filtering for Robust Multi-Agent Cooperation in the Presence of Adversarial Communication
- A Certifiable Algorithm for Simultaneous Shape Estimation and Object Tracking
- Fast and Robust Certifiable Estimation of the Relative Pose Between Two Calibrated Cameras
- Robust Self-Tuning Data Association for Geo-Referencing Using Lane Markings
- Kimera-Multi: Robust, Distributed, Dense Metric-Semantic SLAM for Multi-Robot Systems
- One Ring to Rule Them All: Certifiably Robust Geometric Perception with Outliers
- Multiview Point Cloud Registration via Optimization in an Autoencoder Latent Space
- CLIPPER: Robust Data Association without an Initial Guess
- ROBIN: a Graph-Theoretic Approach to Reject Outliers in Robust Estimation using Invariants
- A Comparison of Robust Kalman Filters for Improving Wheel-Inertial Odometry in Planetary Rovers
- A Dynamical Perspective on Point Cloud Registration
- FracGM: A Fast Fractional Programming Technique for Geman-McClure Robust Estimator
- In Perfect Shape: Certifiably Optimal 3D Shape Reconstruction from 2D Landmarks
- An Inexact Projected Gradient Method with Rounding and Lifting by Nonlinear Programming for Solving Rank-One Semidefinite Relaxation of Polynomial Optimization
- Advances in Inference and Representation for Simultaneous Localization and Mapping
- IPC: Incremental Probabilistic Consensus-based Consistent Set Maximization for SLAM Backends
- GNSS Outlier Mitigation Via Graduated Non-Convexity Factor Graph Optimization
- Dynamical Pose Estimation
- Escaping Poor Local Minima in Large Scale Robust Estimation
- Globally optimal consensus maximization for robust visual inertial localization in point and line map
- Self-supervised Geometric Perception
- A Graduated Filter Method for Large Scale Robust Estimation
- 3D Foundation Model-Based Loop Closing for Decentralized Collaborative SLAM
- ICOS: Efficient and Highly Robust Rotation Search and Point Cloud Registration with Correspondences
- On the Robustness of Multi-View Rotation Averaging
- DANIEL: A Fast and Robust Consensus Maximization Method for Point Cloud Registration with High Outlier Ratios