2. 多源状态估计基础
在进入性能评测之前，必须先厘清被评测的对象本身。多源状态估计并不是单一算法，而是一套从“状态定义”到“多源观测融合”再到“估计输出”的完整链路。只有理解这条链路上每个环节的作用与约束，后续的精度、鲁棒性、实时性评测才有明确的参照系。
一、状态估计的定义与数学本质
状态估计（State Estimation）是指：在系统真实状态无法被直接、完整测量的前提下，利用带有噪声的观测数据与系统动态模型，推断出系统在某一时刻或一段时间内的状态量。这里的“状态”通常是一组能够完整描述系统未来演化所需的最小变量集合，例如位置、速度、姿态、角速度、加速度偏置等。
从数学上看，状态估计通常建立在如下离散时间系统之上：
x_k = f(x_{k-1}, u_k) + w_k // 状态转移方程
z_k = h(x_k) + v_k // 观测方程
w_k ~ N(0, Q_k), v_k ~ N(0, R_k) // 过程噪声与观测噪声其中 x_k 为状态向量，u_k 为控制输入，z_k 为观测向量，Q_k 与 R_k 分别刻画过程噪声与观测噪声的协方差。估计的目标是求后验分布 p(x_k | z_{1:k})，或在高斯假设下求其均值与协方差。卡尔曼滤波、扩展卡尔曼滤波、无迹卡尔曼滤波、粒子滤波、因子图优化等，都是在这一框架下的不同求解策略。
二、多源信息融合的动机
单一传感器在真实系统中几乎无法同时满足精度、鲁棒性与覆盖范围的要求。摄像头在弱光与快速运动下退化，激光雷达在雨雾中散射严重，GNSS 在隧道与城市峡谷中失锁，IMU 存在随时间累积的漂移。多源融合的核心动机可以归纳为四点：
- 互补性：不同传感器在频段、量纲、误差特性上互补。IMU 高频但漂移，GNSS 低频但绝对，二者融合可兼顾短期平滑与长期无偏。
- 冗余性：多路观测对同一状态形成冗余约束，单路失效时系统仍可降级运行，提升容错能力。
- 可观测性增强：某些状态在单一观测下不可观测（如单目视觉的绝对尺度），引入第二类传感器后可恢复可观测性。
- 精度提升：在噪声独立假设下，融合后的协方差通常小于任一单源协方差，估计方差下降。
需要强调的是，融合并非“传感器越多越好”。若某传感器存在未建模的系统性偏差，或时间同步误差较大，融合反而会污染整体估计。因此，融合前必须完成标定、时间对齐与外参标定。
三、常见传感器类型与观测特性
多源状态估计中常见的传感器可按观测对象分为运动学传感器、外部定位传感器与环境感知传感器三类。下表给出典型传感器的观测内容、频率与主要误差来源，便于在评测时建立对照。
| 传感器 | 典型观测 | 频率量级 | 主要误差来源 |
|---|---|---|---|
| IMU | 角速度、比力 | 100–1000 Hz | 零偏、随机游走、温漂 |
| 轮速计 | 轮速、里程增量 | 10–100 Hz | 轮径误差、打滑、标定偏差 |
| GNSS/RTK | 绝对位置、速度 | 1–20 Hz | 多路径、遮挡、电离层延迟 |
| 激光雷达 | 点云、相对位姿 | 10–20 Hz | 运动畸变、雨雾衰减、匹配退化 |
| 相机 | 图像特征、语义 | 20–60 Hz | 光照、纹理缺失、尺度模糊 |
| 毫米波雷达 | 距离、径向速度 | 10–50 Hz | 角度分辨率低、杂波 |
从评测角度看，传感器的频率、噪声统计与失效模式直接决定了融合算法的评测指标设计。例如高频 IMU 的零偏估计误差会体现在长时间轨迹漂移上，而 GNSS 的失锁则考验系统的可观测性维持能力。
四、典型应用场景与融合结构
多源状态估计的典型场景包括：自动驾驶车辆定位、无人机导航、移动机器人 SLAM、工业设备状态监测、可穿戴人体运动捕捉等。不同场景对状态维度、实时性与鲁棒性的要求差异显著。
以自动驾驶为例，常见融合结构为“IMU + 轮速计 + GNSS + 激光雷达/相机”的松耦合或紧耦合架构。松耦合将各传感器独立解算结果送入滤波器，实现简单但信息损失较大；紧耦合直接使用原始观测构建观测方程，精度更高但计算与标定复杂度上升。下图给出一个典型的多源状态估计信号链与融合结构示意。
在该结构中，预处理与同步环节常被低估，但它直接决定融合的上限。时间戳偏差 10 ms，在 10 m/s 的运动下就会引入约 0.1 m 的位置误差；外参标定误差则会以杠杆臂形式放大到状态估计中。因此，评测多源状态估计性能时，必须把预处理链路的误差纳入考量。
五、常见误区与复盘要点
误区二：忽略时间同步。异步观测直接进入滤波器会破坏观测方程的一致性假设。
误区三：用同一组数据同时调参与评测。这会导致评测结果乐观偏差，无法反映真实泛化能力。
复盘时应重点检查：状态向量是否覆盖了所有被观测的自由度；观测模型是否与实际传感器输出一致；噪声协方差是否通过实验标定而非手工猜测；失效检测与降级策略是否在评测中被触发并记录。只有这些基础环节可靠，后续章节讨论的精度、鲁棒性、实时性指标才具有可比性。