适用于位姿测量卡尔曼滤波的滤波器更新信息筛选方法
实质审查的生效
摘要
本发明涉及一种适用于位姿测量卡尔曼滤波的滤波器更新信息筛选方法,包括:持续获取并存储带有时间戳信息的IMU测量数据、IMU解算结果和外部位姿观测结果;选取最新获取的和临近的两帧外部位姿观测结果,按照时间戳最接近再选取出两帧IMU解算结果;根据外部位姿观测结果和IMU解算结果求取相对偏差;相对偏差不超出偏差阈值范围,则将最新获取外部位姿观测结果作为外部观测量,进行卡尔曼滤波器状态向量的更新;利用更新的对应时刻的卡尔曼滤波器状态向量和该时刻之后已存储的IMU测量数据重新进行捷联惯导解算,更新位姿测量结果。本发明提升位姿测量结果准确性,既保证有效的观测数据及时接入滤波器,又避免不合理的观测数据对滤波器的破坏。
基本信息
专利标题 :
适用于位姿测量卡尔曼滤波的滤波器更新信息筛选方法
专利标题(英):
暂无
公开(公告)号 :
CN114370870A
申请号 :
CN202210009783.4
公开(公告)日 :
2022-04-19
申请日 :
2022-01-05
授权号 :
暂无
授权日 :
暂无
发明人 :
张天赵勇杜乔凌川张芳聂智慧傅倩牛海涛王强段晓波刘铁成侯曾刘伏胡蕴琦
申请人 :
中国兵器工业计算机应用技术研究所
申请人地址 :
北京市海淀区车道沟10号
代理机构 :
北京天达知识产权代理事务所(普通合伙)
代理人 :
李明里
优先权 :
CN202210009783.4
主分类号 :
G01C21/16
IPC分类号 :
G01C21/16 G06F17/18
IPC结构图谱
G
G部——物理
G01
测量;测试
G01C
测量距离、水准或者方位;勘测;导航;陀螺仪;摄影测量学或视频测量学
G01C21/00
导航;不包含在G01C1/001至G01C19/00组中的导航仪器
G01C21/10
通过速度或加速度的测量
G01C21/12
在被导航的物体上进行测量;根据测量推算航位
G01C21/16
采用积分加速度或速度的方法,即惯性导航
法律状态
2022-05-06 :
实质审查的生效
IPC(主分类) : G01C 21/16
申请日 : 20220105
申请日 : 20220105
2022-04-19 :
公开
注:本法律状态信息仅供参考,即时准确的法律状态信息须到国家知识产权局办理专利登记簿副本。
文件下载
暂无PDF文件可下载