150、安全控制与碰撞检测：实时安全约束与碰撞避免
写这篇的时候，我刚从实验室的调试台前爬起来。昨晚那个机械臂在轨迹跟踪测试里差点把末端撞上旁边的示教器，好在急停按钮按得够快。这种惊魂时刻在具身智能开发里太常见了——你精心训练的VLA模型输出一个动作，策略网络觉得没问题，但真实物理世界里，那个位姿就是会撞上环境里的某个障碍物。今天这篇，我想把安全控制这块的坑和心得掰开揉碎了讲清楚。
先说一个我踩过最深的坑：很多人以为碰撞检测就是拿包围盒做相交测试，安全控制就是加个速度上限。真这么干，你的机器人迟早要出事。去年我们团队做过一个抓取实验，模型输出一个看起来非常合理的抓取姿态，但实际执行时，机械臂的肘部会先扫过桌面上的一个传感器支架。为什么？因为VLA模型是在仿真环境里训练的，仿真里那个支架根本不存在，或者位置有偏差。你让模型输出关节角度，它只关心末端执行器能不能抓到目标，完全不关心中间构型会不会撞到东西。
所以安全控制的第一层，不是检测碰撞，而是约束动作空间。在模型输出动作之后、发送给底层执行器之前，必须加一个安全过滤器。这个过滤器要做的第一件事，就是检查这个动作是否在关节限位内。别笑，很多开源项目里真的没有这一步。我们的做法是，对每个关节维护一个安全区间，不仅包括硬件限位，还包括软限位——比如你不想让某个关节在特定构型下超过某个速度，因为那会导致奇异点附近的加速度过大。
这里有个调试技巧，我建议你在安全过滤器里加一个动作差分检查。什么意思？就是比较当前时刻模型输出的动作和上一时刻实际执行的动作，如果差值超过某个阈值，直接丢弃这个动作，保持上一时刻的指令。这个阈值怎么定？看你的执行器响应带宽。我们用的协作机械臂，关节速度指令的响应延迟大概在10毫秒左右，所以如果两个连续
