一种基于视觉惯性里程计处理的方法和相关装置

基本信息

申请号 CN202011015344.1 申请日 -
公开(公告)号 CN112129287B 公开(公告)日 2022-06-10
申请公布号 CN112129287B 申请公布日 2022-06-10
分类号 G01C21/16(2006.01)I;G06F17/12(2006.01)I 分类 测量;测试;
发明人 郭建亚;李骊 申请(专利权)人 北京华捷艾米科技有限公司
代理机构 北京集佳知识产权代理有限公司 代理人 -
地址 100193北京市海淀区东北旺西路8号院数字山谷A区1号楼5层
法律状态 -

摘要

摘要 本申请公开了一种基于视觉惯性里程计处理的方法和相关装置,该方法包括:基于视觉相机的第i个视觉帧、第i‑1个视觉帧和第i个视觉帧之间惯性测量单元IMU的测量数据进行数据预处理,获得包括视觉帧和IMU本体帧的第i个视觉惯性帧;对第i个视觉惯性帧进行基于滑动窗口的视觉惯性紧耦合优化,获得第i个视觉惯性帧的状态信息;若第i个视觉惯性帧中视觉帧为视觉失效恢复帧,进行视觉惯性重新对准;若视觉惯性重新对准成功,基于视觉失效前最后一个视觉惯性帧中IMU本体帧的速度信息、视觉惯性重新对准成功的视觉惯性帧中IMU本体帧的速度信息,获得中间的视觉惯性帧中IMU本体帧的速度信息,以调整相应的视觉惯性帧的状态信息。