An efficient solution to the five-point relative pose problem
David Nister
Estimating 3D structure and camera motion from video feeds is vital for autonomous navigation, robotics, and automated mapping. However, traditional uncalibrated reconstruction methods struggle with geometric instability, high computational costs, and severe failure modes when viewing flat or planar environments. While pre-calibrating camera intrinsic parameters resolves many ambiguities, classical calibrated solvers either suffered from excessive mathematical complexity or lacked efficient numerical formulations suitable for real-time applications.
The article set out to develop an exact, highly efficient numerical algorithm for the classical five-point relative pose problem and demonstrate its viability as a real-time hypothesis generator within robust estimation frameworks across multiple views.
The approach derives a direct algebraic elimination method that reduces five point-correspondence constraints into a tenth-degree polynomial matching the problem's theoretical complexity. To achieve high operational speed, the solver integrates tailored linear algebra routines, including specialized matrix factorizations, Sturm sequences for root isolation, and fast triangulation. The algorithm was evaluated through numerical simulations across 100,000 synthetic trials and integrated into a random sample consensus framework tested on diverse real-world video sequences, including turntable objects, handheld imagery, vehicle trajectories, and planar scenes.
The analysis produced several critical findings. First, the solver achieved extreme numerical accuracy, exhibiting median residual errors around 1.39e-10 for generic scenes and 1.76e-10 for planar scenes. Second, the formulation generates an average of only 4.55 real roots per sample, which reduces to an average of 2.74 physically valid hypotheses once positive depth constraints are enforced. Third, individual sample evaluations executed in approximately 120 to 180 microseconds on modest 550 MHz hardware, allowing 500-sample consensus batches to complete in roughly 60 to 67 milliseconds. Finally, when extended across three or more views, the method resolves geometric ambiguities seamlessly, maintaining stable tracking through planar and near-planar scenes without requiring specialized model switching.
These findings indicate that enforcing known camera calibration directly at the hypothesis stage significantly improves both execution speed and tracking robustness. By eliminating the need for complex uncalibrated initialization and costly global optimization steps, systems can achieve low-latency metric reconstructions at high frame rates. In end-to-end demonstrations, the pipeline sustained 26 frames per second on a standard 2.4 GHz processor.
Organizations developing real-time vision systems for robotics, autonomous vehicles, and mapping should adopt this five-point solver within multi-view consensus frameworks to handle generic and planar terrains reliably. Teams should implement the specialized root-finding and matrix decomposition techniques highlighted in the article to minimize processing overhead.
The technique assumes that camera intrinsic parameters are known or approximately fixed, and extreme inaccuracies in assumed focal lengths will distort the reconstructed geometry. While the mathematical and experimental results provide high confidence in the solver's numerical stability and speed, broader operational deployment requires paired feature detection pipelines capable of maintaining sufficient tracking quality under severe noise or rapid motion.
- Paper: A Flexible New Technique for Camera Calibration, Zhengyou Zhang (2000). Establishes practical camera calibration routines that determine the intrinsic parameters required by Nistér's calibrated five-point relative pose formulation.
- Paper: Shape and motion from image streams under orthography: a factorization method, Carlo Tomasi et al. (1992). Introduces foundational factorization principles for recovering 3D shape and camera motion from multiple image feature tracks.
- Paper: Least-Squares Fitting of Two 3-D Point Sets, K. S. Arun et al. (1987). Presents the classic closed-form SVD derivation for estimating rigid transformations between corresponding point sets that underpins geometric camera motion analysis.
- Paper: Least-Squares Estimation of Transformation Parameters Between Two Point Patterns, S. Umeyama (1991). Refines closed-form singular-value decomposition solvers for point pattern transformation estimation by strictly enforcing proper rotation matrices.
- Paper: An Iterative Image Registration Technique with an Application to Stereo Vision, B. D. Lucas et al. (1981). Provides the seminal gradient-guided feature tracking and registration technique essential for generating the sparse 2D point correspondences fed into relative pose solvers.
- Paper: Structure-from-Motion Revisited, Johannes L. Schönberger et al. (2016). Integrates minimal-sample geometric hypothesis solvers within a comprehensive, state-of-the-art structure-from-motion pipeline (COLMAP).
- Paper: Modeling the World from Internet Photo Collections, Noah Snavely et al. (2008). Applies minimal relative-pose estimators within robust multi-view RANSAC and bundle adjustment workflows to reconstruct massive Internet photo collections.
- Paper: ORB-SLAM: A Versatile and Accurate Monocular SLAM System, Raul Mur-Artal et al. (2015). Deploys efficient calibrated pose estimation and geometric model verification inside a real-time monocular SLAM system.
- Paper: ORB-SLAM3: An Accurate Open-Source Library for Visual, Visual–Inertial, and Multimap SLAM, Carlos Campos et al. (2020). Extends real-time visual pose estimation into a unified multi-map visual-inertial SLAM library supporting various camera geometries.
- Paper: Building Rome in a day, Sameer Agarwal et al. (2009). Scales structure-from-motion algorithms relying on pairwise geometric verification to city-scale image collections via distributed computing.
- Paper: Direct Sparse Odometry, Jakob Engel et al. (2016). Develops direct visual odometry that contrasts with feature-based minimal pose solvers by optimizing photometric error directly across image gradients.
- Paper: MonoSLAM: Real-Time Single Camera SLAM, Andrew J. Davison et al. (2007). Implements real-time single-camera probabilistic tracking and mapping, building upon fundamental calibrated motion estimation principles.
- Paper: SuperGlue: Learning Feature Matching With Graph Neural Networks, Paul-Edouard Sarlin et al. (2020). Enhances feature correspondence quality for geometric hypothesis generators like the five-point solver using graph neural networks and optimal transport.
- Paper: PoseNet: A Convolutional Network for Real-Time 6-DOF Camera Relocalization, Alex Kendall et al. (2015). Replaces traditional multi-view algebraic pose solvers with an end-to-end convolutional neural network for direct 6-DoF camera relocalization.
- Paper: Unsupervised Learning of Depth and Ego-Motion from Video, Tinghui Zhou et al. (2017). Learns relative camera ego-motion and depth unsupervised from monocular video, offering a learning-based alternative to exact algebraic geometric solvers.