针对ICP算法在帧间配准中对初始值依赖性大的问题,提出了一种新的由粗到精的帧间配准改进ICP算法。算法通过泰勒展开简化相机位姿模型,利用求和思想建立粗配准模型,提高粗配准效率,运用SVD分解进行求解获得相机位姿粗估计,利用ICP算法进行迭代求解以提高算法精度。在特征提取与匹配阶段采用了预设双阈值策略,既保证了粗配准的精度,又确保ICP算法有足够的对应点。与ICP算法及现有改进算法RANSAC-ICP进行比较实验表明,该算法有效解决了上述ICP算法存在的问题,能达到与RANSAC-ICP算法相当的精度,且配准速度显著提高。
帧间配准 特征提取与匹配 frame-to-frame registration feature extraction and matching ICP ICP SVD SVD
