[发明专利]适用于位姿测量卡尔曼滤波的滤波器更新信息筛选方法在审
申请号: | 202210009783.4 | 申请日: | 2022-01-05 |
公开(公告)号: | CN114370870A | 公开(公告)日: | 2022-04-19 |
发明(设计)人: | 张天;赵勇;杜乔;凌川;张芳;聂智慧;傅倩;牛海涛;王强;段晓波;刘铁成;侯曾;刘伏;胡蕴琦 | 申请(专利权)人: | 中国兵器工业计算机应用技术研究所 |
主分类号: | G01C21/16 | 分类号: | G01C21/16;G06F17/18 |
代理公司: | 北京天达知识产权代理事务所(普通合伙) 11386 | 代理人: | 李明里 |
地址: | 100089*** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | 本发明涉及一种适用于位姿测量卡尔曼滤波的滤波器更新信息筛选方法,包括:持续获取并存储带有时间戳信息的IMU测量数据、IMU解算结果和外部位姿观测结果;选取最新获取的和临近的两帧外部位姿观测结果,按照时间戳最接近再选取出两帧IMU解算结果;根据外部位姿观测结果和IMU解算结果求取相对偏差;相对偏差不超出偏差阈值范围,则将最新获取外部位姿观测结果作为外部观测量,进行卡尔曼滤波器状态向量的更新;利用更新的对应时刻的卡尔曼滤波器状态向量和该时刻之后已存储的IMU测量数据重新进行捷联惯导解算,更新位姿测量结果。本发明提升位姿测量结果准确性,既保证有效的观测数据及时接入滤波器,又避免不合理的观测数据对滤波器的破坏。 | ||
搜索关键词: | 适用于 测量 卡尔 滤波 滤波器 更新 信息 筛选 方法 | ||
【主权项】:
暂无信息
下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中国兵器工业计算机应用技术研究所,未经中国兵器工业计算机应用技术研究所许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/patent/202210009783.4/,转载请声明来源钻瓜专利网。