基于特征点辅助匹配的虚拟宽视角视觉里程计方法及系统

摘要

本发明提供了一种基于特征点辅助匹配的虚拟宽视角视觉里程计方法及系统，包括：原图像通过常速运动模型进行运动预测，预测目前相机的位姿，得到新图像，并对原图像进行特征点选取；根据提取的特征点，通过光流法对原图像与新图像进行特征匹配，得到相同一点在两个图像中的匹配关系；利用单应性矩阵和/或基础矩阵进行异常匹配点对剔除，再使用PnP算法和从历史关键帧中获取的深度信息计算出当前相机的位姿；计算整体所有梯度点的像素误差，根据得到的当前相机的位姿通过高斯牛顿下降法进行优化光度误差，最终得到优化好的相机精准位置姿态；通过本发明可以有效增强在相机旋转的时候的特征点跟踪效果，使得系统整体更加鲁棒。