• 专利标题: 一种基于新型鲁棒广义高阶容积卡尔曼滤波的传递对准方法
  • 专利标题(英): Novel robust generalized high-order cubature kalman filter-based transfer alignment method
  • 申请号: CN201810715555.2
    申请日: 2018-07-03
  • 公开(公告)号: CN108759870A
    公开(公告)日: 2018-11-06
  • 发明人: 高伟王凯张亚王岩岩张悦
  • 申请人: 哈尔滨工业大学
  • 申请人地址: 黑龙江省哈尔滨市西大直街92号
  • 专利权人: 哈尔滨工业大学
  • 当前专利权人: 哈尔滨工业大学
  • 当前专利权人地址: 黑龙江省哈尔滨市西大直街92号
  • 主分类号: G01C25/00
  • IPC分类号: G01C25/00
一种基于新型鲁棒广义高阶容积卡尔曼滤波的传递对准方法
摘要:
本发明公开了一种基于新型鲁棒广义高阶容积卡尔曼滤波的传递对准方法。首先,考虑到系统的非线性,采用速度加姿态加角速度匹配方式,建立传递对准非线性数学模型。其次,主、子惯导分别进行惯导解算,主惯导的速度和姿态信息传输到子惯导的导航计算机,利用主、子惯导系统之间的速度误差、姿态误差和角速度误差构造观测量。然后,基于广义高阶容积卡尔曼滤波时间更新获得一步状态预测值和协方差,利用新息卡方检测方法对观测量受污染的程度进行判断,若判断结果超过了预设门限,则舍弃该部分观测量,跳过观测量重构过程和滤波更新过程;若判断结果未超过预设门限,则利用Huber方法对受污染观测量进行重构。最后,利用重构后的观测量进行量测更新,估计当前时刻的状态值和协方差,从而实现传递对准。本发明解决了观测量中存在混合高斯噪声和野值情况下的舰船快速高精度对准问题。
0/0