一种基于车辆运动学约束的视觉惯性SLAM系统初始化方法
基本信息
| 申请号 | CN202110329164.9 | 申请日 | - |
| 公开（公告）号 | CN113074754A | 公开（公告）日 | 2021-07-06 |
| 申请公布号 | CN113074754A | 申请公布日 | 2021-07-06 |
| 分类号 | G01C25/00（2006.01）I | 分类 | 测量；测试; |
| 发明人 | 张培志;余卓平;蒋屹晨;王晓;史戈松 | 申请（专利权）人 | 上海智能新能源汽车科创功能平台有限公司 |
| 代理机构 | 上海科盛知识产权代理有限公司 | 代理人 | 宣慧兰 |
| 地址 | 201805上海市嘉定区安亭镇曹安公路4801号208室-1 | ||
| 法律状态 | - | ||
摘要
| 摘要 | 本发明涉及一种基于车辆运动学约束的视觉惯性SLAM系统初始化方法，具体包括以下步骤：S1、获取基于视觉图像估计的单目视觉位姿估计、基于惯导数据的惯导预积分和基于车辆底盘数据的车辆运动学预积分；S2、单目视觉位姿估计与车辆运动学预积分对齐，恢复系统尺度；S3、惯导预积分与车辆运动学预积分对齐，计算得到惯导陀螺仪偏置的初值、惯导加速度计偏置及重力矢量的初值，完成视觉惯性SLAM系统的初始化。与现有技术相比，本发明具有提高视觉惯性SLAM系统初始化的准确性和稳定性、避免参数估计结果发散等优点。 |
