摘要
本发明实施例提供一种机动车定位及建图方法、装置及计算机可读存储介质,方法包括以下步骤:获得图像帧;从图像帧中提取三维物体的定位特征,定位特征包括特征点、特征线以及特征平面;基于定位特征构建机动车周围环境的局部场景地图;基于参考帧和当前图像帧中的定位特征的帧间重投影误差以及局部场景地图中的特征平面与当前图像帧中的特征平面的平面匹配约束求解获得机动车当前的初始位姿;对初始位姿进行优化而获得机动车当前的精确位姿;基于预设的关键帧判定条件判断当前图像帧是否为关键帧,若是则采用当前图像帧中的定位特征更新局部场景地图;以及对更新后的局部场景地图进行局部BA优化。本实施例能提高定位精度,减小地图误差。
技术关键词
定位特征
RGB彩色图像
机动车周围环境
关键帧
地图
车载摄像头
场景
可读存储介质
特征匹配跟踪
词袋模型
特征点
RANSAC算法
物体
误差函数
计算机
ORB特征
LM算法
算法模型