论文部分内容阅读
针对磁力计易受干扰和陀螺仪易漂移的问题,使用扩展卡尔曼滤波EKF（Extended Kalman Filter）融合多源传感器进行定向。利用基于四元数的EKF,在当地磁场和重力加速度的基础上融合加速度计、陀螺仪和磁力计观测信息,并通过自适应算法构建过程噪声向量和观测噪声向量的协方差矩阵以解决载体运动和周围磁场干扰对重力和地磁场观测值的影响。实验结果表明,该算法可以有效地减弱陀螺仪漂移和磁场对定向的干扰,获得更加精确和稳定的航向角信息。