Abstract
To determine the relative pose between an object and a single camera using 2D-to-3D point correspondences, a kind of iterative methods based on inverse projection ray approach is proposed. An iterative algorithm which is divided into depth recovery stage and absolute orientation stage is also proposed. In the first stage, the optimal translation vector is first computed in terms of rotation matrix via least square method, then the depths of the observed points are estimated by projecting the estimated point orthogonally to the inverse projection ray defined by the image point, and finally 3D points are reconstructed using the estimated depths from previous step. In the second stage, the optimal rotation matrix is estimated by applying Umeyama algorithm to fitting of the 3D model points and 3D estimated points. The above two stages are repeated until the result converges. The global convergence of the two-stage iterative algorithm is proven based on the global convergence theorem. Finally, a spacecraft docking application is implemented to test the effectiveness and convergence of the proposed algorithm by mathematical simulation and physical simulation.
Similar content being viewed by others
References
Philip N K, Ananthasayanam M R. Relative position and attitude estimation and control schemes for the final phase of an autonomous docking mission of spacecraft. Acta Astronaut, 2003, 52: 511–522
Wu Y H, Hu Z Y. PnP problem revisited. J Math Imag Vision, 2006, 24: 131–141
Gao X S, Hou X R, Tang J, et al. Complete solution classification for the perspective-three-point problem. IEEE Trans Patt Anal Mach Intell, 2003, 25: 930–943
Hu Z Y, Wu C F. A note on the number of solutions of the noncoplanar P4P problem. IEEE Trans Patt Anal Mach Intell, 2002, 24: 550–555
Nister D. An efficient solution to the five-point relative pose problem. IEEE Trans Patt Anal Mach Intell, 2004, 26: 756–770
Quan L, Lan Z D. Linear n-point camera pose determination. IEEE Trans Patt Anal Mach Intell, 1999, 21: 1–7
Tang J L, Chen W S, Wang J. A novel linear algorithm for P5P problem. Appl Math Comput, 2008, 205: 628–634
Ansar A, Daniilidis K. Linear pose estimation from points or lines. IEEE Trans Patt Anal Mach Intell, 2003, 25: 578–589
Kúkelová Z, Bujńák M, Pajdla T. Polynomial eigenvalue solutions to the 5-pt and 6-pt relative pose problems. In: BMVC 2008: Proceedings of the 19th British Machine Vision Conference. London: British Machine Vision Association, 2008. 565–574
Paul D F. Efficient linear solution of exterior orientation. IEEE Trans Patt Anal Mach Intell, 2001, 23: 140–148
Lepetit V, Moreno-Noguer F, Fua P. EPnP: An accurate O(n) solution to the PnP problem. Int J Comput Vision, 2009, 81: 155–166
Lee P Y, Moore J B. Gauss-Newton-on-manifold for pose estimation. J Indust Manag Opt, 2005, 1: 565–587
Dementhon D, Davis L S. Model-based object pose in 25 lines of code. Int J Comput Vision, 1995, 15: 123–141
Haralick R M, Joo H, Lee C N, et al. Pose estimation from corresponding point data. IEEE Trans Syst Man Cybernet, 1989, 19: 1426–1446
Lu C P, Hager G D, Mjolsness E. Fast and globally convergent pose estimation from video images. IEEE Trans Patt Anal Mach Intell, 2000, 22: 610–622
Schweighofer G, Pinz A. Robust pose estimation from a planar target. IEEE Trans Patt Anal Mach Intell, 2006, 28: 2024–2030
Schweighofer G, Pinz A. Globally optimal O(n) solution to the PnP problem for general camera models. In: Everingham M, Needham C J, eds. Proceedings of the 19th British Machine Vision Conference. London: BMVA Press, 2008. 1–10
Faugeras O D, Hebert M. A 3-d recognition and positioning algorithm using geometric matching between primitive surfaces. Int Robot Res, 1986, 5: 27–52
Horn B K P. Closed-form solution of absolute orientation using unit quaternion. J Opt Soc Am A, 1987, 4: 629–642
Arun K S, Huang T S, Blostein S D. Least-squares fitting of two 3-d point sets. IEEE Trans Patt Anal Mach Intell, 1987, 9: 698–700
Umeyama S. Least-squares estimation of transformation parameters between two point patterns. IEEE Trans Patt Anal Mach Intell, 1991, 13: 367–380
Luenberger D G, Ye Y Y. Linear and Nonlinear Programming. 3rd ed. New York: Springer, 2008. 201–208
Zhang S J, Cao X B. Physical simulation system for spacecraft rendezvous and docking based on microSim (in Chinese). Aerospace Control, 2006, 24: 63–67, 96
Author information
Authors and Affiliations
Corresponding author
Rights and permissions
About this article
Cite this article
Zhang, S., Cao, X., Zhang, F. et al. Monocular vision-based iterative pose estimation algorithm from corresponding feature points. Sci. China Inf. Sci. 53, 1682–1696 (2010). https://doi.org/10.1007/s11432-010-4017-6
Received:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s11432-010-4017-6