1. 课程导入

在状态估计与多源信息融合领域,卡尔曼滤波长期占据核心地位。然而,经典卡尔曼滤波建立在线性系统与高斯噪声假设之上,当系统呈现明显非线性时,扩展卡尔曼滤波(EKF)虽然通过一阶泰勒展开实现局部线性化,却会引入雅可比矩阵推导复杂、强非线性下精度退化、甚至滤波发散等问题。无迹卡尔曼滤波(Unscented Kalman Filter,UKF)以“近似概率分布比近似非线性函数更容易”为核心思想,通过确定性采样点(Sigma点)传播均值和协方差,避免了雅可比矩阵计算,在保持相近计算量的同时显著提升非线性估计精度。本课程围绕“无迹卡尔曼滤波融合设计”展开,共30章,从原理推导、算法实现到多传感器融合工程落地逐步深入。

一、学习目标

完成本课程后,学习者应能够达到以下目标:

  • 原理层面:理解UT变换(Unscented Transform)的数学机理,掌握Sigma点选取、权重计算与均值/协方差重构过程,能说明UKF为何能达到二阶以上近似精度。
  • 算法层面:独立推导并实现标准UKF的预测—更新递推流程,理解与EKF、粒子滤波(PF)在精度、计算量、鲁棒性上的差异。
  • 融合层面:掌握UKF在多传感器融合中的状态增广、量测异步处理、时间同步与故障容错设计方法。
  • 工程层面:能够针对IMU/GNSS组合导航、目标跟踪、电池SOC估计等场景完成参数整定、噪声协方差调优与滤波发散排查。

二、核心概念

UKF的理论基石是UT变换。其基本流程为:给定n维状态均值x̄与协方差P,构造2n+1个Sigma点,使其样本均值与样本协方差精确等于原分布;将这些点逐一通过非线性函数传播,再对传播后的点集加权求均值与协方差。权重分为均值权重Wm与协方差权重Wc,其中尺度参数α、β、κ共同决定采样点散布范围与高阶矩匹配程度。

Sigma点构造(n维状态):
  λ = α²(n + κ) − n
  X₀ = x̄
  Xᵢ = x̄ + (√((n+λ)P))ᵢ ,  i = 1…n
  Xᵢ₊ₙ = x̄ − (√((n+λ)P))ᵢ , i = 1…n

权重:
  Wm₀ = λ/(n+λ)
  Wc₀ = λ/(n+λ) + (1 − α² + β)
  Wmᵢ = Wcᵢ = 1/(2(n+λ)) , i = 1…2n

与EKF相比,UKF不需要计算雅可比矩阵,非线性函数以“黑箱”方式被调用;与PF相比,UKF不依赖大量随机粒子,计算量可控且实时性更好。因此UKF常被视为非线性高斯近似下的“性价比最优”方案。

三、整体框架

本课程的整体知识框架可分为四层:数学基础层(概率论、矩阵分解、Cholesky分解)、算法核心层(UT变换、UKF递推、平方根UKF、自适应UKF)、融合设计层(状态增广、量测融合、异步多速率、联邦滤波)、工程应用层(组合导航、目标跟踪、状态监测)。下图展示了从Sigma点采样到多源融合输出的完整信号链与数据流关系。

UKF融合设计整体框架与信号链 传感器输入 IMU / GNSS / 雷达 / 视觉 系统模型 f(x) 非线性状态方程 量测模型 h(x) 非线性观测方程 噪声统计 Q过程噪声 / R量测噪声 UT 变换核心:Sigma点采样 → 非线性传播 → 均值/协方差重构 X₀, X₁…X₂ₙ → f(Xᵢ) / h(Xᵢ) → x̄ = ΣWmᵢ·f(Xᵢ) , P = ΣWcᵢ·(f(Xᵢ)−x̄)(f(Xᵢ)−x̄)ᵀ 无需雅可比矩阵 · 二阶以上近似精度 · 计算量与EKF同阶 预测步(Time Update) Sigma点传播 → 先验均值 x̄⁻ 先验协方差 P⁻ = ΣWcᵢ·(Xᵢ⁻−x̄⁻)(Xᵢ⁻−x̄⁻)ᵀ + Q 更新步(Measurement Update) 量测Sigma点 → 预测观测 z̄⁻ 卡尔曼增益 K = Pxz·Pzz⁻¹ → 后验 x̄ , P 多源融合输出:状态估计 x̂ · 协方差 P · 残差一致性检验 · 故障检测与隔离 组合导航 · 目标跟踪 · 电池SOC · 姿态估计 · 联邦滤波架构

四、典型应用场景

UKF的工程价值在非线性强、量测异构、实时性要求高的场景中尤为突出。下表列出本课程将重点覆盖的典型场景及其关键挑战。

应用场景 状态量 非线性来源 融合传感器 关键挑战
IMU/GNSS组合导航 位置、速度、姿态、零偏 姿态四元数运动学、坐标系旋转 IMU、GNSS、磁力计 异步量测、GNSS失锁、零偏估计
雷达目标跟踪 位置、速度、加速度 极坐标—直角坐标转换 雷达、红外、ESM 机动目标、量测野值、航迹关联
锂电池SOC估计 SOC、极化电压 OCV-SOC非线性曲线、RC模型 电压、电流、温度 参数时变、温度影响、老化
无人机姿态估计 姿态角、角速度零偏 四元数微分方程 陀螺、加速度计、磁力计 振动干扰、磁干扰、快速机动

五、常见误区与学习建议

误区一:认为UKF一定优于EKF。UKF在强非线性下精度更高,但若系统接近线性,两者性能差异很小,而EKF计算更简单。选择应基于非线性程度与工程约束。

误区二:忽略参数α、β、κ的影响。α过小会导致Sigma点过于集中,数值稳定性下降;κ的取值影响高阶矩匹配。默认α=1e-3、κ=0、β=2并非万能。

误区三:协方差矩阵非正定仍强行滤波。数值误差可能使P失去正定性,导致Cholesky分解失败。应引入平方根UKF或定期对称化处理。

学习建议:先用手写推导理解UT变换的权重来源,再用Python/Matlab实现一维非线性示例验证精度,最后进入多传感器融合案例。每章配套代码与参数整定清单,建议边学边跑。