一种新的捷联惯性导航系统姿态四元数方程求解方法

为了解决传统四元数算法计算精度不高的问题,借鉴三子样旋转矢量法的求解过程,提出了一种新的四元数微分方程求解方法——三子样四元数法。三子样四元数法结合四元数微分方程求解旋转四元数的高阶导数,用抛物线拟合载体的角速度并给出角增量形式的计算公式,再根据旋转四元数泰勒展开式建立求解模型。仿真结果表明,当三子样四元数法取到9阶时,整体结果优于三子样旋转矢量法。