双手协调不是两个独立的手臂轨迹同时开始。当双手握住一个刚性物体时，它们的末端执行器形成闭合的运动学链。相对姿态误差会变成接触力、物体变形或滑动。
控制器必须在保持臂间可行关系的同时移动物体，分散负载，并遵守关节、转矩、碰撞和抓握约束。即使每臂准确跟踪自身指令，时序误差和校准偏差仍可能产生内部力。
将此指南与 全体控制指南 及 坐标框架指南一起使用。同时验证物体运动和闭链应力。
用一个对象约束来建模，而不是两个无关的目标
定义物体框架和每个抓握变换。左右工具姿态应由共享物体姿态或一致的相对约束生成。独立目标可能相差毫米或度数，这会对刚性物体产生巨大力。
明确保持抓握顺应性和允许的相对运动。柔性袋、长板和刚性夹具需要不同的约束模型和力限制。
分离绝对坐标和相对坐标
绝对坐标描述对象或协作系统在工作单元中的移动位置。相对坐标描述末端执行器或抓取帧之间的姿态。这种分解将任务运动与闭链关系区分开来。
定义方向、插值和变换方向。一个看似微小的符号或帧错误可能会让机械臂将物体向相反方向旋转。
| 坐标还是变量 | 控制 | 主要约束 | 失败症状 |
|---|---|---|---|
| 物体绝对姿态 | 任务运动 | 世界碰撞与影响范围 | 位置错误 |
| 工具相对姿态 | 闭链 | 抓握几何 | 武器大战 |
| 网状物体扳手 | 加速或接触 | 有效载荷与任务群 | 损失追踪 |
| 内部扳手 | 握把与预载 | 损坏与执行器极限 | 加热或弯曲 |
| 零空间态势 | 联合边缘 | 自碰撞 | 奇点 |
将双臂校准成一个统一的物理框架
两臂的基底零点、关节零点、工具中心点和抓取变换会累积在相对误差中。对每个臂对不同目标进行校准时，可能会留下交叉臂偏差，只有在两臂接触同一物体后才会出现。
使用通用伪影，在调零传感器后测量相对姿态和力。遵循 机器人校准流程，每次测试都保留校准版本。
在所有约束都存在的情况下求解闭链运动
闭链规划器或控制器必须同时满足两个抓握关系，同时尊重关节和碰撞。先采样一个臂，解另一个臂是有用的，但可能会偏向解答，或在狭窄的共享工作区中失效。
当前 MoveIt 双臂文档 展示了多臂配置和规划组。它本身并不能实现物体—力协调或安全行为。
从任务中选择主从角色或对称角色
主从设计允许一只手臂带动，另一只手臂跟随相对姿势或力。对称设计则将任务变量分配到两只手臂。两者都不是绝对优越；工具、刚度、感应和伸展距离决定了有用的分配。
让角色切换显明且无碰撞。参考或力积分器的突然变化即使每个控制器单独稳定，也可能给物体带来冲击。
测量内力与净物体扳手分开测量
内力不会加速刚性物体，但会对握把、物体和关节施加负载。系统在挤压、拉伸或扭转自身时，可以表现出优异的物体姿态追踪。手腕传感器或关节转矩估计可以揭示这种隐藏的应力。
一些预载可能改善握把稳定性。应将物体强度、接触摩擦、传感器偏置和执行器热限制限制限制，而不是强制归零。
按转矩和抓距分配负载
负载均分很简单，但在单臂奇点、关节极限或抓握力弱处可能不理想。分配可以考虑转矩余量、可操作性、接触裕度以及任务扳手的方向。
在运动过程中跟踪分配。随着物体旋转或移动基地移动，可行的静态分割可能变得不可行。
控制时序、抖动和通信丢失
机械臂需要共享时间基础来执行指令、关节状态和力。延迟差值表现为相对跟踪误差，尤其是在快速或硬运动时。仅靠平均延迟就能掩盖有害抖动和丢包。
使用 时间同步指南，并在测试中注入有界延迟。当同步质量超出合格包络时，减速或停止双臂。
规划自碰撞、物体碰撞和可见性
两支臂形成更多自碰撞对，并可能阻挡彼此的摄像机。被持有的物体成为移动碰撞几何体的一部分。电缆和临时支撑装置可能不在标称模型中。
检查整个进近、协同运动、回归和撤退。在同一事件中，两臂都更新物体几何和附着体状态。
将回归视为一个有支持的过渡
在重新抓握时，一只手可以支撑全部载荷，另一只手负责卸载、移动和再次接触。支撑抓握、物体移动和下一次接触必须始终保持在过渡的边缘内。
在载荷转移前定义验证：已建立接触，力方向合理，姿态在公差范围内，且接收臂能够承受载荷。当任何门失效时，中止至支撑状态。
协调保护性止挡和单臂故障
如果一臂停止，另一臂不应继续在旧指令下拉动共享物体。安全响应取决于负载、重力、刹车、夹具和人员操作。两臂可能需要同步停止、受控下降或保持支撑。
测试传感器脱落、驱动故障、保护性停止、握把滑动和物体断裂情况。恢复程序不得使单臂对卡扣或无动力的伙伴重新启用。
| 测试因子 | 变体 | 度规 | 必备的失败证据 |
|---|---|---|---|
| 目标 | 质量、刚度、大小 | 姿态与内力 | 变形 |
| 校准 | 相对偏置注入 | 力与偏 | 变换版本 |
| 时间安排 | 延迟和抖动 | 相对误差与峰值力 | 时钟跟踪 |
| 负载分担 | 非对称范围与转矩 | 边缘与温度 | 关节状态 |
| 断层 | 停止、滑倒、传感器丢失 | 安全状态的成功 | 响应时间线 |
发布双手验收检查表
记录对象和抓取框架、绝对和相对目标、负载分配、内部力限制、同步阈值、碰撞模型、停止行为及支持的恢复。将两个机械臂的指令和测量数据存储在一个时间轴上。
通过以下清单进行验证。
评估“双臂机器人协调控制”时，还应保存模型版本、机器人配置、标定文件、测试日期和全部试验记录。把成功、失败、恢复与人工介入放在同一份数据中，才能区分模型能力、系统接口和现场流程造成的差异。
成本评估除了设备与算力，还要记录数据采集、工程调试、安全措施、维护、停机和人员培训。只有把这些持续投入与单位成功任务的价值比较，才能判断方案是否适合扩大。
上线后仍要持续检查分布变化、传感器漂移、机械磨损和人工接管原因。监测结果应能触发降级、停止与重新验证流程，并为下一轮数据采集和模型更新留下可追溯记录。
最终结论应明确写出已知限制、尚未验证的场景和下一项可证伪的实验，使后续团队能够沿着证据继续推进。
实际项目还应指定数据、模型、控制器和安全流程的负责人，并预先定义回滚条件。责任边界、审批记录与变更日志越清楚，故障发生后越容易停止扩散、定位原因并安全恢复。
把任务拆成感知、决策、动作执行和结果确认，可以更准确地定位瓶颈。每一阶段都应有独立指标与失败示例，避免用端到端成功率掩盖偶发但严重的风险。
引用的产品规格、论文结果和监管要求需要记录发布日期与适用版本。资料更新后应重新核对关键结论；无法从一手来源确认的内容，应明确标注为待验证信息。
小规模试点的价值在于提前暴露接口、人员协作和异常处理问题。试点结束后应依据预设门槛决定扩大、修改或停止，而不是因为已经投入资源就默认继续。
所有结论都应能够追溯到原始记录，并可复核。
硬件与软件接口应分别记录单位、坐标系、时钟、延迟和允许范围，并通过自动测试检查不一致。接口定义变化时，旧数据和旧控制参数不能在未经验证的情况下直接复用。
异常测试应覆盖断电、通信丢失、传感器失真、对象滑移和人员进入工作区等情形。系统不仅要发现异常，还应以可预测的方式减速、停止或请求人工确认。
- 校准双臂相对几何。
- 明确控制对象和相对坐标。
- 分别测量网和内扳手。
- 测试延迟、抖动、碰撞和负载转移。
- 将单臂故障协调到系统安全状态。
常见问题
两条手臂路径能否独立规划并共同执行？
仅适用于没有共享刚性约束且经过碰撞检查后的任务；共享对象工作需要一致的相对关系。
主从控制比对称控制更差吗？
不。这是一种角色分配，有不同的权衡；任务几何形状、刚度、感应和覆盖范围决定了适用性。
内力应该永远为零吗？
不行。受控预载可以稳定握把，但必须保持在物体、接触点、传感器和执行器范围内。
如果一只手臂进入保护性止挡会发生什么？
另一臂需要协调的预定义响应，如同步停止、支撑或受控下放，并针对负载进行验证。
主要的双手指标是什么？
物体姿态、相对姿态、网扳手和内部扳手、负载分担裕度、碰撞间隙、时序及故障恢复成功率。
闭链内力与止点边界
双手系统在共享接触时是一台闭链机器。安全和恢复逻辑必须协调两个机械臂和受支撑物体，而不仅仅是两个控制器。