- 专利标题: 一种基于RGB-D和IMU信息融合的位姿估计方法
-
申请号: CN201910250449.6申请日: 2019-03-29
-
公开(公告)号: CN109993113B公开(公告)日: 2023-05-02
- 发明人: 张磊 , 张华希 , 罗小川 , 郑国贤
- 申请人: 东北大学
- 申请人地址: 辽宁省沈阳市浑南区创新路195号
- 专利权人: 东北大学
- 当前专利权人: 东北大学
- 当前专利权人地址: 辽宁省沈阳市浑南区创新路195号
- 代理机构: 北京易捷胜知识产权代理有限公司
- 代理商 韩国胜
- 主分类号: G06V10/80
- IPC分类号: G06V10/80 ; G06V10/44 ; G06V10/46 ; G06T7/246 ; G06T7/269 ; G06T7/73 ; G01C21/16 ; G01C21/18
摘要:
本发明提供一种基于RGB‑D和IMU信息融合的位姿估计方法,包括:S1在RGB‑D相机数据和IMU数据的时间同步之后,对RGB‑D相机采集的灰度图像和深度图像以及IMU采集的加速度、角速度信息进行预处理,获取世界坐标系下相邻帧匹配的特征点和IMU状态增量;S2依据位姿估计系统的系统外参,对系统中视觉惯导装置进行初始化;S3根据初始化后的视觉惯导装置的信息和世界坐标系下相邻帧匹配的特征点、IMU状态增量构建系统的最小二乘优化函数,使用优化方法迭代求解出最小二乘优化函数的最优解,将最优解作为位姿估计状态量;进一步地,进行回环检测,获取全局一致的位姿估计状态量。由此,使得特征点深度估计更加准确,提高系统的定位精度。
公开/授权文献
- CN109993113A 一种基于RGB-D和IMU信息融合的位姿估计方法 公开/授权日:2019-07-09