前言 在GNSS/INS组合定位中,初始航向角的精度对滤波收敛很重要,如果初始航向角误差很大,不仅会导致滤波器收敛速度慢,还有可能导致滤波直接发散,因此就有了大方位失准角下的航向初始化方式,在实际工程应用中很有帮助。 对严龚敏的这篇《低精度的SINS/GPS组合导航系统中初始航向角对准技术》论文中的公式进行整理,方便日后应用。 一、公式推导 1、公式推导 2、初始航向角: 二、参考文献 [1] 严龚敏<低精度的SINS/GPS组合导航系统中初始航向角对准技术>