Efficient Minimal Solvers for Relative Pose Estimation in Autonomous Driving Applications
About
With the advancement of visual sensing systems, computer vision is playing an increasingly important role in autonomous driving and robot navigation. Relative pose estimation in multi-camera systems is essential for accurate vehicle localization and environment perception, demanding high real-time performance and robustness. Existing methods, however, often involve high computational costs and rely heavily on abundant feature matches, limiting their applicability in time-sensitive driving scenarios. To address these limitations, this paper introduces a unified framework for efficient relative pose estimation, built upon a novel translation parameterization and first-order rotation approximation. Within this framework, we propose three efficient minimal solvers specifically designed for autonomous vehicles. The first solver integrates the vertical direction prior from Inertial Measurement Units (IMUs), the second utilizes the rotation axis direction prior during steering maneuvers, and the third is designed for planar motion - a realistic assumption for ground vehicles operating on structured roads. By reducing both the minimal number of point correspondences and the algebraic complexity, our methods enable faster hypothesis generation within RANSAC-based pipelines, improving suitability for real-time systems. Extensive experiments on synthetic datasets and the KITTI autonomous driving benchmark demonstrate that the proposed solvers achieve a favorable balance between speed and accuracy compared to existing state-of-the-art algorithms.
Related benchmarks
| Task | Dataset | Result | Rank | |
|---|---|---|---|---|
| Translation Direction Estimation | KITTI Sequence 00 | Median Direction Error (deg)1.1088 | 14 | |
| Translation Direction Estimation | KITTI Sequence 06 | Median Dir Error (degree)0.5544 | 14 | |
| Translation Direction Estimation | KITTI Sequence 05 | Median Translation Direction Error (degree)0.7687 | 14 | |
| Translation Direction Estimation | KITTI Sequence 01 | Median Direction Error (degree)1.2823 | 14 | |
| Translation Direction Estimation | KITTI Sequence 10 | Median Direction Error (degree)0.9462 | 14 | |
| Translation Direction Estimation | KITTI Sequence 03 | Median Translation Direction Error (degree)1.217 | 14 | |
| Translation Direction Estimation | KITTI Sequence 08 | Median Translation Direction Error1.2634 | 14 | |
| Translation Direction Estimation | KITTI sequence 09 | Median Translation Direction Error (degree)0.8708 | 14 | |
| Translation Direction Estimation | KITTI Sequence 02 | Median Direction Error (deg)1.0051 | 14 | |
| Translation Direction Estimation | KITTI Sequence 04 | Median Translation Direction Error (deg)0.6295 | 14 |