MEMS捷联惯导自适应SCKF滤波的初始对准方法

    公开(公告)号:CN103557864A

    公开(公告)日:2014-02-05

    申请号:CN201310528761.X

    申请日:2013-10-31

    CPC classification number: G01C25/005 G01C21/16 G01C21/20

    Abstract: 本发明公开了一种MEMS捷联惯导自适应SCKF滤波的初始对准方法,本发明采用GPS确定载体的初始位置信息,采集MEMS加速度计和磁强计输出的数据,采用解析法完成粗对准,粗略地得到捷联矩阵;然后建立基于MEMS的捷联惯导系统初始对准的非线性模型,进行滤波的初始化;然后利用平方根CKF进行状态估计,在每次迭代时利用状态估计量与一次预测状态量之差,对系统噪声方差阵进行更新,增强滤波对系统噪声统计特性不确定的自适应能力;然后得到精确地平台失准角校正系统的姿态矩阵,从而完成初始对准;本发明可以在陀螺仪常值漂移较大时也能较好的完成初始对准,并且增强了滤波对系统噪声统计特性不确定的自适应能力。

Patent Agency Ranking