一种基于地磁梯度张量的四元数卡尔曼滤波姿态估计方法

摘要

本发明属于水下地磁辅助导航领域，具体涉及到一种基于地磁梯度张量的四元数卡尔曼滤波姿态估计方法。本发明包括：设定初始参数值；采集载体运动过程中陀螺及磁强计的输出数据作为量测量；测量地理系下地磁梯度张量；测量载体系下地磁梯度张量；进行状态更新；估计k时刻的状态；估计k时刻的状态。本发明提出的一种基于地磁梯度张量的Cubature卡尔曼滤波姿态估计方法对姿态角的估计精度比传统Cubature卡尔曼滤波算法高出数倍，而且通过三轴磁通门磁强计测量获取量测值y_k的方法具有价格低廉的潜在优势。