基于李群描述的捷联惯性导航解算方法

摘要

本发明公开了基于李群描述的捷联惯性导航解算方法，采用李群描述代替传统四元数算法中的四元数描述进行捷联解算，将姿态矩阵和载体速度构建成SE(3)群，通过对惯性敏感器件采集到的数据积分用来对SE(3)群进行迭代更新。本发明直接对姿态矩阵进行计算，可以有效避免传统四元数捷联解算过程中由于四元数描述而产生的非唯一性问题和归一化计算过程，并且省略了传统四元数捷联解算过程中四元数和姿态矩阵之间相互转换的计算过程，避免了转换计算所带来的不可避免的误差，在确保解算精度的同时减少了计算量，在实际工程中具有良好的应用前景。