一种通用视觉SLAM方法
基本信息
申请号 | CN202111490931.0 | 申请日 | - |
公开(公告)号 | CN114111818A | 公开(公告)日 | 2022-03-01 |
申请公布号 | CN114111818A | 申请公布日 | 2022-03-01 |
分类号 | G01C21/32(2006.01)I | 分类 | 测量;测试; |
发明人 | 付世沫;常青;王耀力 | 申请(专利权)人 | 太原供水设计研究院有限公司 |
代理机构 | 西安亿诺专利代理有限公司 | 代理人 | 贺珊 |
地址 | 030000山西省太原市杏花岭区北大街109号5层501、502 | ||
法律状态 | - |
摘要
摘要 | 本发明涉及一种通用视觉SLAM方法,方法如下:首先,双目相机与IMU以紧耦合方式进行数据融合得到姿态信息;其次,当卫星定位系统信号不可用时,以IMU预测姿态信息,作为预测状态;当卫星定位系统信号可用时,以IMU和卫星定位系统通过扩展卡尔曼滤波EKF方法以松耦合方式进行数据融合后再预测姿态信息,作为预测状态;然后,利用EKF通过观测状态去更新预测状态得到新的姿态信息;最后,以新的姿态信息和双目相机生成的图像特征深度图构建地图,完成SLAM算法。本发明提供了一种IMU与卫星定位系统辅助的通用视觉SLAM方法,适于搭载在人类背负系统以及无里程计的机器人系统,在室内外均可使用,满足复杂场景下需求。 |
