捷联惯性导航、制导系统中方向余弦矩阵的递推算法

数十年来，四元数及其解法成功地应用于捷联惯性导航和制导系统中，成为经典的算法。它定义了从导航坐标系到飞行器体坐标系的四元数，然后给出四元数更新方程，再根据实时确定的四元数求出体系到导航坐标系的方向余弦矩阵，以便将测得的体系的视速度增量转换到导航系。从制导和导航角度看，上述方向余弦矩阵是必不可少的，而四元数却是中间变量，因此，本文跨越了四元数及其算法，根据方向余弦矩阵微分方程直接导出方向余弦矩阵的更新递推公式。数学仿真表明该算法的精度与四元数算法接近，但它具有更容易理解、计算量小、编程简单等优点，可以代替四元数方法。