无人机垂直通道卡尔曼滤波器:从状态空间模型到六传感器融合的数值实例本文以某无人机飞控(FCS)惯性导航状态估计器中的垂直通道(高度)滤波器为对象,系统阐述其卡尔曼滤波(EKF)的数学原理与具体实现。文章从连续时间运动方程出发,经前向欧拉离散化得到系统矩阵 AAA 与输入矩阵 BBB;随后给出预测(Predict)与修正(Correct)两步的完整方程,并以一组 6 路传感器(GNSS 速度/高度、声呐、气压计、VIO 速度/位置)的真实结构为例,代入具体数值逐步计算出新息、新息协方差、卡尔曼增益与修正后的状态与协方差,最后讨论了信任权重、偏置可观测性与协方差收缩等工程要