一种基于旋转矩阵单位四元数分解的运动估计算法

本文基于旋转矩阵单位四元数分解定理,提出一种由3D特征点空间位置估计运动参数的算法。单位四元数表示旋转矩阵时不存在奇异点,故基于单位四元数的运动估计方法具有更大的实用价值,而本文算法无需Horn(1987)和Su等人(1989)提出的单位四元数方法的迭代运算。本文给出了解的唯一性分析和模拟实验结果,可见其性能是令人满意的。

AN ALGORITHM OF MOTION ESTIMATION BASED ON UNIT QUATERNION DECOMPOSITION OF THE ROTATION MATRIX

Based on the unit quaternion decomposition of rotation matrix, this paper puts forward an algorithm to estimate motion parameters from the space position vectors of 3D feature points. Rotation matrix's representation with the unit quaternion has no singular points, so the unit quaternion-based estimation method is of more practical importance, and the algorithm in this paper does not need iteration computation compared to those unit quaternion-based method proposed by Horn(1987) and Su, et al.(1989). Solution's uniqueness analysis of the algorithm and simulation experiment results are also presented, it can be seen that performance of the proposed method is satisfactory.