一种基于双模型切换的二次传递对准方法
Abstract:
本发明提供一种基于双模型切换的二次传递对准方法,包括以下步骤:主惯导系统采用固定频率向子惯导系统发送导航参数,子惯导系统利用主惯导的导航参数完成粗对准;子惯导系统基于主惯导系统导航参数构造观测量;在四元数误差模型下使用扩展卡尔曼滤波进行迭代解算,待失准角缩小到一预设角度α时,进行滤波切换,然后在欧拉角误差模型下使用标准卡尔曼滤波进行迭代解算,直到失准角估计值收敛且稳定;利用估计出的失准角来修正子惯导系统的姿态矩阵,得到捷联初始姿态矩阵,以完成二次传递对准。本发明的方法同时具备了线性模型滤波收敛速度快,精度高,非线性模型使用范围广的优点,同时可满足系统快速性,精确性,健壮性的要求。
Public/Granted literature
Patent Agency Ranking
0/0