A novel algorithm for pose estimation based on generalized orthogonal iteration with uncertainty-weighted measuring error of feature points

In this paper, we investigate the effect of anisotropic and correlated non-identical distributions of feature points’ gray level on pose estimation in stereo vision system. The generalized orthogonal iteration (GOI) algorithm for pose estimation with uncertainty-weighted measuring error of feature target is proposed. In this method, the inverse covariance matrix is applied to describe the uncertainty of feature points, and weighted contribution of uncertainty to the error objective function is analysed. By transforming the uncertainty into the covariance-weighted data space, a novel objective function based on spatial collinear error is constructed. The orthogonal iterative algorithm is extended to stereo vision system for pose estimation and the GOI algorithm is deduced, by which the optimized solution to a novel objective function is given. Finally, simulation and actual experimental results show high accuracy and strong robustness of the proposed approach, and should therefore, have potential for a variety of engineering applications.