初始姿态最优估计方法

摘要

本发明涉及惯性导航技术领域，公开了一种初始姿态最优估计方法。其中，该方法包括：计算重力矢量在体坐标系下的测量值和重力矢量在参考坐标系下的测量值基于测量值和测量值计算损失函数构造矩阵K；计算损失函数构造矩阵K的特征值λi和特征向量qi；根据特征值λi和特征向量qi计算扩展矩阵H及其伴随矩阵H*；基于伴随矩阵H*得到初始姿态最优解。由此，能够有效提高单位置条件下的初始姿态估计精度。