公开(公告)号：CN102654406A

公开(公告)日：2012-09-05

申请号：CN201210104322.1

申请日：2012-04-11

Applicant: 哈尔滨工程大学

Inventor： 郝燕玲 ,  杨峻巍 ,  高伟 ,  奔粤阳 ,  徐博 ,  王根 ,  陈亮 ,  郝金会 ,  刘彬 ,  刘亚龙

IPC: G01C25/00 ,  G01C21/16 ,  G01C21/20

Abstract: 本发明的目的在于提供基于非线性预测滤波与求容积卡尔曼滤波相结合的动基座初始对准方法，包括以下步骤：采集陀螺仪及加速度的输出数据；完成粗对准，初步确定载体的姿态矩阵；建立大方位失准角条件下捷联惯导系统初始对准的非线性误差模型、非线性预测滤波与求容积卡尔曼滤波相结合的非线性滤波器；载体先做匀加速直线运动，然后做匀速直线运动；进行捷联解算，同时测量载体的运动速度；取捷联解算的速度与测量的载体的运动速度作为量测量，利用、建立的非线性滤波器对三个平台误差角进行估计；利用估计出的平台误差角对此时的姿态矩阵进行修正，从而完成初始对准。本发明当海况不佳载体出现大幅晃动时，动基座初始对准对准精度高，收敛速度快。