一种高精度捷联姿态算法

本文讨论求解捷联姿态矩阵的等效矢量算法。利用ＧｏｏｄｍａｎＲｏｂｉｎｓｏｎ定理，从几何角度推导出计算等效转动矢量的公式，从而得到一种高精度捷联姿态算法。进行了数字仿真，并与四元数法、二子样、三子样、四子样算法进行了比较，结果表明，这种算法可大大减小圆锥误差，具有运算量小、精度高的优点。