4、碰撞检测机制：自碰撞检测与环境碰撞检测、碰撞体简化、碰撞检测参数调优
碰撞检测，说白了就是让机器人知道「我碰到东西了」。在仿真里，这事比你想的复杂得多。我最早做机械臂仿真时，觉得碰撞检测不就是个开关吗？打开就完事了。结果仿真跑起来，要么漏检，机械臂直接穿模；要么卡得跟幻灯片一样，一秒跑一帧。
嗯，这里面的门道，我们今天一条条捋清楚。
4.1 自碰撞检测 vs 环境碰撞检测
先分清楚两个概念：自碰撞和环境碰撞。
- 自碰撞：机械臂自己的连杆之间撞上了。比如大臂和小臂折过头，或者夹爪碰到了腕部。
- 环境碰撞：机械臂撞到了工作台上的工件、夹具、安全围栏等外部物体。
在仿真引擎里，这两套检测机制通常是分开的。自碰撞更关注关节角度极限和连杆几何干涉，环境碰撞则依赖场景中的静态/动态物体网格。
关键区别：自碰撞的检测对象是固定的（机械臂自身模型），可以预计算优化；环境碰撞的对象是动态加载的，每次仿真都要实时计算。
我在项目里遇到过一个问题：自碰撞明明没报错，但机械臂在仿真里却「卡住」了。后来排查发现，是自碰撞的检测对没配全——默认只检测相邻连杆，但非相邻连杆在某些姿态下也会干涉。所以，我建议你手动把所有可能干涉的连杆对都加到检测列表里，别偷懒。
4.2 碰撞体简化：别拿原模型去算
很多人直接把CAD模型丢进仿真引擎做碰撞检测。结果呢？一个法兰盘几万个三角面，算一次碰撞要几十毫秒。你想想看，机械臂有6个关节，每个关节步长都要算一次，整个仿真直接卡死。
正确的做法是——简化碰撞体。
| 碰撞体类型 | 适用场景 | 计算开销 | 精度 |
|---|---|---|---|
| 球体 | 关节、末端执行器 | 极低 | 低 |
| 胶囊体 | 连杆、臂体 | 低 | 中 |
| 盒体 | 基座、大型结构件 | 低 | 中 |
| 凸包 | 复杂外形但无凹陷 | 中 | 高 |
| 原始网格 | 仅用于最终验证 | 高 | 最高 |
我个人习惯是：先用球体和胶囊体把整个机械臂包起来，跑通运动学和初步路径规划。等需要做精细干涉检查时，再换成凸包或简化网格。这样前期调试速度快得多。
小技巧：在URDF或SDF文件中，用 <collision> 标签单独定义碰撞体，和 <visual> 分开。视觉模型可以很精细，碰撞模型尽量简单。
4.3 碰撞检测参数调优
碰撞检测不是非黑即白的。你调几个参数，结果可能天差地别。
4.3.1 安全距离（Safety Distance）
这个参数定义了「多远算安全」。默认值通常是0，也就是碰到才算碰撞。但我建议你设一个非零的安全距离，比如5mm或10mm。为什么？
- 仿真有步长误差，机械臂可能在一个步长内「跳过」碰撞面。
- 真实机械臂有控制延迟和惯性，仿真里刚好不碰，实际可能已经撞了。
我曾经吃过这个亏。仿真里路径规划完美通过，结果上真机时，末端夹爪擦到了工件边缘。后来我把安全距离从0改到8mm，再也没出过问题。
4.3.2 碰撞检测频率（Collision Check Rate）
不是每一步都要做全量碰撞检测。你可以设置每隔N步检测一次，或者只在关节速度变化大的时候检测。
举个例子：机械臂在匀速直线运动时，碰撞风险很低；但在接近目标点或切换姿态时，碰撞概率骤增。我一般这样配置：
# 伪代码示例
if joint_velocity_change > threshold:
check_collision(every_step=True)
else:
check_collision(every_step=False, interval=5)
这样既保证了安全性，又把计算开销降到了原来的1/5。
4.3.3 碰撞体层级（Collision Layer）
大型仿真场景里，不是所有物体都需要互相检测碰撞。比如地面和机械臂肯定要检测，但两个固定夹具之间就不用。通过碰撞层级或碰撞掩码，你可以指定哪些组之间做检测。
| 层级 | 对象 | 检测对象 |
|---|---|---|
| Layer 1 | 机械臂连杆 | Layer 2, Layer 3 |
| Layer 2 | 工件、夹具 | Layer 1 |
| Layer 3 | 安全围栏 | Layer 1 |
| Layer 4 | 固定支架 | 无 |
这样配置后，仿真引擎只检测必要的碰撞对，计算量直接减半。
注意：碰撞层级配置不当会导致漏检。我曾经把机械臂和工件放在同一层，结果两者互相不检测，机械臂直接穿模抓取。检查了半天才发现是层级掩码设错了。
4.4 碰撞检测知识体系
下面这张图帮你理清本章的核心逻辑：
4.5 实战建议：从仿真到真机的碰撞检测策略
最后，我分享一个我在实际项目中用过的策略：
- 第一阶段：用球体和胶囊体做快速碰撞检测，跑通运动学逆解和初步路径。
- 第二阶段：换成凸包碰撞体，加入安全距离（建议5-10mm），做精细路径优化。
- 第三阶段：在仿真中模拟真实控制周期（比如1ms步长），验证碰撞检测的实时性。
- 第四阶段：上真机前，用仿真回放真实轨迹，确认无碰撞风险。
避坑指南：我曾经在第二阶段直接用了原始网格做碰撞检测，结果仿真跑不动。后来换成凸包，计算量降了80%，精度只损失了不到1%。所以，别迷信「越精细越好」——够用就行。
碰撞检测这件事，说白了就是在精度和性能之间找平衡。你调得越细，仿真越接近真实；但调过头了，仿真就跑不动了。记住我今天说的这几个参数和简化方法，你的机械臂仿真至少能少踩一半的坑。