精读笔记

Problem Setting

Constant Time-Delay Leader Following with Neural Networks and Invariant Extended Kalman Filters for Arbitrary Trajectories（arXiv preprint / 2026）关注的不是常规 platooning，也不是带通信的 formation control，而是更苛刻的“monkey see, monkey do”式轨迹复现：跟随车没有全局坐标、没有车间通信、没有共享地图，只能用自身输入和前车相对观测，在固定时间延迟后占据前车曾经经过的位置。

这个问题的关键矛盾是：任务目标是历史轨迹复现，但可用观测是当前 ego frame 下的相对状态。随着跟随车自己运动，过去观测必须不断被搬运到当前参考系；一旦姿态或自车 odometry 有偏差，延迟越长，desired pose 的坐标表达越不可靠。传统 IEKF/模型方法能维持几何一致性，但对 arbitrary nonlinear trajectories 和未建模动态很硬；纯学习方法能拟合复杂时间关系，但缺少 SE(2) 结构和可靠初始锚点，闭环里早期小偏差会被控制器放大。

Motivation

作者真正抓住的缺口是：无通信固定延迟跟随不是一个单步 leader pose filtering 问题，而是一个带几何约束的历史轨迹重建问题。已有方法通常在两端失衡：要么依赖通信/waypoint/全局坐标，把最难的信息对齐问题绕开；要么使用滤波和运动模型，把前车轨迹限制在模型可解释范围内；要么用普通 RNN/LSTM 做时间序列预测，但预测空间和控制空间并不匹配。

因此这篇论文的动机不是“Seq2Seq 更强”，而是需要一种信息组织方式：把相对观测历史压缩成 delayed trajectory，把几何滤波器产生的初值作为 reference-frame anchor，再让学习模型处理那些很难由专家模型手写的非线性轨迹和误差补偿。缺的是 representation alignment，而不只是更大的预测器。

Core Idea

核心思想是把 fixed-delay following 显式建模为 SE(2) 上的 ego-centric trajectory distribution prediction。IEKF 不再是最终估计器，而是给 Seq2Seq 一个几何一致的 warm start：它把 t-P 时刻看到的 leader pose 通过自车运动传播到当前 ego frame，形成 delayed desired pose 的初始猜测。Seq2Seq 再利用过去 P 步相对观测、自车控制和 leader velocity，预测未来 P 步跟随车应追踪的相对轨迹及其不确定性。

本质区别在于它重新组织了信息流：不是“滤波器估计状态，然后控制器追踪”，也不是“神经网络黑盒预测轨迹”，而是“几何模型提供坐标锚点，序列模型学习轨迹搬运中的非线性残差和历史依赖，几何 MPC 消费同一流形表示”。这种 inductive bias 让模型比纯 RNN/Transformer 更不容易在姿态和坐标系变换上浪费容量，也让它比纯 IEKF 更能适应复杂轨迹分布。

Method

方法层面最重要的不是 GRU、GELU 或具体超参数，而是三个机制。

第一，SE(2) 表示和 boxminus/NLL loss 解决的是预测目标与真实误差度量不一致的问题。对于固定延迟跟随，orientation error 会直接影响后续位置重建；如果用 R^3 MSE，角度 wrap-around 和群结构被破坏，预测看似平滑但闭环控制语义不对。boxminus loss 的价值是把训练误差对齐到控制误差。

第二，IEKF warm start 解决的是长延迟下 early trajectory anchoring。Seq2Seq 单独从历史观测恢复完整 delayed trajectory 时，最困难的是初始 desired pose 在当前 ego frame 中的位置和朝向；这个量由自车运动积分主导，数据驱动模型很容易在闭环分布漂移时犯系统性错误。IEKF 给出一个可解释的初值，网络更多是在修正而非从零构造。

第三，GMPC 解决的是预测—控制接口问题。既然预测输出是 SE(2) 轨迹，控制器也应在 SE(2) tracking error 上优化。否则学习模型输出的几何结构会在控制阶段被普通欧氏误差吃掉。论文中加入输入变化约束，本质是抑制预测噪声导致的控制抖动，而不是核心理论创新。

Key Insight / Why It Works

这篇最有价值的 insight 是：在无全局坐标的 delayed following 中，性能瓶颈往往不是单个模块的表达能力，而是坐标系搬运的一致性。IEKF、boxminus loss、GMPC 分别在估计初值、训练目标、控制目标上维持同一种几何语义；Seq2Seq 只负责学习模型难以覆盖的部分。这种 decomposition 比端到端黑盒更稳。

最可能的核心贡献是 warm-started manifold trajectory prediction，而不是“probabilistic Seq2Seq”本身。消融也暗示：没有初始预测时，即使用 boxminus loss，闭环性能会显著恶化；这说明网络并没有真正学到完全自主的几何积分/坐标搬运能力，它需要一个物理锚点。换言之，方法有效更像是 better inductive bias + residual learning，而不是纯 scaling。

概率输出的作用比较微妙。论文没有把协方差用于 GMPC，因此 uncertainty 并没有形成决策层面的风险建模。它更可能起到 NLL 训练下的表示正则作用，帮助模型区分不同 horizon 和不同观测条件下的可信度，但“概率预测改善控制”的因果链文中未闭合。这里的增益来源不清。

另一个值得注意的判断是：所谓 arbitrary trajectories 主要依赖训练数据覆盖。轨迹来自随机障碍、RRT、spline 和若干控制器混合生成，模型学到的可能是该生成过程下的 trajectory manifold，而不是对任意 leader 行为的外推能力。它不是 retrieval，但有明显 distributional pattern reuse 的成分。

Relation To Prior Work

最接近的路线有三类：无通信 leader-following 中的滤波/MPC 方法、SE(2) 上的 IEKF/GMPC 几何控制方法、以及 Seq2Seq trajectory prediction。论文的新意不是发明这些组件，而是把它们放到 fixed-delay no-communication convoy 的同一信息闭环里。

相对 Wang et al. 这类 uncertainty-tuned MPC / pairwise Kalman filter 方法，本文把 leader waypoint/trajectory 估计从手写模型扩展到数据驱动序列预测，因此能覆盖更复杂的非线性轨迹，但代价是依赖仿真数据分布和训练 pipeline。相对普通 RNN/Transformer 轨迹预测，本文实质新增的是 SE(2) 对齐和 IEKF anchor，而不是序列模型能力。相对 GMPC 工作，本文把 desired trajectory 从已知参考轨迹改成 learned delayed trajectory，使 GMPC 能用于无通信复现任务。

因此它属于“model-based geometry + learned residual trajectory reconstruction + MPC”的谱系。看似是 learning-based convoying，实质更像 structured learning for state/trajectory estimation。

Dataset / Evaluation

仿真数据覆盖了随机障碍环境中由 RRT+spline 生成的曲线轨迹，并混合了反馈线性化、GMPC 和随机控制来扩展 ego 状态分布；这对训练一个 delayed trajectory reconstructor 是合理的，至少避免了单一控制器造成的严重 covariate bias。但任务覆盖仍主要限于平面 unicycle-like 运动、相对观测可得、无动态障碍/遮挡的设置。

评估比较了 IEKF、GRU、Transformer 和 true trajectory lower bound，能够支持“结构化几何学习比纯模型或普通学习更好”这个局部 claim。消融比较有信息量：boxminus loss 对预测误差重要，warm start 对闭环更关键。真机实验是加分项，说明系统不是纯仿真 artifact；但 Vicon 提供相对状态和 leader velocity，再人为加噪，并没有验证真实 perception stack，也没有验证 GPS-denied/视觉遮挡/传感器失锁等关键场景。

因此 evaluation 支持的是：在相对观测抽象已解决的前提下，该估计-控制结构有效。它没有完全支持更强的 claim：现实无通信车队中可端到端处理任意前车轨迹。

Limitation

最重要的隐含前提是观测接口过于理想：每步都有 leader 相对位姿和 leader 线/角速度估计。真实无通信任务里，这些量本身就是最难的 perception/localization 问题之一。论文把感知抽象掉是合理的研究切分，但也意味着系统级 claim 不能过度外推。

第二，泛化上限受数据生成分布限制。RRT+spline 轨迹、固定 horizon P、固定噪声水平、固定车辆模型共同定义了训练 manifold。模型在这个 manifold 内表现好，不等价于对人类驾驶、急停、复杂速度 profile、非平滑轨迹、低摩擦地形或多车遮挡的泛化。核心能力可能主要来自数据覆盖加几何先验，而不是学习到了通用 convoy reasoning。

第三，协方差没有进入控制，概率建模的闭环价值未被证明。既然 GMPC 不使用 uncertainty，输出 covariance 更像 auxiliary head / NLL regularizer。若要声称 uncertainty-aware tracking，需要 robust/on-manifold MPC 或 chance constraint，否则概率部分的贡献归因不清。

第四，稳定性和可行性分析基本缺失。GMPC 有局部优化和输入约束，但 learned reference trajectory 的误差如何影响 closed-loop stability，长延迟下误差是否有界，多车级联时是否 string stable，文中未充分说明。

第五，真机实验规模较小且环境受控。Vicon、室内、低速、单 follower，这些条件离实际军事/物流 convoy 的复杂性还有距离。sim-to-real gap 已经导致明显误差，说明模型对未建模动力学并不天然鲁棒。

Takeaway

• 1. 对这类无全局坐标的 delayed tracking 问题，最值得迁移的不是 Seq2Seq，而是“几何 warm start + 学习轨迹残差 + 几何控制”的接口设计。
• 2. 如果预测对象最终要被 MPC 消费，训练 loss、状态表示和控制误差必须对齐；否则纯学习模型的离线 RMSE 很容易在闭环里失真。
• 3. IEKF 在这里的角色从 classical estimator 变成 neural predictor 的 anchor，这是一个很有用的范式：让模型学习难建模部分，而把坐标变换、群结构和短期物理传播交给可解释模块。
• 4. 未来真正值得做的是把 uncertainty 接入 robust GMPC，并把 perception-derived relative observations 纳入训练和评估；否则这条线仍停留在“理想观测下的轨迹重建”。

一句话总结

这篇论文把无通信固定延迟车队跟随从手写滤波/MPC问题推进为带 SE(2) 几何先验的学习式相对轨迹重建问题，真正贡献在于用 IEKF 锚定坐标系、用 Seq2Seq 学习长延迟残差、再用 GMPC 保持预测—控制一致性。