一种动态场景下的激光单目视觉融合定位建图方法
授权
摘要
本发明公开了一种动态场景下的激光单目视觉融合定位建图方法,该方法包括:步骤1,根据当前帧点云数据与上一帧视觉里程计预测到的位姿先验信息,以检测动态障碍物信息;步骤2,在相互标定外参的单目视觉2上形成的图像掩膜,在图像掩膜上提取ORB特征点及其与上一帧ORB特征点的匹配,再估计ORB特征点的深度,通过位姿解算获取相对位姿,并输出满足要求的关键帧信息;步骤3,将关键帧插入到共视图中,根据地图点共视程度更新该关键帧与其它关键帧的连接关系、以及生长树和词袋模型,生成新地图点,并根据当前关键帧的本质图找到相邻关键帧,构建非线性优化问题,优化关键帧的位姿和地图点;步骤4,判断每一关键帧的图像数据与当前关键帧的图像数据的相似度是否达到阈值,如果是,则判定为出现回环,替换或填补当前关键帧与回环关键帧存在冲突的地图点,再在本质图上将当前关键帧与回环关键帧连接,并更新本质图,最后进行全局BA,获得优化后的关键帧位姿、特征点地图和点云地图。本发明能够在动态场景中执行SLAM目的。
基本信息
专利标题 :
一种动态场景下的激光单目视觉融合定位建图方法
专利标题(英):
暂无
公开(公告)号 :
CN113345018A
申请号 :
CN202110604065.7
公开(公告)日 :
2021-09-03
申请日 :
2021-05-31
授权号 :
CN113345018B
授权日 :
2022-06-14
发明人 :
秦晓辉芦涛尚敬胡云卿刘海涛徐彪谢国涛秦兆博胡满江王晓伟边有钢秦洪懋丁荣军
申请人 :
湖南大学;中车株洲电力机车研究所有限公司
申请人地址 :
湖南省长沙市岳麓区麓山南路麓山门
代理机构 :
北京汇智胜知识产权代理事务所(普通合伙)
代理人 :
石辉
优先权 :
CN202110604065.7
主分类号 :
G06T7/73
IPC分类号 :
G06T7/73 G06T7/66 G06K9/46 G06K9/62 G01C22/00
相关图片
IPC结构图谱
G
G部——物理
G06
计算;推算或计数
G06T
一般的图像数据处理或产生
G06T7/10
分割;边缘检测
G06T7/70
确定物体或摄像机的姿态、方向
G06T7/73
使用基于特征的方法
法律状态
2022-06-14 :
授权
2021-09-21 :
实质审查的生效
IPC(主分类) : G06T 7/73
申请日 : 20210531
申请日 : 20210531
2021-09-03 :
公开
注:本法律状态信息仅供参考,即时准确的法律状态信息须到国家知识产权局办理专利登记簿副本。
文件下载
1、
CN113345018A.PDF
PDF下载