精读笔记

Problem Setting

论文研究的是 filtering-based VINS，特别是 MSCKF/EKF 框架中 landmark 表示方式对 observability consistency 的影响。VINS 的物理系统有 4 个 gauge freedom：global position 三维平移和绕重力方向的 global yaw。理想估计器不能从视觉-惯性局部测量中获得这些方向的信息；但标准 EKF 因为每次在当前估计处线性化，导致不同时刻的 Jacobian 对同一不可观变换的表达不一致，从而在不可观方向上产生虚假信息。

真正困难点不在于“知道 VINS 有四维不可观子空间”，而在于实际滤波器的状态包含当前 IMU、clones、landmarks，且各部分的线性化点不断变化。已有 consistency 方法通常把问题归因到线性化策略或误差定义：FEJ 固定第一次估计，OC 显式约束 nullspace，RI-EKF 改变误差定义。但如果 landmark 用 global frame 表示，landmark 本身也出现在 gauge transformation 里，差的 landmark 初始化会迫使 FEJ 在很差的点上长期使用 Jacobian。这形成关键矛盾：为了 consistency 要固定 landmark 线性化点；为了 accuracy 又希望使用更新后的 landmark estimate。本文切入的正是这个矛盾。

Motivation

已有路线的问题是，它们主要假设 landmark 是 global Euclidean state，然后再想办法修补由这种表示导致的 nullspace 漂移。FEJ 对 global landmarks 有效但保守，尤其 monocular 低视差或高像素噪声下，初始三角化很差，固定 landmark first estimate 会直接降低 measurement Jacobian 质量。RI-EKF 虽然能让 navigation 部分更自然，但 global landmark 的误差定义会和 navigation state 耦合，实际实现中常用 decoupled RI + FEJ landmark，仍没有摆脱 landmark FEJ。

作者看到的缺口是：anchored features 在工程系统里早已常用，但社区更多把它们视为数值稳定或远点表示问题，而不是 consistency 问题。论文的核心观察是，anchored landmark 是相对 anchor camera 的局部坐标，它不需要承载 global gauge freedom。因此 landmark 估计值变化不应该改变系统不可观方向。这一点如果成立，就意味着 parameterization 本身可以消掉最有害的一类 linearization mismatch。

Core Idea

核心思想可以概括为：不要让 landmark state 参与 global gauge transformation。global 3D landmark 表示中，若整个世界平移或绕重力旋转，landmark 坐标必须一起变化，因此不可观子空间包含 landmark 相关项。anchored 表示中，landmark 是相对于 anchor camera 的局部量；global gauge 变换同时作用在 anchor pose 和当前 pose 上，二者之间的相对几何不变，所以 landmark 参数无需变化。于是 observability nullspace 的 landmark block 变成零。

这改变的是信息组织方式，而不是增加一个后处理约束。全局表示把 feature 当成世界坐标中的实体，所有 gauge freedom 都显式作用到 feature；anchored 表示把 feature 绑定到局部参考系，global gauge freedom 被吸收到 pose graph / clone states 中。这是更好的 inductive bias：视觉测量本质上约束的是相对几何，不是全局坐标。它比在 global landmark 上强行 FEJ 更 scalable 的地方在于，landmark 可以继续使用 best estimate 计算 Jacobian，不必为 consistency 牺牲 feature 几何的线性化精度。

Method

1. Nullspace analysis：论文对包含当前 IMU state、一个 cloned anchor pose 和一个 landmark 的 VINS 状态构造局部 observability matrix，比较 global 3D 与 anchored landmark 的 nullspace。global 3D 下 landmark block 为 translation 的 I 和 yaw 的 -p×g；anchored 下 landmark block 为零。它解决的是“inconsistency 的依赖变量到底有哪些”的归因问题。

2. Anchored FEJ：由于 nullspace 不依赖 landmark state，FEJ 不必作用于 landmark；只需对 navigation / pose states 中仍出现在 nullspace 的部分使用 first estimate。它解决的是 FEJ-G3D 的精度-一致性冲突：避免在差 landmark 初始化上永久冻结 Jacobian。

3. Anchored RI-EKF：对 IMU navigation state 和 cloned poses 使用 right-invariant error，使剩余的 global translation / yaw nullspace 对 navigation estimate 也不敏感。由于 landmark block 已经为零，RI-AID 不需要像 RI-G3D 那样引入 landmark FEJ 或复杂耦合。核心变化是把 consistency enforcement 的作用域缩到 pose/navigation 子系统，而不污染 landmark 更新。

4. 实验实现基于 OpenVINS，对比 G3D 与 AID，以及 Std/FEJ/RI 三种滤波配置。这里实现本身不是贡献，重要的是同一系统中隔离 landmark parameterization 和 consistency strategy 的交互效应。

Key Insight / Why It Works

最重要的 insight 是：很多 EKF-VINS inconsistency 并不是抽象地来自“EKF 线性化不好”，而是来自 gauge freedom 被错误地分配到了状态参数中。global landmark parameterization 让 landmark 坐标承担了本不应由测量确定的全局自由度；当 landmark estimate 随更新改变时，滤波器在不同时间看到的是不同的 gauge tangent space。anchored parameterization 则把 feature 状态对齐到视觉测量真正敏感的相对几何上，使 feature 线性化点变化不再改变 gauge nullspace。

这本质上是 representation alignment / better inductive bias，而不是 scaling、更多数据或 test-time compute。AID 的收益不是因为 inverse-depth 更“高级”，而是因为 anchor-relative 表示把 unobservable global transform 从 landmark variables 中移除了。inverse-depth 还会改善远点和低视差下的数值条件，但论文真正的 theoretical contribution 与 inverse-depth 的具体形式无关，anchored Euclidean 也应有类似结论。

最可能的核心贡献是 Eq. (29) 这一类结论：anchored feature 的 nullspace landmark component 为零。FEJ-AID 和 RI-AID 是自然推论。Std-AID 已经显著好于 Std-G3D 的实验现象也支持一个强判断：在 global landmark VINS 中，最主要的虚假信息增益往往来自 landmark linearization mismatch，而不是 navigation state mismatch。navigation mismatch 仍存在，所以长轨迹上 Std-AID 还会偏乐观，但量级小很多。

辅助部分包括 RI-EKF 集成和 OpenVINS 实验。RI-AID 的理论上限更干净，但实验中相对 Std-AID 的收益并不总是大，说明在这些 benchmark 上 anchored representation 已经吃掉了主要收益；RI/FEJ 的 marginal gain 更多体现在长轨迹或更严苛一致性指标上。

Relation To Prior Work

这篇论文位于 VINS consistency / observability analysis 谱系中，直接继承 Hesch et al. 的 observability-constrained/FEJ 分析、Huang/Mourikis 的 FEJ 思路，以及 Yang et al. 的 decoupled RI-EKF。它不是提出新的 VIO pipeline，也不是新的 landmark parameterization；anchored inverse-depth 在 MSCKF 和 OpenVINS 中早已存在。

真正不同点是归因对象发生了变化。以往工作问的是：给定 global landmark state，如何通过 FEJ、OC、RI-EKF 保持正确 nullspace。本文问的是：如果 landmark 本身改成 anchor-relative state，nullspace 还依赖 landmark 吗？答案是否定的。这使 anchored features 从“工程上好用的 feature 表示”上升为“天然改善 consistency 的状态设计”。

和 robocentric VIO 的精神接近：都在减少全局坐标对局部测量的污染。但 anchored features 更局部、更容易嵌入现有 world-centric MSCKF；它没有把整个 navigation state 改成 robocentric，而是只把 map 部分局部化。和 RI-EKF 的关系是互补：RI 处理 navigation error 的 group invariance，anchored feature 处理 landmark gauge dependence。二者组合后比 RI-G3D 更干净，因为不再需要 landmark FEJ 或 coupled landmark error。

Dataset / Evaluation

评估覆盖了仿真 Monte-Carlo 和真实 TUM-VI room sequences，足以支持论文的主要 claim：anchored parameterization 在 EKF-VINS 中改善 consistency，尤其在视觉噪声大、feature 初始化差时比 global 3D 更稳。仿真部分有 NEES，因此能直接验证 consistency，而不只是看 ATE；这是必要的。真实数据部分只报告轨迹误差和 RPE，不能直接验证 covariance consistency，但能说明该设计没有只在仿真指标上成立。

实验设计比较干净：同一 OpenVINS 框架下对 G3D/AID 与 Std/FEJ/RI 做交叉对比，能看出 landmark representation 和 consistency technique 的交互。最有说服力的现象不是某个表格最佳值，而是 Std-AID 与 FEJ/RI-AID 差距很小，同时明显优于 Std-G3D；这正对应理论中的“landmark linearization mismatch 被消掉”。

局限是 benchmark 仍较窄。TUM-VI room sequences 是室内、小范围、有较好纹理和 mocap ground truth 的场景；Udel ARL 虽长，但仍是仿真。动态场景、强退化运动、弱纹理、长时间 reanchoring、在线标定误差与异常匹配的交互没有被充分覆盖。真实实验没有 NEES，也就无法直接证明 real-world consistency，只能间接看 accuracy/RPE。

Limitation

第一，anchored 表示只是消掉 landmark-state dependency，不是完全解决 EKF inconsistency。nullspace 仍依赖 navigation state；标准 AID 在长轨迹上仍会出现 NEES 偏高。因此如果 deployment 需要可信 covariance，FEJ-AID 或 RI-AID 仍有必要。

第二，问题可能被部分转移到 anchor pose 和 reanchoring。anchored landmark 的全局位置依赖 anchor pose；当 anchor 被边缘化，需要 reanchor 并更新均值/协方差。论文称开销可忽略，但文中未充分说明 reanchoring 的线性化误差是否在长期、频繁 anchor 切换或高不确定 anchor 下积累成新的 inconsistency 源。

第三，AID 的实验收益混合了 observability benefit 和 inverse-depth parameterization 的数值 benefit。作者提到 anchored Euclidean 有类似结论但省略结果，这在理论上合理，但从实证归因看仍不够完整。若要严格区分，应系统报告 anchored Euclidean、anchored inverse-depth、global inverse-depth 等变体。

第四，结论主要针对 EKF/MSCKF filter。optimization-based VIO 中 marginalization prior、relinearization、FEJ marginalization 的机制不同，anchored representation 是否同样保持优势仍是 open problem。作者也把这列为未来工作。

第五，实验没有充分覆盖在线 calibration 状态对 observability 的影响。真实实验启用了在线外参/内参标定，但理论分析没有把 calibration states 纳入 nullspace 推导；这部分增益来源不清，可能存在工程实现和参数调节的混合效应。

Takeaway

• 1. Landmark parameterization 不是中性实现细节；它会决定 gauge freedom 如何进入 EKF 线性化系统。
• 对 VINS 来说，anchor-relative map state 是比 global map state 更符合测量结构的 inductive bias。
• 2. 对 filtering VINS，如果使用 anchored features，FEJ 不应机械地冻结所有状态；landmark 可以用 best estimate，FEJ 主要作用于 navigation/clone states。
• 这一点对工程系统很有迁移价值，因为它同时保留 consistency 和 landmark Jacobian 精度。

一句话总结

这篇论文把 anchored feature 从 VINS 中常见的工程参数化提升为一种 consistency-preserving state representation，说明其真正价值在于消除 landmark 线性化点对不可观子空间的依赖，是 VINS consistency 研究从“修补滤波器”走向“设计正确状态表示”的一步。