企业官网建设流程全解析

空间机械臂双臂碰撞检测这块，我在某型号项目中从头跟到尾，踩了不少坑也沉淀了一些自己的理解。这个话题看起来是纯算法问题，真正落地的时候你会发现它其实是数学建模、计算资源分配、控制时序设计三件事搅在一起。今天不打算讲教科书，把我的工程思路和处理经验整理出来分享，对正在做空间机械臂或者地面双臂协同的同行应该有些参考价值。

1. 双臂协同作业为什么绕不开碰撞问题

1.1 工作空间重叠是碰撞风险的根源

空间机械臂做双臂协同，不外乎在轨组装、载荷搬运、设备维护这几类场景。两个机械臂的基座分别安装在舱体不同位置，但为了完成协同任务，它们的工作空间必然有大量重叠区域。比如双臂同时抓取一个大型载荷，两只手爪需要靠在同一个目标周围，这时候臂杆之间、臂杆与载荷之间、载荷与舱体之间的间隙可能只有几厘米。

单臂作业时，机械臂自身有成熟的安全避让策略，因为环境模型相对固定，碰撞风险主要来自预先规划好的路径与静态障碍物的冲突。双臂协同一上来就不一样了：两个机械臂各自运动，任何一个臂的构型都在实时变化，臂与臂之间的相对位置每个控制周期都不同，这是一个动态耦合的碰撞问题。

更麻烦的是，双臂协同任务中两个臂往往需要同时逼近同一个目标，构型接近，控制误差、动力学耦合误差都会叠加。比如末端定位误差在单臂时正负5毫米，双臂协同同一抓取点时，两臂叠加后可能变成正负1厘米甚至更多，这就直接吃掉了一部分安全余量，碰撞检测的阈值空间被压缩得很厉害。

1.2 空间环境让碰撞代价成倍放大

地面工业机器人的碰撞检测如果误报，顶多停机重新规划；如果漏报发生碰撞，机械臂受损可以更换维修。空间机械臂完全不是这个量级。

在轨环境下，一旦发生碰撞，轻则机械臂关节锁定、任务中断，重则损伤舱体表面热控层或精密载荷，没有任何快速人工介入手段，长时间无法恢复。而且碰撞事件发生后，受力导致的微弱结构变形在微重力环境下可能引发新的位姿偏差，形成连锁问题。这个代价决定了空间机械臂的碰撞检测绝对是宁可误报十次也不漏报一次。

但空间环境还有另一层冷酷的现实：星载计算机的算力非常有限，可能只有地面工控机的几分之一。同时机械臂本身又细又长（典型7自由度臂展开可达十几米），结构柔性明显，动力学模型不确定性大。你没法像地面那样堆算力堆精度，必须在有限资源下做可用的检测方案。

1.3 单臂成熟方案为什么不能直接套用

很多人觉得碰撞检测就是拿机械臂模型跟环境模型做布尔求交，单臂能做双臂也能做。实际实现时你会发现有本质区别。

单臂碰撞检测只有一条运动链需要实时更新，环境里除机械臂自身外基本都是静态物体。双臂系统相当于两条运动链在同一个动态场景里运动，任意一个臂的连杆都可能与另一个臂的连杆发生碰撞，而且碰撞的对象不再是固定的，需要实时追踪两个臂的相对位姿关系。

在算法实现层面，单臂可以把环境碰撞体全部预先重建成静态检测树，每次只需要更新机械臂自身的碰撞体，然后做静态树与动态树的查询。双臂系统则需要同时动态更新两条臂的碰撞体信息，再做动态体与动态体的检测，多了一个维度，计算量和数据管理复杂度同步上升。

另外，双臂共用一个控制周期，检测结果必须在一个周期内同时反馈到两个臂的规划器，这意味着碰撞检测模块不能只输出"某个臂是否碰撞"，还必须明确"哪一对连杆发生了碰撞、碰撞点在哪个坐标系下、分离距离是多少"，给上层决策提供完整信息。这些需求跟传统单臂检测模块差异很大。

2. 碰撞检测的建模基础：把机械臂变成可计算的几何对象

2.1 连杆几何模型的简化与选择

碰撞检测第一步是把机械臂的物理几何转成计算机能快速判断的数学模型。这里有一个核心矛盾：模型越精细，检测越准，但计算开销越大；模型越粗糙，计算越快，但可能出现漏检或误报。

我实际使用的建模策略是：碰撞模型和动力学模型完全分离。动力学模型追求质量、惯量、质心的精确性，碰撞模型只关注几何表面。

几何简化上，我主要用三类形状，按优先级排序：

胶囊体是臂杆建模的最佳选择。它的几何定义简单——一个圆柱加两个半球端盖，任意两点到线段轴的距离判断就可以完成相交测试。对于直径均匀的臂杆，胶囊体的包络误差可以控制在2%以内。关节部位由于形状复杂、又有转动自由度，直接用一个或多个包围球覆盖，好处是旋转时球体形状不变，完全不需要随关节角更新几何。

这里有个容易踩的坑：为了追求极限精度把所有连杆都用原始CAD模型网格导入。这个做法在地面资源充足的场合问题不大，但在星载环境会把碰撞检测计算量抬高一个数量级，而且网格模型的碰撞检测数值稳定性也不如凸包。我后来统一改成了"凸包+胶囊体+包围球"的混合方案，检测精度损失不到5%，计算时间下降了约70%。

2.2 运动学正解与碰撞检测坐标变换

有了几何模型，下一步要解决"机械臂在空间里到底长什么样"的问题。碰撞检测需要知道每个连杆在世界坐标系下的位姿，这依靠运动学正解计算。

对于7自由度机械臂，我用的是改进型DH参数建模，每个关节对应一个4x4齐次变换矩阵。正解计算本质上就是把这些矩阵按顺序连乘，得到每个连杆坐标系到基座坐标系的变换关系。伪代码如下：

def forward_kinematics(joint_angles, dh_params): # T_base_to_link[i] 存储第i个连杆相对于基座的位姿 T_base_to_link = [] T_cur = np.eye(4) # 初始为基座坐标系 for i in range(len(joint_angles)): # 根据DH参数计算相邻连杆变换矩阵 theta = joint_angles[i] a, alpha, d = dh_params[i] T_i = dh_transform(theta, a, alpha, d) T_cur = T_cur @ T_i T_base_to_link.append(T_cur) return T_base_to_link

正解输出的每个连杆位姿，随后用于把碰撞体模型从连杆局部坐标系变换到世界坐标系。实际工程中要注意一个细节：因为碰撞检测模块可能在控制循环里被高频调用，每次调用都重新做整条链的正解计算没必要。我采用的方式是，正解结果在上一个控制周期已经算好，碰撞检测模块直接读取共享内存中的位姿缓存，配合时间戳判断数据是否新鲜。

2.3 环境障碍与目标载荷的建模

碰撞检测不只是机械臂之间，还包括机械臂与周围环境。空间站舱壁、太阳翼、天线这些静态物体，我建议在做任务前一次性构建成静止的碰撞树，整个过程不需要更新。

目标载荷（比如大型桁架、卫星、实验柜）则要根据任务阶段决定建模方式：如果载荷被抓持在机械臂末端，它就变成机械臂运动链的延伸部分，跟着末端的位姿一起变换；如果载荷还没被抓持，属于独立运动物体，需要在每个控制周期更新它相对世界系的位置。

3. 核心检测算法：从层次包围体到距离计算

3.1 为什么要用包围体层次而不是直接做三角面片碰撞

对工程实现而言，关键决策点之一是：用什么几何结构做碰撞检测。

最简单粗暴的思路是把所有模型离散成三角网格，直接做三角形相交测试。这对几百个三角形的模型还能接受，但空间机械臂的CAD模型动辄几万甚至几十万个三角形，两个臂做全量三角形求交，一个周期内计算量会爆炸。

工程上普遍采用包围体层次结构（BVH），思路是：先用大的简单几何体（AABB、OBB、包围球）快速排除明显不相交的物体对，只有在大包围体重叠时，才进一步细分到子包围体，最后才做精确几何计算。我把检测分成两个层级：

AABB的优势是相交测试只需要六次浮点比较，速度极快。缺点是包络精度低，对角线方向上会留出很大空隙。所以在粗检测阶段用AABB做"有嫌疑"判断，宁可多保留一些候选对，也绝不漏掉，真正判断放在精检测阶段。

3.2 离散检测与连续检测的取舍

碰撞检测另一个核心决策是：每个控制周期内做离散点检测，还是做连续时间检测。

离散检测的做法是：在当前时刻对两条机械臂的位姿各做一次碰撞检测，属于"快照式"判断。优势是计算简单、稳定，配合足够高的检测频率（我通常在10-20毫秒执行一次）效果很好。劣势在于：如果机械臂运动速度很快，一个周期内单次检测可能漏掉"穿过"的情况——比如某个细长臂杆快速扫过另一个臂，前后两个采样时刻都在安全位置，但中间某刻已经穿透了。

针对这个问题，补充手段是给所有运动部件设置一个"安全膨胀半径"，相当于把物理间隙放大，速度越快放大越多。做一个粗略计算：假如末端运动速度是0.5米/秒，控制周期20毫秒，单周期位移10毫米。膨胀半径取20毫米就能覆盖两个周期的位移量，且留有余量。这是一种保守但极其可靠的工程措施。

如果确实对高速运动物体做连续碰撞检测（CCD），工程上常用扫掠体方法：把物体在一个时间步内的扫过区域构建成一个凸体，检测这个扫掠体与另一个物体是否相交。这个方法比离散检测可靠，但扫掠体的构建计算量明显更大，关节转动情况下扫掠体的精确构建更是复杂。我的工程结论是：空间机械臂作业普遍速度不快的场景，离散检测+膨胀半径的方案性价比远高于连续检测。这个结论经过仿真和实物验证，长期运行没有出现漏报。

3.3 最小分离距离的计算

碰撞检测不只要知道"碰没碰"，还必须知道"有多近"。分离距离是避碰规划的核心输入，也是安全分级判断的依据。

精检测阶段，凸体间最小距离（或穿透深度）我使用GJK算法和EPA算法组合求解。GJK的核心原理很优雅：它不直接计算两个凸体的几何关系，而是利用闵可夫斯基差的概念——两个凸体相交，当且仅当它们的闵可夫斯基差包含原点。通过迭代构建单纯形逼近原点，可以快速判断是否相交，并在不相交时快速估计距离。

距离计算的工程细节值得注意。比如两个胶囊体的最短距离可以直接转化为"两条线段之间的最短距离再减去两个半径之和"。线段间最短距离的计算是几何算法中的基础问题，用参数化方法可以高效求解。而凸包间距离则建议直接调用开源碰撞库中的GJK实现，工程效率远高于自己造轮子。

我用的开源库不多，主要是碰撞检测库（FCL），它在机器人领域的避障和规划模块里应用非常广。实际工程中有几个使用trap：一是FCL的碰撞对象在设置变换矩阵后需要调用update方法刷新内部结构，忘记刷新会出现检测结果滞后；二是FCL在检测时默认带薄层（通产默认厚度为0），距离趋近于0时结果可能抖动，建议显式设置一个小的薄层厚度（比如0.5毫米），能显著改善数值稳定性。

4. 实时性、精度与计算资源的三角平衡

4.1 星载计算环境下的算力约束

碰撞检测模块在设计之初必须明确自己的算力预算。以我参与的实际项目为例，控制周期设定为50毫秒（这是综合考虑关节伺服能力、通信延迟和任务需求后的数值），其中分配给碰撞检测的时间预算不超过8毫秒，算力约束非常紧张。

这意味着整个碰撞检测模块的平均单次计算必须控制在2毫秒内。设计时只能做减法：能预计算的绝不实时算，能快速排除的绝不做精确检测。静态环境碰撞树在任务开始前全部构建完毕，碰撞体模型全部用解析几何而不是网格，关节自碰撞关系预先建立查询表。

一个经验参数供参考：10毫秒内的计算时间分配中，粗检测（AABB层）占20%，精检测（按需做连杆对距离计算）占60%，余下20%是数据准备和结果输出。

4.2 工程中的优化手段

在算力受限环境下做碰撞检测，我积累了几条有效的优化手段：

第一，空间划分减少候选对。双臂各有7个连杆（不含手爪），全配对是7x7=49对，但物理空间上相隔很远的连杆对根本无需检测。我引入基于包围球的空间哈希网格，每个连杆根据当前位姿注册到它所在的网格单元，检测时只对同一网格或相邻网格内的连杆对做AABB粗检测。这个策略在实际工况中能把需要精检测的连杆对从49对降为6-10对。

第二，优先级分级刷新。当前时刻距危险最近的那几对连杆（比如距离小于安全阈值2倍），每个控制周期都做完整精检测；距离较远的对，每2-3个周期刷新一次。如果一个连杆对连续3个周期距离都在安全范围之外，可以进一步降频。这是一种基于时间的自适应调度，实际使用中既保证了安全性又显著降低了平均计算量。

第三，利用多核并行。星载计算机虽然总体算力不高，但一般不止一个核心。我把两条机械臂的碰撞模型更新、粗检测、精检测拆成独立的并行任务，用共享内存同步结果，耗时能再压缩约30%。这里要注意避免线程间锁竞争，所有共享数据用双缓冲机制。由于涉及具体软件框架，后续在某个具体项目中可以通过实际并发框架落地。

4.3 阈值与安全策略的设定

碰撞检测如果没有合理的阈值设定，再好的算法也无法保障安全。阈值体系我习惯分三层：

30毫米这个数字不是拍脑袋定的，它由三方面余量叠加而来：控制误差约±10毫米，动力学模型不确定度带来的位置偏差约±10毫米，再留出10毫米用于覆盖检测算法本身的数值误差。如果任务对精度要求更高（比如对接任务），这个阈值需要相应缩小，但同时要求控制误差必须压缩。

这里有一个工程共识要强调：空间机械臂的碰撞检测阈值宁可偏大，绝不要为了追求工况极限而压小。因为漏报的代价远大于误报，误报最多浪费一次重新规划的时间，漏报可能导致结构损坏等重大问题。

5. 我在地面验证时踩过的坑

5.1 随机位形采样的覆盖性测试

碰撞检测算法完成后的第一关是随机测试。我的做法是：在两臂关节空间的全部可达范围内随机采样关节角组合，对每一组位形运行碰撞检测，并与高精度离线验证工具（基于精确网格模型）的结果对比，统计检测的漏报率和误报率。

这项工作看似简单，实际坑很多。一开始我随机采样了50万组位形，检测结果一致性接近100%，以为算法没问题了。后来为了赶进度直接进入半物理仿真，结果在某个特定构型附近出现了漏报。百思不得其解时复盘发现：因为随机采样在7维关节空间分布非常稀疏，那些关节角落在狭窄数值区间内的退化构型根本没有覆盖到。后来我改为分维度做边界采样，把每个关节角按1度步长扫过全行程，同时结合随机采样，才把这类边界case暴露出来。

这个教训说明：随机采样必须结合确定性的边界扫描，两者互补，不能只依赖随机性。

5.2 奇异位形附近的数值不稳定

机械臂在奇异位形附近，关节空间很小的变化会引起末端笛卡尔空间的剧烈变化（从数学角度看是雅可比矩阵条件数变得极大）。碰撞检测在这个区域同样会出现数值不稳定：相邻两个控制周期的分离距离计算结果跳变。比如某个时刻计算的最近距离是25毫米，下一时刻直接变成15毫米，而后又跳回22毫米，这种抖动脉冲会让上层控制误判为碰撞风险突变。

解决这个问题不能只靠算法层，需要多层配合。算法层面，我给检测结果加了一个一阶低通滤波，对分离距离的变化率做了限幅；规划层面，通过在奇异位形附近增加关节限位软约束，让机械臂尽量不深入奇异邻域。两者结合后，距离输出变得平滑稳定。

5.3 仿真模型与实物模型不一致

这是工程中最隐蔽、最容易被忽视的问题。仿真用的机械臂几何模型和实物之间存在系统性偏差，尤其在热变形、负载弯折等工况下差异会被放大。某次地面验证中，仿真环境下碰撞检测各指标都正常，但实物测试时检测距离比仿真偏大约5毫米——后来排查发现，是因为臂杆在负载作用下的弹性弯折导致末端实际位置比几何模型低，这个偏差在长臂杆末端被放大，直接影响了碰撞检测的距离精度。

事故复盘后我定了一个规则：碰撞检测模型必须同时建立标称几何模型和最大偏差包络模型，分别用于"正常路径验证"和"最坏情况校核"。在控制逻辑中，仿真验证用标称模型，安全评估用偏差包络模型，确保即使存在未建模的偏差，碰撞风险也在可控范围。

6. 从碰撞检测到避碰策略的最后一步

6.1 检测结果如何接入规划器

碰撞检测算法本身不是终点，它的价值体现在为上层规划器提供决策支撑。我在软件架构上把碰撞检测实现为一个独立的"碰撞查询服务"，对外提供统一接口：

• getMinDistanceState()：获取当前最小分离距离和对应的连杆对信息
• isCollisionImminent(threshold)：判断是否存在距离低于指定阈值的风险
• getCollisionPairs(time_horizon)：预测未来一段时间内可能有碰撞风险的连杆对

规划器在生成路径时，会周期性调用这几个接口。如果检测到距离进入危险阈值，规划器切换到避碰重规划流程，在保持任务目标的前提下，用局部路径调整或采样规划算法搜索新的无碰撞路径。重规划通常在几百毫秒内完成，然后控制权交还正常跟踪。

6.2 特殊情况下的接管策略

碰撞检测触发后的决策不能只有一个"急停"选项。不同风险等级应该有不同响应：

• 分离距离在预警阈值与危险阈值之间：降速+预警，不打断任务流
• 距离小于危险阈值且仍在缩小：暂停当前运动，启动重规划
• 距离逼近物理安全极限或已接触：紧急制动，锁定关节，转入安全停泊模式

这套分级策略的核心思想是：给系统尽量多的反应时间来解决问题，而不是一刀切地急停——急停本身在空间操控中也会带来不小的风险，比如大惯量载荷在急停时的残余动力学响应。

6.3 个人工作中的一些习惯性建议

最后分享几个我自己积累的工作习惯。每一次碰撞检测触发都必须完整记录当时的机械臂构型、任务阶段、分离距离数据链，这些数据是后续算法优化的金矿——我至少两次通过历史告警记录找到了检测算法本身可以改进的薄弱环节。给碰撞检测的所有参数（膨胀半径、薄层厚度、危险阈值）在代码里做统一配置中心，严禁在多个子模块中硬编码，不然任务切换时改参数会漏改某处导致安全隐患。

另外，在仿真验证时我强烈建议用"最苛刻工况"测试：双臂以最大速度相向运动、载荷抓持状态与非抓持状态切换、太阳翼与舱体的不同相对方位都覆盖到。仿真里暴露的问题越多，实物系统越安全。

空间机械臂双臂碰撞检测的工程实现就是这样一个持续迭代的过程：建模求精度、算法求效率、阈值求平衡、验证求全面，每一步都有取舍，最终的安全感来自各个环节踏踏实实的验证，而不是某一个算法的灵光一现。