一种视觉辅助惯性差分位姿测量系统

基本信息

申请号 CN202210035732.9 申请日 -
公开(公告)号 CN114383612A 公开(公告)日 2022-04-22
申请公布号 CN114383612A 申请公布日 2022-04-22
分类号 G01C21/16(2006.01)I;G01S19/47(2010.01)I 分类 测量;测试;
发明人 王强;刘铁成;张天;唐昳;牛海涛;段晓波;傅倩;刘伏;胡蕴琦;马超;徐丹;马世纪;岳普;陈赞 申请(专利权)人 中国兵器工业计算机应用技术研究所
代理机构 北京天达知识产权代理事务所(普通合伙) 代理人 李明里
地址 100089北京市海淀区车道沟10号
法律状态 -

摘要

摘要 本发明涉及一种视觉辅助惯性差分位姿测量系统,包括:测量单元,以及与测量单元连接的运动载具IMU、被测物体IMU和视觉单元;运动载具IMU和被测物体IMU用于获取运动载具和被测物体的运动信息;视觉单元用于获取被测物体相对于运动载具的视觉位姿数据;测量单元,接收运动载具和被测物体的运动信息,进行双IMU差分获得的载体坐标系下被测物体相对载体的惯性位姿数据;接收视觉位姿数据;并以视觉位姿数据为外部观测量对包括惯性位姿数据在内的状态数据进行卡尔曼滤波,输出滤波后的被测物体与运动载具的相对位姿数据。本发明充分利用惯性测姿采样频率高、短时精度高,视觉测姿无累积误差的特性,实现高精度的位姿追踪。