基于几何约束的位姿测量方法

Abstract

The pose estimation method based on geometric constraints is studied. The coordinates of the five feature points in the camera coordinate system are calculated to obtain the pose of an object on the basis of the geometric constraints formed by the connective lines of the feature points and the coordinates of the feature points on the CCD image plane; during the solution process, the scaling and orthography projection model is used to approximate the perspective projection model. The initial values of the coordinates of the five feature points in the camera coordinate system are obtained to ensure the accuracy and convergence rate of the non-linear algorithm. In accordance with the perspective projection characteristics of the circular feature landmarks, we propose an approach that enables the iterative acquisition of accurate target poses through the correction of the perspective projection coordinates of the circular feature landmark centers. Experimental results show that the translation positioning accuracy reaches ±0.05 mm in the measurement range of 0-40 mm, and the rotation positioning accuracy reaches ±0.06o in the measurement range of 4o-60o.