An Accurate and Real-time Relative Pose Estimation from Triple Point-line Images by Decoupling Rotation and Translation (2403.11639v1)
Abstract: Line features are valid complements for point features in man-made environments. 3D-2D constraints provided by line features have been widely used in Visual Odometry (VO) and Structure-from-Motion (SfM) systems. However, how to accurately solve three-view relative motion only with 2D observations of points and lines in real time has not been fully explored. In this paper, we propose a novel three-view pose solver based on rotation-translation decoupled estimation. First, a high-precision rotation estimation method based on normal vector coplanarity constraints that consider the uncertainty of observations is proposed, which can be solved by Levenberg-Marquardt (LM) algorithm efficiently. Second, a robust linear translation constraint that minimizes the degree of the rotation components and feature observation components in equations is elaborately designed for estimating translations accurately. Experiments on synthetic data and real-world data show that the proposed approach improves both rotation and translation accuracy compared to the classical trifocal-tensor-based method and the state-of-the-art two-view algorithm in outdoor and indoor environments.
- R. J. Holt and A. N. Netravali, “Motion and structure from line correspondences: Some further results,” International Journal of Imaging Systems and Technology, vol. 5, no. 1, pp. 52–61, 1994.
- R. Gomez-Ojeda, F.-A. Moreno, D. Zuniga-Noël, D. Scaramuzza, and J. Gonzalez-Jimenez, “Pl-slam: A stereo slam system through the combination of points and line segments,” IEEE Transactions on Robotics, vol. 35, no. 3, pp. 734–746, 2019.
- H. Wei, F. Tang, Z. Xu, and Y. Wu, “Structural regularity aided visual-inertial odometry with novel coordinate alignment and line triangulation,” IEEE Robotics and Automation Letters, vol. 7, no. 4, pp. 10613–10620, 2022.
- S. Liu, Y. Yu, R. Pautrat, M. Pollefeys, and V. Larsson, “3d line mapping revisited,” in Proceedings of the IEEE/CVF Conference on Computer Vision and Pattern Recognition, pp. 21445–21455, 2023.
- Y. He, J. Zhao, Y. Guo, W. He, and K. Yuan, “Pl-vio: Tightly-coupled monocular visual–inertial odometry using point and line features,” Sensors, vol. 18, no. 4, p. 1159, 2018.
- H. Wei, F. Tang, Z. Xu, C. Zhang, and Y. Wu, “A point-line vio system with novel feature hybrids and with novel line predicting-matching,” IEEE Robotics and Automation Letters, vol. 6, no. 4, pp. 8681–8688, 2021.
- Y. Liu, T. S. Huang, and O. D. Faugeras, “Determination of camera location from 2-d to 3-d line and point correspondences,” IEEE Transactions on pattern analysis and machine intelligence, vol. 12, no. 1, pp. 28–37, 1990.
- A. Vakhitov, L. Ferraz, A. Agudo, and F. Moreno-Noguer, “Uncertainty-aware camera pose estimation from points and lines,” in Proceedings of the IEEE/CVF Conference on Computer Vision and Pattern Recognition, pp. 4659–4668, 2021.
- R. Fabbri, T. Duff, H. Fan, M. H. Regan, D. d. C. d. Pinho, E. Tsigaridas, C. W. Wampler, J. D. Hauenstein, P. J. Giblin, B. Kimia, et al., “Trplp-trifocal relative pose from lines at points,” in Proceedings of the IEEE/CVF Conference on Computer Vision and Pattern Recognition, pp. 12073–12083, 2020.
- D. Nistér, “An efficient solution to the five-point relative pose problem,” IEEE transactions on pattern analysis and machine intelligence, vol. 26, no. 6, pp. 756–770, 2004.
- H. Stewenius, C. Engels, and D. Nistér, “Recent developments on direct relative orientation,” ISPRS Journal of Photogrammetry and Remote Sensing, vol. 60, no. 4, pp. 284–294, 2006.
- L. Kneip, R. Siegwart, and M. Pollefeys, “Finding the exact rotation between two images independently of the translation,” in Computer Vision–ECCV 2012: 12th European Conference on Computer Vision, Florence, Italy, October 7-13, 2012, Proceedings, Part VI 12, pp. 696–709, Springer, 2012.
- L. Kneip and S. Lynen, “Direct optimization of frame-to-frame rotation,” in Proceedings of the IEEE International Conference on Computer Vision, pp. 2352–2359, 2013.
- D. Muhle, L. Koestler, N. Demmel, F. Bernard, and D. Cremers, “The probabilistic normal epipolar constraint for frame-to-frame rotation optimization under uncertain feature positions,” in Proceedings of the IEEE/CVF Conference on Computer Vision and Pattern Recognition, pp. 1819–1828, 2022.
- C. L. Lawson, “Contribution to the theory of linear least maximum approximation,” Ph. D. dissertation. Univ. Calif., 1961.
- C.-K. Chng, A. Parra, T.-J. Chin, and Y. Latif, “Monocular rotational odometry with incremental rotation averaging and loop closure,” in 2020 Digital Image Computing: Techniques and Applications (DICTA), pp. 1–8, IEEE, 2020.
- A. Concha, M. Burri, J. Briales, C. Forster, and L. Oth, “Instant visual odometry initialization for mobile ar,” IEEE Transactions on Visualization and Computer Graphics, vol. 27, no. 11, pp. 4226–4235, 2021.
- Y. He, B. Xu, Z. Ouyang, and H. Li, “A rotation-translation-decoupled solution for robust and efficient visual-inertial initialization,” in Proceedings of the IEEE/CVF Conference on Computer Vision and Pattern Recognition, pp. 739–748, 2023.
- R. Hartley and A. Zisserman, Multiple view geometry in computer vision. Cambridge university press, 2003.
- B. Guan, P. Vasseur, and C. Demonceaux, “Trifocal tensor and relative pose estimation from 8 lines and known vertical direction,” in 2022 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 6001–6008, IEEE, 2022.
- P. Hruby, T. Duff, A. Leykin, and T. Pajdla, “Learning to solve hard minimal problems,” in Proceedings of the IEEE/CVF Conference on Computer Vision and Pattern Recognition, pp. 5532–5542, 2022.
- Y. Ding, C.-H. Chien, V. Larsson, K. Åström, and B. Kimia, “Minimal solutions to generalized three-view relative pose problem,” in Proceedings of the IEEE/CVF International Conference on Computer Vision, pp. 8156–8164, 2023.
- A. Morgan, Solving polynomial systems using continuation for engineering and scientific problems. SIAM, 2009.
- T. Duff, K. Kohn, A. Leykin, and T. Pajdla, “Plmp-point-line minimal problems in complete multi-view visibility,” in Proceedings of the IEEE/CVF International Conference on Computer Vision, pp. 1675–1684, 2019.
- R. Fabbri, T. Duff, H. Fan, M. H. Regan, D. d. C. de Pinho, E. Tsigaridas, C. W. Wampler, J. D. Hauenstein, P. J. Giblin, B. Kimia, et al., “Trifocal relative pose from lines at points,” IEEE Transactions on Pattern Analysis and Machine Intelligence, 2022.
- Z. Xu, H. Wei, F. Tang, Y. Zhang, Y. Wu, G. Ma, S. Wu, and X. Jin, “Plpl-vio: a novel probabilistic line measurement model for point-line-based visual-inertial odometry,” in 2023 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS), pp. 5211–5218, IEEE, 2023.
- J. K. Uhlmann, Dynamic map building and localization: new theoretical foundations. PhD thesis, University of Oxford, 1995.
- Q. Cai, L. Zhang, Y. Wu, W. Yu, and D. Hu, “A pose-only solution to visual reconstruction and navigation,” IEEE Transactions on Pattern Analysis and Machine Intelligence, vol. 45, no. 1, pp. 73–86, 2021.
- R. I. Hartley, “In defense of the eight-point algorithm,” IEEE Transactions on pattern analysis and machine intelligence, vol. 19, no. 6, pp. 580–593, 1997.
- M. A. Fischler and R. C. Bolles, “Random sample consensus: a paradigm for model fitting with applications to image analysis and automated cartography,” Communications of the ACM, vol. 24, no. 6, pp. 381–395, 1981.
- A. Geiger, P. Lenz, and R. Urtasun, “Are we ready for autonomous driving? the kitti vision benchmark suite,” in 2012 IEEE conference on computer vision and pattern recognition, pp. 3354–3361, IEEE, 2012.
- M. Burri, J. Nikolic, P. Gohl, T. Schneider, J. Rehder, S. Omari, M. W. Achtelik, and R. Siegwart, “The euroc micro aerial vehicle datasets,” The International Journal of Robotics Research, vol. 35, no. 10, pp. 1157–1163, 2016.
- E. Rosten and T. Drummond, “Machine learning for high-speed corner detection,” in Computer Vision–ECCV 2006: 9th European Conference on Computer Vision, Graz, Austria, May 7-13, 2006. Proceedings, Part I 9, pp. 430–443, Springer, 2006.
- B. D. Lucas and T. Kanade, “An iterative image registration technique with an application to stereo vision,” in IJCAI’81: 7th international joint conference on Artificial intelligence, vol. 2, pp. 674–679, 1981.
- R. G. Von Gioi, J. Jakubowicz, J.-M. Morel, and G. Randall, “Lsd: A line segment detector,” Image Processing On Line, vol. 2, pp. 35–55, 2012.
- L. Zhang and R. Koch, “An efficient and robust line segment matching approach based on lbd descriptor and pairwise geometric consistency,” Journal of visual communication and image representation, vol. 24, no. 7, pp. 794–805, 2013.