精读笔记

Problem Setting

论文《A Smart-Scheduled Hybrid EKF-FGO State Estimation》（arXiv preprint / 2026）实际解决的是 hybrid state estimation 中一个经常被忽略的系统层问题：全局优化应该以什么频率介入递归滤波。这里的关键矛盾是，中间时刻需要低延迟、稳定的在线估计，但全局一致性修正又需要较重的 batch optimisation。EKF 可以每步运行，但会累积线性化和传播误差；FGO 可以修正轨迹和地图的一致性，但不能无限频繁地运行。以前方法往往把优化频率埋在 sliding window、incremental update 或 backend 实现里，而不是把它作为独立变量来分析。本文真正的问题不是设计更强的 SLAM backend，而是隔离回答：在 solver 结构和迭代预算固定时，schedule 本身对漂移和成本的影响有多大。

Motivation

已有路线不够的地方不在于缺少 EKF 或 FGO，而在于缺少对二者时间组织方式的系统理解。incremental smoothing 关注如何让每次优化更便宜，sliding-window 关注如何限制变量规模，EKF-SLAM 关注递归估计的一致性；但这些路线通常默认某个更新节奏。作者的观察是，很多实际系统的性能瓶颈并不只来自单次优化复杂度，也来自优化被调用得太频繁或太晚。关键缺口是：优化 schedule 对 pre-optimisation drift、final accuracy 和 amortized compute 的影响没有被干净地剥离出来。本文因此选择一个刻意简化的 hybrid EKF-FGO 框架，把 W 作为主要实验变量。

Core Idea

核心思想是把 hybrid estimator 视为一个 test-time compute allocation 问题：EKF 提供连续、便宜但局部的 belief propagation；FGO 提供间歇、昂贵但全局一致的 correction；schedule W 决定全局 correction 注入系统的频率。这个视角改变的不是概率模型本身，而是信息流的时间结构。优化不再被看作每步默认动作，而是一个可稀疏调用的资源。

直觉上它可能有效，是因为 EKF 已经能在短到中等时间尺度内控制漂移增长；FGO 的边际收益在过高频率下可能递减。因此只要 EKF propagation 足够稳定，许多频繁 batch optimisation 是冗余的。本文试图利用这种不对称：降低优化频率带来近似线性的/快速计算节省，而漂移可能只缓慢增加。这更像一种 compute scheduling / memory reuse 的 inductive bias，而不是新的 inference algorithm。

Method

方法的必要机制可以压缩为三点。

第一，EKF 每步运行，解决的是优化间隔内不能没有在线估计的问题。它给系统提供低延迟状态和协方差，是中间漂移受控的主要来源。没有这一步，baseline 只能依赖 motion model / odometry propagation，pre-optimisation drift 自然更大。

第二，周期性 FGO 每 W 步运行，解决的是长期一致性和 accumulated error correction 的问题。作者固定 GN 迭代次数，使 W 的效果不被 solver effort 混淆。这里的核心变化是把 batch optimisation 从持续后台过程变成离散资源注入。

第三，把 EKF belief 作为 Gaussian prior factor 加入当前 pose，并在优化后重置 EKF。这个机制解决 filter 和 optimiser 之间的信息断裂：EKF 不只是给初始化，FGO 也不只是离线修正，而是二者通过 prior 和 reinitialisation 形成闭环。需要注意的是，这也可能引入信息重复使用或过度自信的问题，文中未充分说明。

Key Insight / Why It Works

这篇最有价值的 insight 是：在 hybrid estimator 里，最终精度和中间精度不是同一个问题。只要最终或周期性 batch optimisation 足够纠正轨迹，final ATE 可能对 W 不敏感；但机器人实际运行时关心的 pre-optimisation drift 会强烈依赖 W。这个区分是合理且可迁移的，尤其对实时系统比只报告 final ATE 更有意义。

方法有效的主要原因很可能不是 EKF prior factor 的新颖性，而是 EKF propagation 本身已经大幅优于 odometry-only propagation。换句话说，论文展示的 70–90% drift reduction 很大程度是在比较“有 measurement update 的 EKF propagation”和“无 filtering 的 odometry propagation”。schedule 的贡献则体现在发现一个 operating regime：W 增大时成本迅速下降，而 EKF 控制下的漂移增长较慢。

这本质上属于 test-time compute scheduling + memory reuse，而不是新的 latent structure 或 representation learning。FGO 的作用是稀疏地注入全局一致性，EKF 的作用是保存短期在线 belief。所谓 Smart-Scheduled 在当前版本里并不 smart：W 是固定扫描参数，没有基于不确定性、innovation 或任务风险的自适应策略。因此核心贡献更像是一个受控实验观察，而不是算法突破。

需要警惕的归因问题：文中没有充分分离 EKF prior、EKF reinitialisation、窗口长度、优化频率和 baseline propagation 差异各自的贡献。若 classical FGO baseline between optimisation events 只用 motion model，而 hybrid 用完整 EKF measurement updates，那么结果并不能说明“schedule + FGO prior”本身有多强，只说明在线滤波对中间 drift 很重要。

Relation To Prior Work

这篇工作最接近 hybrid filtering-smoothing、fixed-lag smoothing、sliding-window SLAM 和 incremental smoothing 的系统设计谱系。与 iSAM2 / Bayes tree 这类工作不同，它不试图降低单次增量优化复杂度，也不改变量消元或重线性化策略；它假设 batch optimiser 给定，然后研究多久调用一次。与 fixed-lag smoother 不同，它的关注点不是窗口内边缘化的一致性，而是 schedule 对中间误差和 amortized compute 的影响。

看似新的部分——EKF belief 作为 Gaussian prior、优化后重置 filter、周期性 batch correction——本身都不是新思想，属于已有 hybrid estimator 的常见组合。实质新增的信息是把这些机制放在一个固定 solver effort 的框架中，把 W 作为显式自变量，并引入 pre-optimisation drift 来衡量 schedule 的实际在线影响。也就是说，它的贡献更偏 experimental characterization / design-space analysis，而不是 estimator theory 或 backend innovation。

Dataset / Evaluation

评估非常受控，也非常窄。只有仿真 planar SLAM、固定圆形轨迹、固定半径和曲率、固定噪声模型，没有真实机器人、没有多场景、没有复杂动态、没有回环结构变化、没有长时地图增长压力。这样的设置适合隔离 schedule 变量，但不足以验证方法在一般 SLAM/VIO/robot deployment 中的有效性。

实验确实支持一个有限 claim：在这个圆轨迹仿真下，增大 W 可以显著降低平均优化成本，而 hybrid 的 pre-optimisation drift 仍远低于 odometry-only baseline，final ATE 基本不变。但它没有充分支持更强 claim，例如“scheduling 是普适关键维度”“EKF-FGO prior coupling 比已有 hybrid smoother 更优”或“该策略可直接扩展到真实复杂系统”。benchmark 更像 sanity check，而不是 stress test。

Limitation

第一，方法成立依赖 EKF 在优化间隔内足够稳定且线性化误差可控。一旦进入高非线性、高曲率、弱观测、强遮挡或错误数据关联场景，pre-optimisation drift 可能不再缓慢增长，非对称 trade-off 可能消失。

第二，scalability 上限没有被真正测试。论文说 full graph / window graph optimisation，但实验没有展示长轨迹、大规模 landmark、复杂稀疏结构下的变量增长、边缘化误差或内存压力。成本下降可能主要来自调用频率降低，而不是方法在大规模图上的结构性可扩展。

第三，α 固定为 0.5，但 EKF prior strength 是非常关键的耦合参数。α 太小会让可能不一致的 EKF belief 过度支配 FGO；α 太大则 prior 接近无效。文中未充分说明其敏感性，也没有讨论 EKF covariance inconsistency 对 prior factor 的影响。

第四，可能存在信息双计数。EKF belief 已经由同一 motion / measurement 数据递归形成，而 FGO 又使用相同数据构图，再加入 EKF prior。如果没有严格的信息管理，这个 prior 并不一定是独立约束。文中没有给出一致性分析。

第五，baseline 设计偏弱。odometry-only pre-optimisation drift 与 hybrid EKF drift 的比较，会天然放大 hybrid 优势；更有说服力的 baseline 应包括 fixed-lag smoother、iSAM2 不同 relinearization schedule、EKF-only、FGO with better initialisation、以及相同 online measurement update 但无 EKF prior 的版本。

第六，“smart scheduled”命名过强。当前 schedule 是固定周期扫描，不是智能调度；真正的 smart scheduling 应该是 event-triggered / uncertainty-aware / resource-aware。

Takeaway

• 1. 对实时 SLAM / state estimation，pre-optimisation drift 比 final ATE 更能反映 schedule 的系统价值；只看最终轨迹误差会掩盖在线运行风险。
• 2. 优化频率是一个独立且值得显式调的 design axis。
• 即使不改 backend，只改变 test-time compute 的时间分配，也可能得到很大的效率收益。
• 3. 最值得迁移的 insight 是“局部 filter 负责短期稳定，全局 optimiser 稀疏纠偏”，并且二者之间要有显式状态反馈；这可迁移到 VIO、multi-sensor fusion、在线 mapping 和 resource-constrained robotics。

一句话总结

这篇论文不是提出新 SLAM 算法，而是把 hybrid EKF-FGO 中的 batch optimisation frequency 明确化为 test-time compute scheduling 变量，并用受控仿真说明其对中间漂移与计算成本的非对称权衡。