一种避免欧拉转换奇异导致精度下降的地面静态对准方法

摘要

本发明公开了一种避免欧拉转换奇异导致精度下降的地面静态对准方法，包括如下步骤：将惯组陀螺角速率和加表比力转换到准北东地坐标系；基于陀螺计算的角增量，利用四元数乘法修正准北东地坐标系；基于加表计算的加速度，利用最小二乘估计失准角；基于失准角和粗对准姿态角，利用四元数乘法计算精对准角度。本发明基于粗对准姿态角建立的准北东地坐标系进行精对准，并基于四元数乘法计算精对准四元数，生成高精度对准角度，避免了欧拉转换奇异导致精度下降的问题。该地面静态对准算法简单，易于工程应用。