发明公开
- 专利标题: 基于视觉惯性多传感器融合的相对定位方法及存储介质
-
申请号: CN202310908717.5申请日: 2023-07-21
-
公开(公告)号: CN116958258A公开(公告)日: 2023-10-27
- 发明人: 辜晓波 , 罗东向 , 周玉杰 , 周豪忠 , 张梦龙 , 刘霄
- 申请人: 广东工业大学 , 华南师范大学
- 申请人地址: 广东省广州市东风东路729号;
- 专利权人: 广东工业大学,华南师范大学
- 当前专利权人: 广东工业大学,华南师范大学
- 当前专利权人地址: 广东省广州市东风东路729号;
- 代理机构: 广州润禾知识产权代理事务所
- 代理商 郑永泉
- 主分类号: G06T7/73
- IPC分类号: G06T7/73 ; G06T7/246 ; G06T7/33 ; G01C21/16 ; G01C21/18
摘要:
本发明提供基于视觉惯性多传感器融合的相对定位方法及存储介质,包括:获取图像帧序列,对图像帧进行ORB特征提取与匹配,光流跟踪相邻图像帧,去除异常匹配对,得到初始旋转和平移估计;利用IMU获取加速度和角速度,对加速度和角速度进行积分,得到当前时刻的位置、速度、旋转,计算图像相邻帧的预积分增量、预积分误差的雅可比矩阵和协方差项;对陀螺仪进行校正;初始化速度、重力和尺度因子,求解待优化变量X;重力方向细化,视觉惯性对齐,将所有变量调整到惯性世界系,实现IMU预积分与视觉结构对齐,优化相机位姿;全局优化;对优化后的相机位姿进行指数滤波,实时解算出相机的位姿,实现未知环境下某段时间内运动的相对定位。