一种适用于相对位姿测量的卡尔曼滤波方法
实质审查的生效
摘要

本发明涉及一种适用于相对位姿测量的卡尔曼滤波方法,其特征在于,包括以下步骤:使用分别布置在运动载体与被测物体的两个IMU分别获取运动载体与被测物体的运动信息,并求解出的被测物体相对于运动载体的姿态数据;基于包括所述姿态数据在内的状态量,建立卡尔曼滤波的状态误差方程;根据误差传播过程,更新卡尔曼滤波的误差状态协方差矩阵;建立卡尔曼滤波的观测方程,依据外部观测传感器的观测量,更新状态协方差矩阵与状态向量;得到滤波后的被测物体与运动载体的相对位姿。本发明通过状态误差卡尔曼滤波器对载体IMU的位姿误差与零偏、相对姿态测量的位姿误差与零偏进行修正,得到高精度的被测物体与运动载体的相对位姿。

基本信息
专利标题 :
一种适用于相对位姿测量的卡尔曼滤波方法
专利标题(英):
暂无
公开(公告)号 :
CN114323011A
申请号 :
CN202210010929.7
公开(公告)日 :
2022-04-12
申请日 :
2022-01-05
授权号 :
暂无
授权日 :
暂无
发明人 :
张天王强刘鹏郭盼盼冉梓月张滨生牛海涛胡蕴琦马世纪岳普陈赞陈灿王琪贾珣王欣
申请人 :
中国兵器工业计算机应用技术研究所
申请人地址 :
北京市海淀区车道沟10号
代理机构 :
北京天达知识产权代理事务所(普通合伙)
代理人 :
李明里
优先权 :
CN202210010929.7
主分类号 :
G01C21/16
IPC分类号 :
G01C21/16  G06F17/16  
IPC结构图谱
G
G部——物理
G01
测量;测试
G01C
测量距离、水准或者方位;勘测;导航;陀螺仪;摄影测量学或视频测量学
G01C21/00
导航;不包含在G01C1/001至G01C19/00组中的导航仪器
G01C21/10
通过速度或加速度的测量
G01C21/12
在被导航的物体上进行测量;根据测量推算航位
G01C21/16
采用积分加速度或速度的方法,即惯性导航
法律状态
2022-04-29 :
实质审查的生效
IPC(主分类) : G01C 21/16
申请日 : 20220105
2022-04-12 :
公开
注:本法律状态信息仅供参考,即时准确的法律状态信息须到国家知识产权局办理专利登记簿副本。
文件下载
暂无PDF文件可下载
  • 联系电话
    电话:023-6033-8768
    QQ:1493236332
  • 联系 Q Q
    电话:023-6033-8768
    QQ:1493236332
  • 关注微信
    电话:023-6033-8768
    QQ:1493236332
  • 收藏
    电话:023-6033-8768
    QQ:1493236332