精读笔记

Problem Setting

《Derivations of Error-State Kalman Filter Kinematics for Globally Applicable Aided Inertial Navigation Systems》（arXiv preprint / 2026）处理的是全球尺度 aided INS 的 error-state 建模问题，而不是局部机器人导航常见的平地、常重力、非旋转世界近似。真正困难点是：地球自转、曲率、ECEF 绝对位置、NED frame transport rate、重力非均匀性、IMU bias 和 Lie-group error representation 同时进入后，误差动力学不再是简单的局部 SE_2(3) textbook form。

以前方法的卡点在于两条文献线彼此脱节：经典惯导给出 geodetic/NED 的 Pinson error model，但 trajectory-dependent 且坐标奇异；invariant EKF/ESKF 给出 group-affine 的漂亮理论，但多数讨论是在局部、常重力或简化地球模型下。关键矛盾是：全球导航需要物理上正确的地球模型，而 invariant filtering 的好处依赖对称性；越真实的全球模型，越容易破坏这种对称性。

Motivation

作者要补的缺口不是“再发明一个 ESKF”，而是把同一个全球惯导问题在四种误差定义下展开到可实现的 F/G/H/reset 级别。这个缺口很实际：很多实现会把 ECEF nominal propagation、NED error、body-frame attitude perturbation、SE_2(3) reset、GNSS Jacobian 混在一起，短距离看不出问题，全球/高速/长航时下会暴露为 covariance 不一致或数值病态。

核心观察是：选择 left-invariant、right-invariant 或 additive error，本质上是在选择误差坐标系和信息流方向。世界系量测自然偏好 RI 或 additive ECEF；IMU 输入在 body frame，传播结构自然偏好 LI。作者的判断是，低更新率或 GNSS-denied 场景下，传播阶段的 covariance accuracy 往往比瞬时量测 Jacobian 是否简单更重要，因此 LI 通常更有实践吸引力。

Core Idea

论文的核心思想是：固定同一套全球 ECEF/NED navigation equations，不改变物理系统，只改变 error definition，然后观察误差传播结构如何被重排。这个视角很有用，因为它把“滤波器差异”从实现细节提升到表示选择：误差是在 body frame、ECEF frame、geodetic frame，还是 additive Euclidean space，会决定 attitude error 如何进入 velocity/position，bias/noise 如何注入 covariance，以及量测更新是否引入大尺度耦合。

LI SE_2(3) 的 inductive bias 是让 PVA error 跟随 body frame，使 IMU-driven propagation 更接近系统自然对称性，因此 F 中主要项不显式依赖绝对 ECEF position。RI 的 inductive bias 是让 error 留在 world/ECEF frame，使 position measurement 更直接，但代价是 attitude error 会旋转绝对位置/速度，导致 O(R_E) 或 O(|v|) 量级 coupling。additive ECEF 则基本放弃 Lie-group PVA structure，只保留 SO(3) attitude perturbation，换取最清楚、最稳健的工程接口。

Method

关键机制可以压缩为四个建模选择。

第一，geodetic/NED ESKF 作为经典全球惯导基线：它解决的是地球曲率和 moving navigation frame 的传统处理问题；需要它是因为这是现有 INS/GNSS 工程系统的主流参照；核心变化是所有 PVA error 都在局部导航/大地坐标中 additive，导致 F 的 position、velocity、attitude 子块都依赖纬度、高度、速度和 transport rate。

第二，LI ECEF SE_2(3) ESKF：它解决的是 propagation trajectory-dependence；需要它是因为 IMU measurements 是 body-frame inputs，系统动力学更接近 left-invariant/group-affine；核心变化是 position/velocity error 也被旋到 body frame，使传播矩阵的主要结构只依赖 body angular rate、specific force、Earth rate，而不含绝对 ECEF position。

第三，RI ECEF SE_2(3) ESKF：它解决的是 world-frame measurement 与 error state 的对齐；需要它是因为 GNSS/ECEF position update 在 ECEF error 中看起来最自然；核心变化是 error 左乘到 nominal state，position measurement Jacobian 出现 attitude-position coupling S(-p)，传播中也出现绝对 p 和 v 相关项。

第四，additive ECEF ESKF：它解决的是工程实现和量测更新稳定性；需要它是因为很多全球导航系统只想避免 geodetic singularity，同时不想承担 RI 的数值问题；核心变化是 velocity/position 用 ECEF additive error，attitude 用 body-frame SO(3) perturbation，因此 H_pos 是 identity，但 F 仍显式依赖 R_hat，非 group-affine。

Key Insight / Why It Works

最重要 insight 是：invariant filter 的收益不是来自“用了 Lie group”这个标签，而来自 error representation 是否匹配系统输入和动力学对称性。惯导传播由 body-frame IMU 驱动，所以 LI error 把误差放在 body frame 后，传播中的很多 nominal trajectory dependence 被吸收到 group action 里；这就是 LI F 矩阵更干净、更接近 log-linear 的根本原因。

这篇最可能的核心贡献是把 RI 的隐藏代价讲清楚。RI 在量测侧看起来优雅，因为 GNSS position 是 world-frame；但它把 attitude error 与绝对 ECEF position 绑定，H 中的 S(-p) 是地球半径量级，F/G 中也出现 S(p)R、S(v)R。这不是小的实现瑕疵，而是 representation choice 造成的尺度病态。anchoring 能缓解，但本质上承认 RI 的全局 ECEF error coordinates 对数值实现不友好。

additive ECEF 的价值也被重新定位：它不是理论上最优，而是工程上很合理的折中。它牺牲 trajectory-independent propagation，换来稳定的 position update 和没有 geodetic pole singularity 的 Cartesian nominal state。对高 update-rate GNSS/多传感器融合，additive ECEF 可能比理论更漂亮的 RI 更可靠。

这里没有 scaling、data coverage、retrieval、test-time compute 这类机器学习式增益来源；所谓提升完全来自更合适的 inductive bias 和坐标/群结构对齐。辅助部分包括 full-order reset Jacobian、SE_2(3) Jacobian 闭式/级数表达、anchored RI 公式；这些对实现重要，但不改变核心判断：传播结构优先于量测 Jacobian 的表面简洁性。

Relation To Prior Work

它最接近三条路线：经典 strapdown INS/GNSS error model，如 Groves/Titterton/Weston 的 Pinson/NED 体系；Barrau/Bonnabel/Brossard 等 invariant filtering 与 SE_2(3) preintegration/rotating Earth 体系；Solà/Barfoot 的 Lie theory/state-estimation notation 体系。论文的新意不是提出新理论，而是把这些路线在全球惯导语境下统一到同一推导框架。

和经典 NED ESKF 的本质差异是：经典方法把地球几何放进坐标动力学，导致复杂且局部坐标奇异；ECEF invariant/additive 方法把地球几何更多放进物理项和误差表示选择里。和一般 invariant EKF 文献的差异是：本文没有停留在理想 group-affine local navigation，而是显式处理 Earth rate、centrifugal term、gravity variation、bias/noise coupling 和 ECEF measurement Jacobian。

看似新的部分中，SE_2(3)、left/right invariant error、SO(3)/SE_2(3) Jacobian 都是已有思想重组；实质创新在于对全球 ECEF/NED 四种 formulation 的并排可实现推导，以及对 RI 数值病态和 anchored mitigation 的明确结构化说明。

Dataset / Evaluation

这篇论文基本没有 dataset/evaluation，不能按 empirical paper 来读。它的“评估”是解析层面的：比较 F/G/H 的块结构、trajectory dependence、是否含绝对 ECEF position、是否存在 pole singularity、measurement Jacobian 是否良态。这个证据足以支撑“实现参考”和“结构差异分析”的 claim，但不足以支撑任何关于 RMSE、consistency、robustness 的强性能结论。

它没有跨场景真实世界验证，没有 Monte Carlo NEES/NIS，没有不同 update-rate/GNSS outage/高速飞行/长航时下的定量对比。因而“LI generally preferred”应理解为基于结构和理论对称性的判断，而不是实验定论。benchmark 是否验证核心 claim 这个问题在本文中基本不存在；核心 claim 是数学结构 claim，不是 benchmark claim。

Limitation

第一，group-affine 假设的上限被 gravity variation 直接触碰。文中承认重力非均匀会引入 gravity gradient G_e，破坏理想结构；但没有系统分析这个项在全球长航时任务中何时必须建模，何时可忽略。若任务跨度大、精度要求高，LI 的 trajectory-independent 优势会被现实地球模型削弱。

第二，bias/noise coupling 使 invariant formulation 不是完美 invariant。RI 中 gyro noise/bias 对 velocity/position 的耦合尤其明显，作者也提到需要截断以保留 log-linear 结构。这意味着一些“漂亮”的 F 是通过丢项得到的；一致性收益和建模误差之间的 trade-off 文中未充分说明。

第三，anchored RI 是工程修补，不是理论等价变换。它改善 O(R_E) 数值病态，但会改变 covariance/Kalman gain；anchor reset 又引入额外 covariance transform。它把全局 RI 的尺度问题转移到局部 anchor 管理问题，并没有消除 velocity-gyro coupling 在高速场景下的病态。

第四，缺少实证归因。文中没有证明 full SE_2(3) reset 比 attitude-only reset 在实际任务中显著更好，也没有证明 LI 在多源量测、高频更新场景下总优于 additive ECEF。增益来源不清的地方主要在“理论结构优势是否转化为部署性能”。

Takeaway

• 1. 全球 aided INS 中，error representation 是一等设计变量，不是符号偏好；它决定传播一致性、量测 conditioning 和数值尺度。
• 2. 对 IMU-driven propagation，LI/body-frame SE_2(3) error 是最自然的 inductive bias；它的优势来自匹配系统输入对称性，而不是 Lie group 形式本身。
• 3. RI/world-frame error 对 GNSS update 友好，但在 ECEF 下会把地球半径量级引入 attitude-position coupling；不 anchoring 基本不适合严肃实现。
• 4. Additive ECEF 仍然是强工程 baseline：非 invariant 但简单、稳定、无极点奇异；未来真正值得做的是在真实长航时、多传感器、低更新率场景下定量比较 LI、anchored RI、additive ECEF 的 consistency 和 failure mode。

一句话总结

这篇论文在全球惯导 ESKF 方向里的位置是一份高价值的结构化推导笔记：它没有提出新滤波器，而是把经典、LI、RI、additive ECEF 四类误差建模放到同一全球地球模型下，明确了 left-invariant propagation 优势、right-invariant ECEF 数值病态和 additive ECEF 工程折中的本质。