一种基于视觉-IMU-轮速计融合的语义SLAM方法
基本信息
申请号 | CN202110218495.5 | 申请日 | - |
公开(公告)号 | CN113052855B | 公开(公告)日 | 2021-11-02 |
申请公布号 | CN113052855B | 申请公布日 | 2021-11-02 |
分类号 | G06T7/11(2017.01)I;G06T7/215(2017.01)I;G01C21/16(2006.01)I;G06N3/04(2006.01)I;G06N3/08(2006.01)I;G06N7/00(2006.01)I | 分类 | 计算;推算;计数; |
发明人 | 李威;李晓馨;朴松昊;陈立国 | 申请(专利权)人 | 苏州迈思捷智能科技有限公司 |
代理机构 | 淮安市科文知识产权事务所 | 代理人 | 李锋 |
地址 | 215325江苏省苏州市昆山市周庄镇崇远路181号 | ||
法律状态 | - |
摘要
摘要 | 本发明涉及计算机视觉技术领域,公开了一种基于视觉‑IMU‑轮速计融合的语义SLAM方法,将视觉测量、IMU测量和轮速计测量融合,并使用非线性优化方法来最大化后验概率,以求解最优的状态估计。然后将估计出的每帧图像位姿、对应得深度图以及2D语义分割结果输入到3D建图模块中,以构建全局3D语义网格地图。路面状况信息通过2D语义分割结果传递给SLAM前端的定位模块,并根据小车前方路面状况、IMU与轮速计预测位置误差以及IMU与轮速计测量值之间的对准误差来判断当前小车的运动是否异常,如异常,则主动从状态估计方程中删除当前帧对应的轮速计的预积分测量值,以提高复杂场景中姿态估计的鲁棒性。 |
