- 专利标题: 行人运动约束的视觉惯性融合定位与建图方法和装置
-
申请号: CN202211123604.6申请日: 2022-09-15
-
公开(公告)号: CN115235454A公开(公告)日: 2022-10-25
- 发明人: 潘献飞 , 涂哲铭 , 陈昶昊 , 张礼廉 , 褚超群 , 陈宗阳 , 毛军 , 王茂松
- 申请人: 中国人民解放军国防科技大学
- 申请人地址: 湖南省长沙市开福区德雅路109号
- 专利权人: 中国人民解放军国防科技大学
- 当前专利权人: 中国人民解放军国防科技大学
- 当前专利权人地址: 湖南省长沙市开福区德雅路109号
- 代理机构: 长沙国科天河知识产权代理有限公司
- 代理商 邱轶
- 主分类号: G01C21/00
- IPC分类号: G01C21/00 ; G01C21/16 ; G06T7/73 ; G06T7/55
摘要:
本申请涉及一种行人运动约束的视觉惯性融合定位与建图方法和装置。所述方法包括:对足绑式IMU进行因子图建模,得到因子图,根据足绑式IMU的速度预测值以及零速之间的误差,构建零速修正因子;根据视觉惯性里程计观测的位置信息与足绑式IMU观测的位置信息,构建视觉惯性里程计因子;将零速修正因子和视觉惯性里程计因子作为状态变量的约束条件,对因子图进行优化,得到优化因子图;根据视觉传感器采集的图像数据以及通过足绑式IMU的零速检测结果,筛选关键帧图像,根据关键帧图像进行稠密重建,得到建图结果;对优化因子图和建图结果进行融合,实现行人运动的定位与建图。采用本方法能够复杂环境下的行人导航定位与建图。
公开/授权文献
- CN115235454B 行人运动约束的视觉惯性融合定位与建图方法和装置 公开/授权日:2022-12-30