3. 碰撞检测基本原理与ROBOGUIDE实现机制
在ROBOGUIDE中做碰撞检测，不能只停留在“点一下仿真看有没有报警”的层面。要真正理解检测结果是否可信、为什么有时漏报、为什么有时误报、为什么仿真会突然变慢，就必须回到碰撞检测的底层原理：几何求交、包围盒、距离计算，以及ROBOGUIDE如何把这些数学工具组织成一套可配置、可权衡的检测机制。
一、几何求交：碰撞检测的数学基础
碰撞检测最直接的定义是：判断两个几何体在空间中是否发生重叠。对于机器人工作站中的对象——机器人本体、焊枪、夹具、工件、围栏、变位机——它们通常被表示为三角网格（Triangle Mesh）或参数化实体（如圆柱、长方体、球体）。几何求交就是对这些几何表示做相交测试。
以三角网格为例，两个物体发生碰撞，等价于存在一对三角形，它们之间的最小距离小于等于零。因此，最朴素的算法是“两两三角形求交”：对物体A的每个三角形与物体B的每个三角形做三角形-三角形相交测试。这种测试通常基于分离轴定理（SAT）或Möller-Trumbore算法。假设物体A有m个三角形，物体B有n个三角形，则最坏情况下需要做m×n次测试。对于机器人本体（可能数万三角形）与夹具（数千三角形），这个计算量是巨大的，无法满足实时仿真要求。
所以，实际系统不会直接做全量三角形求交，而是先做“粗筛”，再做“精筛”。粗筛用包围盒快速排除明显不相交的物体对，精筛只对可能相交的局部区域做精确三角形测试。这就是包围盒存在的意义。
二、包围盒：用简单形状换速度
包围盒（Bounding Volume）是用一个简单的几何体把复杂物体“包”起来。最常见的两种是轴对齐包围盒（AABB）和有向包围盒（OBB）。AABB的边平行于世界坐标轴，构造简单，相交测试只需比较三个轴上的区间是否重叠；OBB的边可以任意旋转，更贴合物体形状，但测试需要把两个盒子的方向都考虑进去，计算量更大。
在ROBOGUIDE中，机器人各轴、工具、夹具通常都有对应的包围盒。当两个物体的AABB在X、Y、Z三个轴上的投影区间都重叠时，才可能真正碰撞；只要有一个轴不重叠，就可以立即判定“不相交”，直接跳过后续精确检测。这个判断非常快，能过滤掉绝大多数物体对。
但包围盒也有代价：它比物体本身大，可能把“实际不碰撞”的情况误判为“可能碰撞”，从而触发不必要的精筛。包围盒越贴合物体，粗筛越准，但构造和更新成本越高。ROBOGUIDE在精度与速度之间做平衡时，包围盒的粒度是一个关键参数。
三、距离计算：从“是否碰撞”到“离碰撞还有多远”
很多场景不仅要知道“碰没碰”，还要知道“离碰还有多远”。例如，焊枪与夹具之间需要保持安全间隙，或者机器人末端在狭窄空间内运动时，需要实时监控最小距离。这时就要用到距离计算。
两个凸体之间的最小距离，可以通过GJK（Gilbert-Johnson-Keerthi）算法高效计算。GJK的核心思想是：在闵可夫斯基差空间（Minkowski Difference）中，判断原点是否在差集内。如果原点在差集内，说明两个物体相交；如果不在，则原点到差集边界的距离就是两个物体的最小距离。GJK通常配合EPA（Expanding Polytope Algorithm）使用，当检测到相交时，EPA可以进一步计算穿透深度，用于碰撞响应或报警等级判断。
在ROBOGUIDE中，距离计算常用于“接近报警”功能。例如，设定安全距离为5mm，当焊枪与夹具的最小距离小于5mm时，系统提前报警，而不是等到真正碰撞。这对于调试和路径优化非常有价值。
四、ROBOGUIDE中的触发条件与检测周期
ROBOGUIDE不会在每一帧都对所有物体做全量碰撞检测。它采用“按需触发”和“周期检测”相结合的策略。触发条件通常包括：机器人运动到新的示教点、工具姿态发生变化、工件被夹具夹紧或松开、外部轴运动、以及用户手动启动碰撞检查。在仿真运行过程中，系统会按照设定的检测周期（例如每50ms或每100ms）对当前处于“活动状态”的物体对进行检测。
这里有一个关键概念：碰撞对（Collision Pair）。ROBOGUIDE允许用户指定哪些物体之间需要检测碰撞，哪些可以忽略。例如，机器人本体与自身通常不检测（除非需要检测奇异姿态下的自碰撞），机器人末端工具与工件需要检测，工具与夹具需要检测，但夹具与工件之间如果是“夹紧”关系，则通常不检测。合理设置碰撞对，可以大幅减少计算量。
五、检测精度与计算资源的权衡
精度和资源是一对矛盾。提高精度意味着更小的包围盒余量、更密的三角网格、更短的检测周期、更多的碰撞对；这些都会增加CPU和内存开销，导致仿真变慢。ROBOGUIDE中常见的权衡手段包括：
- 包围盒粒度：对形状规则的物体用AABB，对细长或倾斜物体用OBB，减少误判。
- 网格简化：对不参与精确碰撞的物体，用低模网格或直接只用包围盒。
- 碰撞对白名单：只检测真正可能碰撞的物体对，避免全量两两检测。
- 检测周期：在调试阶段用较短周期（如20ms）捕捉瞬态碰撞；在演示或长周期仿真中用较长周期（如100ms）降低负载。
- 距离监控分级：只对关键物体对开启距离监控，并设置合理的安全距离阈值。
六、一个可参考的配置示例
假设一个焊接工作站：机器人本体、焊枪、夹具、工件、围栏。可以按如下方式配置碰撞检测：
| 物体对 | 检测方式 | 周期 | 说明 |
|---|---|---|---|
| 焊枪 ↔ 夹具 | 精确求交 + 距离监控 | 20ms | 安全距离5mm，接近即报警 |
| 焊枪 ↔ 工件 | 精确求交 | 20ms | 焊接路径需避免碰撞 |
| 机器人本体 ↔ 围栏 | 包围盒粗筛 | 100ms | 大范围安全，低精度即可 |
| 夹具 ↔ 工件 | 不检测 | — | 夹紧关系，允许接触 |
| 机器人本体 ↔ 自身 | 不检测 | — | 正常姿态无自碰撞 |
这个示例说明：碰撞检测不是“全开”或“全关”，而是根据工艺关系、安全要求和计算预算做精细配置。理解几何求交、包围盒和距离计算这三块基石，再结合ROBOGUIDE的触发条件与碰撞对管理，才能让碰撞检测既准又快。