Robust Pose Estimation With an Outlier Diagnosis Based on a Relaxation of Rigid Body Constraints

Abstract

In this paper, we propose a novel outlier diagnosis method for robust pose estimation of rigid body motions from outlier contaminated 3D point measurements. Due to incorrect correspondences in a cluttered measuring environment, observed point data are contaminated by outliers, which are unusual gross errors that lie out of an overall error distribution. Standard leastsquares methods for pose estimation are highly sensitive to outliers. For this reason, an outlier diagnosis method is developed to preprocess measured point data prior to pose estimation. This diagnosis method detects and removes outliers based on a relaxation method with rigid body constraints of a rigid body. Simulations and experiments prove the effectiveness and advantages of high breakdown point and ease of implementation.