一种面向动态环境的地面辅助的视觉里程计方法

摘要

本发明公开了一种面向动态环境的地面辅助的视觉里程计方法。深度相机固定安装在地面移动机器人上，拍摄得到相邻时刻的图像；深度图像对应的三维点云提取主平面，计算地面似然参数将主平面完整合并；根据地面区域的匹配点对计算初始位姿，统计概率分布，设定动态阈值然后对非地面区域的匹配点对进行区分，联合所有静态点对优化位姿。本发明能够在地面区域较小的情况下从深度图像对应的点云中快速检测出地面，不依赖于固定阈值对外点进行区分，去除了动态角点的干扰，更加准确地估计机器人的运动轨迹。