A direct least squares method for camera pose estimation based on straight line segment correspondences

作者：Li Xin; Zhang Yueqiang; Liu Jinbo; Zhang Xiaohu; Yu Qifeng

来源：Acta Optica Sinica, 2015, 35(6): 0615003.

DOI：10.3788/AOS201535.0615003

• Camera pose estimation
• Least squares methods
• Least squares solutions
• Optimal solutions
• Optimality conditions
• Polynomial equation
• Quadratic cost functions
• Straight-line segments

In order to estimate the camera pose from straight line segment correspondences in high precision, a direct least squares solution is proposed. A straight line segment distance measurement which integrates distance between endpoints, midpoints, angle and lengths of two line segments is proposed and used to transform the original problem into minimize a quadratic cost function of pose rotation matrix. A modified cost function based on the CGR parameters of rotation matrix is minimized, which the optimality conditions form a system of three third-order polynomial equations. Algebraic method is used to solve this system directly without requiring iterations, and the globally optimal solution of rotation matris is obtained. The complexity of proposed method is O(n). The efficiency and high precision are demonstrated by synthesized and real data experiments.

• 出版日期2015