基于地磁梯度张量矩阵正交对角化的水下全姿态确定方法

摘要

本发明属于水下地磁辅助导航技术领域，具体涉及一种基于地磁梯度张量矩阵正交对角化的水下全姿态确定方法。本发明通过地磁梯度张量矩阵的对角化和特征向量的正交归一化处理，得到姿态矩阵，从而确定水下载体的姿态。本发明无积累误差且具有很好的隐蔽性，能较为准确地反演出载体的姿态角信息，且稳定性好，对姿态角初始解的要求不高，姿态确定完全自主，计算量也较小，更适用于大初始姿态误差下水下载体的全姿态确定。