策略推理 10Hz 对不上底层 1kHz：具身智能真机部署中的轨迹插补与安全兜底方案

最近把几个端到端 VLA 模型往实机机械臂上挂，高低频脱节的问题确实很折磨人。

高层策略受限于算力和图像吞吐，推理频率通常只有 5 Hz 到 15 Hz，而且延迟存在明显抖动；而机械臂底层的关节伺服（比如走 EtherCAT 的电机驱动）基本要求 200 Hz 到 500 Hz，甚至 1 kHz。如果中间处理不好，要么机械臂抖动剧烈报过流，要么在策略推理超时时出现危险动作。

目前在 ROS 2 实机落地时，我这边验证下来相对稳妥的解法大概是两层架构：

1. 轨迹插补与连续性平滑： 上层尽量走 Action Chunking，一次输出未来一段时域的动作序列（比如 8-16 帧）。底层不要直接做朴素的线性或三次样条插值，遇到策略输出突变容易导致加速度（Acceleration）和加加速度（Jerk）超限。我们习惯在中间包一层 Ruckig 做实时轨迹规划，以当前机械臂的实时状态作为起点，对 Policy 给出的 Target 做在线轨迹重规划，强制加上速度、加速度和 Jerk 限制。

2. 周期抖动与安全兜底： 给高频执行层配一个硬件看门狗（Watchdog），容忍阈值一般设为 1.5 到 2 个推理周期（约 150-200 ms）。一旦策略推理卡顿或丢帧，绝不能直接发零速度（硬刹车极容易打齿），也不能简单地原位冻结；而是由底层控制器根据当前运动学状态，沿切线方向自动生成一条平滑减速轨迹（Deceleration Profile）直至安全悬停。

想向各位同行请教一下： 大家在做具身智能落地时，这一层通常是放在 ros2_control 内部写自定义 Controller 实现，还是在中间件节点解决？ 另外，当策略多峰性导致相邻两次推理的 Chunk 轨迹出现较大方向跳变时，大家倾向于用滚动时域滤波（Receding Horizon），还是直接通过阻抗控制在力矩层把误差吃掉？