基于李群乘性卡尔曼滤波的捷联惯导系统运动初始对准方法

摘要

本发明公开了基于李群滤波的运动状态下捷联惯性导航对准方法，采用李群描述代替传统四元数描述实现对SINS姿态变换的计算，对利用李群和捷联惯导系统的特性构建的新系统进行分析，并根据李群中特殊正交群的性质定义的误差旋转矩阵，建立了基于误差状态的线性初始对准模型，利用凯莱变换恒等地映射到向量空间进行滤波。最后将误差补偿，得到姿态矩阵的最优估计。该方法避免了避免奇异值分解法的大失准角下的奇异点问题和传统四元数方法的非线性近似带来的精度问题；利用误差作为状态量进行估计并对误差进行补偿，状态相关误差得以减小，提高了对准精度。更适合于实际工程应用。