4. 协同控制核心概念

双臂机器人协同控制的核心，不是把两条机械臂各自控制好再简单叠加，而是要在统一的任务语义下，明确“在哪里协同、以什么位姿关系协同、由谁主导协同、控制权如何分配”。本节围绕协同空间、相对位姿、绝对位姿、主从控制、对等控制与混合控制架构六个概念展开，它们共同构成双臂协同控制工程的概念骨架。

一、协同空间：双臂共同可达且可用的作业域

协同空间（Collaborative Workspace）指两条机械臂在满足关节限位、避碰约束、负载能力和任务精度要求的前提下，能够同时参与同一作业的有效空间集合。它并不等于两个单臂工作空间的简单交集，因为双臂同时进入该区域时，还要考虑臂间最小安全距离、共享工件的可操作性和奇异位形规避。

从工程角度看，协同空间可分为三类：重叠协同区，两臂均可到达且可共同操作同一工件；交接协同区，适合完成工件从一臂到另一臂的传递；独立作业区，两臂各自工作但需保持动态避碰。协同空间分析通常需要结合可达性地图、碰撞距离场和任务优先级共同评估。

二、相对位姿与绝对位姿：协同关系的两种描述

绝对位姿描述每个末端或工件在统一世界坐标系下的位置与姿态，通常记为 ^W T_L 和 ^W T_R，分别表示左臂和右臂末端相对世界系的齐次变换。绝对位姿适合做全局路径规划、避障和任务空间定位，但直接分别控制两个绝对位姿，容易在装配、搬运等任务中产生累积的相对误差。

相对位姿描述两臂末端之间或末端与工件之间的位姿关系，记为 ^L T_R，即右臂末端相对左臂末端的变换。相对位姿是双臂协同的关键量：在刚性夹持、轴孔装配、双手搬运等场景中，任务成败往往取决于相对位姿是否稳定，而不是单个绝对位姿是否绝对精确。

绝对位姿关系：
  ^W T_L = [ R_L  p_L ]
           [ 0    1  ]
  ^W T_R = [ R_R  p_R ]
           [ 0    1  ]

相对位姿关系：
  ^L T_R = (^W T_L)^(-1) · ^W T_R

协同约束示例：
  || p_R - p_L || = d_desired
  R_L^T · R_R = R_relative_desired

实际控制中常采用“绝对位姿定基准、相对位姿保协同”的策略：一条臂按绝对轨迹运动，另一条臂以相对位姿约束跟随，从而把协同误差限制在任务允许的范围内。

三、主从控制、对等控制与混合控制架构

主从控制（Master-Slave Control）指定一条臂为主臂，另一条为从臂。主臂按任务轨迹运动，从臂根据主臂位姿和期望相对位姿解算自身目标。其优点是结构清晰、实现简单、协同关系容易保证；缺点是主臂承担全部规划压力，从臂响应存在滞后，且主臂故障会直接影响协同任务。

对等控制（Peer-to-Peer Control）中两条臂地位相同，共同接受上层任务约束，通过分布式或集中式协调器同时求解两臂运动。它适合双手协调搬运、柔性装配等需要双向力位交互的场景，但控制耦合更强，对通信周期、同步精度和求解实时性要求更高。

混合控制架构则把任务分解为不同阶段：在接近阶段采用对等控制以保持灵活避碰，在接触和装配阶段切换为主从控制以保证相对位姿稳定，在释放阶段再回到对等控制。混合架构的关键是设计明确的切换条件、切换时的位姿连续性和力/位控制模式过渡。

四、方法流程：从任务到协同控制架构的落地步骤

1. 任务分解：把作业拆成接近、抓取、搬运、装配、释放等阶段，标注每阶段对绝对位姿和相对位姿的精度要求。
2. 协同空间校验：在目标工件位姿下计算两臂可达性、碰撞距离和奇异指标，确认当前阶段处于可用协同空间内。
3. 位姿关系定义：确定基准臂、期望相对位姿 ^L T_R_des 及其容差，明确绝对位姿轨迹由谁提供。
4. 架构选择：根据任务阶段选择主从、对等或混合控制，并设定切换条件，如接触力阈值、相对位姿误差阈值或时间节点。
5. 同步与监控：统一控制周期，监控相对位姿误差、关节速度、臂间距离和力反馈，超限时触发降速或急停。

五、案例场景：轴孔装配中的架构切换

以双臂轴孔装配为例。接近阶段，两臂分别持轴和孔件，采用对等控制，各自规划无碰撞路径，保持较大安全距离；接触阶段，切换到主从控制，以持孔臂为主臂，持轴臂按相对位姿约束做柔顺插入，相对位姿误差控制在 0.2 mm 和 0.5° 以内；插入完成后，再切回对等控制完成释放和退出。该案例说明，混合控制架构的价值在于让不同阶段使用最合适的协同关系，而不是全程只用一种模式。

六、常见误区与复盘要点

掌握协同空间、相对位姿、绝对位姿以及主从、对等、混合三类架构，就能够在双臂协同控制工程中建立清晰的问题边界：先判断“能不能一起做”，再定义“以什么位姿关系做”，最后决定“由谁主导、如何切换”。这三步是后续轨迹规划、力位控制和同步实现的共同基础。