一种基于点线特征的无人船双目视觉同步定位与建图方法
摘要:
本发明涉及一种基于点线特征的无人船双目视觉同步定位与建图方法,包括如下步骤:获取无人船双目摄像头采集的图像,通过特征提取得到点特征和线特征;基于所述点特征和线特征,通过与历史图像帧进行匹配,获取当前图像帧的位姿估计,实现无人船的定位;判断是否插入新的关键帧,若插入新的关键帧,基于关键帧对构建的局部地图进行束调整;通过计算关键帧间的相似性对轨迹中的环路闭合进行估计,并对轨迹进行校正;完成地图的构建。与现有技术相比,本发明具有适应性强、鲁棒性、实时性强等优点。
0/0