From Correspondences to Pose: Non-minimal Certifiably Optimal Relative Pose without Disambiguation (2312.05995v2)
Abstract: Estimating the relative camera pose from $n \geq 5$ correspondences between two calibrated views is a fundamental task in computer vision. This process typically involves two stages: 1) estimating the essential matrix between the views, and 2) disambiguating among the four candidate relative poses that satisfy the epipolar geometry. In this paper, we demonstrate a novel approach that, for the first time, bypasses the second stage. Specifically, we show that it is possible to directly estimate the correct relative camera pose from correspondences without needing a post-processing step to enforce the cheirality constraint on the correspondences. Building on recent advances in certifiable non-minimal optimization, we frame the relative pose estimation as a Quadratically Constrained Quadratic Program (QCQP). By applying the appropriate constraints, we ensure the estimation of a camera pose that corresponds to a valid 3D geometry and that is globally optimal when certified. We validate our method through exhaustive synthetic and real-world experiments, confirming the efficacy, efficiency and accuracy of the proposed approach. Code is available at https://github.com/javrtg/C2P.
- Fast explicit diffusion for accelerated features in nonlinear scale spaces. In BMVC. British Machine Vision Association, 2013.
- Semidefinite relaxations for quadratically constrained quadratic programming: A review and comparisons. Mathematical programming, 129:129–157, 2011.
- Navigation using affine structure from motion. In ECCV. Springer, 1994.
- Nicolas Boumal. An introduction to optimization on smooth manifolds. Cambridge University Press, 2023.
- The non-convex burer-monteiro approach works on smooth semidefinite programs. In NeurIPS. Curran Associates, Inc., 2016.
- Convex optimization. Cambridge university press, 2004.
- G. Bradski. The OpenCV Library. Dr. Dobb’s Journal of Software Tools, 2000.
- Convex global 3d registration with lagrangian duality. In CVPR, 2017a.
- Cartan-sync: Fast and global se(d)-synchronization. IEEE RA-L, 2(4):2127–2134, 2017b.
- A Certifiably Globally Optimal Solution to the Non-Minimal Relative Pose Problem. In CVPR, 2018.
- A nonlinear programming algorithm for solving semidefinite programs via low-rank factorization. Mathematical programming, 95(2):329–357, 2003.
- A strengthened sdp relaxation for quadratic optimization over the stiefel manifold. Journal of optimization theory and applications, pages 1–20, 2023.
- Orb-slam3: An accurate open-source library for visual, visual–inertial, and multimap slam. IEEE T-R0, 37(6):1874–1890, 2021.
- On the local stability of semidefinite relaxations. Mathematical Programming, pages 1–35, 2022.
- Shonan rotation averaging: Global optimality by surfing so (p)^ n so (p) n. In ECCV, pages 292–308. Springer, 2020.
- Superpoint: Self-supervised interest point detection and description. In CVPRW, 2018.
- DKM: Dense Kernelized Feature Matching for Geometry Estimation. In CVPR, 2023a.
- RoMa: Revisiting Robust Lossses for Dense Feature Matching. arXiv preprint arXiv:2305.15404, 2023b.
- Random sample consensus: a paradigm for model fitting with applications to image analysis and automated cartography. Communications of the ACM, 24(6):381–395, 1981.
- Sdpa (semidefinite programming algorithm) user’s manual—version 6.2. 0. Department of Mathematical and Com-puting Sciences, Tokyo Institute of Technology. Research Reports on Mathematical and Computing Sciences Series B: Operations Research, 2002.
- Fast and robust certifiable estimation of the relative pose between two calibrated cameras. Journal of Mathematical Imaging and Vision, 63(8):1036–1056, 2021.
- Certifiable relative pose estimation. Image and Vision Computing, 109:104142, 2021.
- A tighter relaxation for the relative pose problem between cameras. Journal of Mathematical Imaging and Vision, 64(5):493–505, 2022.
- Matthew Peter Giamou. Semidefinite Relaxations for Geometric Problems in Robotics. PhD thesis, University of Toronto (Canada), 2023.
- Semidefinite relaxations for robust multiview triangulation. In CVPR, 2023.
- R.I. Hartley. In defense of the eight-point algorithm. IEEE TPAMI, 19(6):580–593, 1997.
- Rotation averaging. IJCV, 103:267–305, 2013.
- Global optimization through rotation space search. IJCV, 82(1):64–79, 2009.
- Multiple View Geometry in Computer Vision. Cambridge University Press, ISBN: 0521540518, second edition, 2004.
- Essential matrix estimation using gauss-newton iterations on a manifold. IJCV, 74:117–136, 2007.
- Nicholas J Higham. Matrix nearness problems and applications. Applications of matrix theory, 22, 1989.
- Matrix Analysis. Cambridge university press, 2012.
- SDPT3 — A Matlab software package for semidefinite programming, Version 1.3. Optimization Methods and Software, 11(1-4):545–581, 1999.
- Essential matrix estimation using convex relaxations in orthogonal space. In ICCV, pages 17142–17152, 2023.
- Opengv: A unified and generalized approach to real-time calibrated geometric vision. In IEEE ICRA, pages 1–8, 2014.
- Direct optimization of frame-to-frame rotation. In ICCV, 2013.
- Finding the exact rotation between two images independently of the translation. In ECCV, pages 696–709. Springer, 2012.
- Triangulation: Why optimize? In BMVC, 2019.
- Geometric interpretations of the normalized epipolar error. arXiv preprint arXiv:2008.01254, 2020.
- Hara: A hierarchical approach for robust rotation averaging. In CVPR, pages 15777–15786, 2022.
- Lightglue: Local feature matching at light speed. In ICCV, 2023.
- H Christopher Longuet-Higgins. A computer algorithm for reconstructing a scene from two projections. Nature, 293(5828):133–135, 1981.
- David G Lowe. Distinctive image features from scale-invariant keypoints. IJCV, 60:91–110, 2004.
- OpenMVG: Open multiple view geometry. In International Workshop on Reproducible Research in Pattern Recognition, pages 60–74. Springer, 2016.
- The probabilistic normal epipolar constraint for frame-to-frame rotation optimization under uncertain feature positions. In CVPR, 2022.
- Orb-slam2: An open-source slam system for monocular, stereo, and rgb-d cameras. IEEE T-R0, 33(5):1255–1262, 2017.
- Orb-slam: A versatile and accurate monocular slam system. IEEE T-R0, 31(5):1147–1163, 2015.
- D. Nister. An efficient solution to the five-point relative pose problem. IEEE TPAMI, 26(6):756–770, 2004.
- Usac: A universal framework for random sample consensus. IEEE TPAMI, 35(8):2022–2038, 2012.
- Se-sync: A certifiably correct algorithm for synchronization over the special euclidean group. The International Journal of Robotics Research, 38(2-3):95–125, 2019.
- Orbitopes. Mathematika, 57(2):275–314, 2011.
- Semidefinite descriptions of the convex hull of rotation matrices. SIAM Journal on Optimization, 25(3):1314–1343, 2015.
- Structure-from-motion revisited. In CVPR, 2016.
- Recent developments on direct relative orientation. ISPRS Journal of Photogrammetry and Remote Sensing, 60(4):284–294, 2006.
- its applications. Academic Press, New York, 14:181208, 1980.
- On benchmarking camera calibration and multi-view stereo for high resolution imagery. In CVPR, 2008.
- Jos F. Sturm. Using sedumi 1.02, a MATLAB toolbox for optimization over symmetric cones. Optimization Methods and Software, 11(1-4):625–653, 1999.
- Loftr: Detector-free local feature matching with transformers. In CVPR, 2021.
- On the quotient representation for the essential manifold. In CVPR, 2014.
- The space of essential matrices as a riemannian quotient manifold. SIAM Journal on Imaging Sciences, 10(3):1416–1445, 2017.
- PDC-Net+: Enhanced Probabilistic Dense Correspondence Network. IEEE TPAMI, 45(8):10247–10266, 2023.
- Charles F Van Loan. The ubiquitous kronecker product. Journal of computational and applied mathematics, 123(1-2):85–100, 2000.
- Semidefinite programming. SIAM review, 38(1):49–95, 1996.
- A high-performance software package for semidefinite programs: Sdpa 7. Technical report, 2010.
- A quaternion-based certifiably optimal solution to the wahba problem with outliers. In ICCV, 2019.
- Graduated non-convexity for robust spatial perception: From non-minimal solvers to global outlier rejection. IEEE RA-L, 5(2):1127–1134, 2020.
- Teaser: Fast and certifiable point cloud registration. IEEE T-R0, 37(2):314–333, 2021.
- Optimal essential matrix estimation via inlier-set maximization. In ECCV. Springer, 2014.
- Ji Zhao. An efficient solution to non-minimal case essential matrix estimation. IEEE TPAMI, 44(4):1777–1792, 2022.
- A certifiably globally optimal solution to generalized essential matrix estimation. In CVPR, 2020.