Computation of Spatial Displacements from Redundant Geometric Features

Abstract

This paper follows a previous one on the computation of spatial displacements (Ravani and Ge, 1993). The first paper dealt with the problem of computing spatial displacements from a minimum number of simple features of points, lines, planes, and their combinations. The present paper deals with the same problem using a redundant set of the simple geometric features. The problem for redundant information is formulated as a least squares problem which includes all simple features. A Clifford algebra is used to unify the handling of various feature information. An algorithm for determining the best orientation is developed which involves finding the eigenvector associated with the least eigenvalue of a 4 × 4 symmetric matrix. The best translation is found to be a rational cubic function of the best orientation. Special cases are discussed which yield the best orientation in closed form. In addition, simple algorithms are provided for automatic generation of body-fixed coordinate frames from various feature information. The results have applications in robot and world model calibration for off-line programming and computer vision.