简介：针对采用旋转四元数误差进行的组合导航误差建模中状态方程的非线性化问题,提出一种新的惯性/天文组合姿态组合算法,以姿态加性四元数误差和陀螺漂移为状态变量,推导系统线性化状态方程,并以天文导航和惯导姿态四元数之差为量测量,建立系统量测方程,然后利用卡尔曼滤波实现对该组合模式的信息融合,仿真分析表明,所设计的基于姿态四元数误差和陀螺漂移的组合模式能够有效估计系统状态误差,姿态误差0.02°左右,验证了其有效性,可避免较为复杂的非线性滤波器的使用,为工程实践提供了理论支持。
基于加性四元数误差方程的惯性/天文姿态组合算法
