4. 双臂协调任务分类

双臂协调是人形机器人区别于单臂工业机器人的核心能力之一。当两个上肢需要在同一工作空间内共同完成一项任务时，控制策略不再只是两条独立运动链的简单叠加，而是需要在运动学约束、动力学耦合、力/位混合控制以及任务优先级等多个维度上进行统一规划。根据双臂末端执行器之间的物理接触关系、信息传递方向和控制权限分配，工程上通常将双臂协调任务划分为刚性协调、柔性协调、主从协调和对等协调四种基本类型。这四种类型并非互斥，实际应用中往往以组合形式出现，例如在装配任务中，一只手刚性夹持工件，另一只手进行柔性寻位，同时通过主从策略传递期望位姿。理解这四种协调模式的本质区别与适用边界，是进行双臂运动规划、阻抗参数整定和任务调度设计的前提。

上图从任务约束、信息流向、控制带宽和典型应用四个维度给出了四种协调模式的整体映射。刚性协调强调闭链约束下的零相对运动，柔性协调引入可控的柔顺量，主从协调建立非对称的位姿传递关系，而对等协调则让双臂在任务层面共享决策权。下面分别对每种模式的核心原理、判断方法、实战案例和常见误区展开论述。

4.1 刚性协调：闭链约束下的高刚度同步

核心原理

刚性协调（Rigid Coordination）指双臂末端通过刚性连接件（如法兰盘、夹具或直接夹持同一刚体）形成运动学闭链，两臂之间不存在相对自由度。此时双臂系统等效于一个并联机构，其运动学约束可表示为：

pose_L = pose_R ⊗ T_offset

其中 pose_L 和 pose_R 分别为左右臂末端位姿，T_offset 为两末端之间的固定齐次变换矩阵。控制目标是在整个运动过程中严格保持该约束关系，任何一侧的位置偏差都会在闭链中产生内部应力，进而导致机构卡死或电机过流。

判断方法

• 物理连接检查：双臂末端是否通过螺栓、真空吸盘或机械爪刚性锁紧同一工件？若存在弹性元件或间隙，则不属于纯刚性协调。
• 自由度计算：采用 Grübler 公式计算闭链机构的自由度。若系统自由度小于双臂自由度和，说明存在冗余约束，需要协调控制。
• 控制架构：刚性协调通常采用集中式控制器，由单一控制器同时解算双臂逆运动学，并实时补偿闭链误差。

案例拆解：大型电池模组搬运

某工厂需要人形机器人双臂搬运 50kg 的电池模组（尺寸 600×400×200mm），模组通过专用吊具与双臂末端刚性连接。初始方案采用双臂独立位置控制，结果在启动和停止阶段出现明显的“抢力”现象——左臂超前右臂 3mm，导致吊具扭曲变形。分析发现，双臂各自的位置闭环带宽不一致（左臂 8Hz，右臂 12Hz），在动态过程中产生相位差。解决方案：① 将双臂控制频率统一为 1kHz，采用主从式刚性协调，以左臂为基准，右臂通过闭链雅可比实时修正；② 在控制器中增加内部力传感器，检测到闭链内力超过 200N 时自动降低加速度；③ 增加前馈补偿项，将模组重心偏移量（沿 X 方向 15mm）纳入动力学模型。改进后，双臂同步误差从 ±3mm 降至 ±0.5mm，搬运周期缩短 18%。

常见误区

• 误区一：认为刚性协调只需要保证最终位姿一致，忽略运动过程中的同步误差。
• 误区二：将双臂分别进行轨迹规划再拼接，未考虑闭链约束对逆解的影响。
• 误区三：忽视温度变化引起的臂杆热膨胀，导致长时间运行后闭链内力逐渐增大。

4.2 柔性协调：阻抗控制与有控柔顺

核心原理

柔性协调（Flexible Coordination）允许双臂末端之间存在受控的相对运动，通过阻抗控制或导纳控制建立力-位移的动态关系。典型模型为二阶阻抗方程：

M_d * Δẍ + B_d * Δẋ + K_d * Δx = F_ext

其中 M_d、B_d、K_d 分别为期望惯量、阻尼和刚度矩阵，Δx 为位置修正量，F_ext 为外部接触力。柔性协调的核心在于“有控柔顺”——既不是完全刚性的位置约束，也不是完全自由的力量控制，而是根据任务阶段动态调整阻抗参数。

判断方法

• 接触力要求：任务中是否存在需要控制接触力大小的环节（如装配插入、表面打磨）？
• 位置不确定性：工件尺寸公差是否大于机器人重复定位精度？若是，则需要柔性补偿。
• 控制模式：检查控制器是否支持力/位混合切换，是否具备实时阻抗参数调整接口。

案例拆解：轴承柔性装配

在电机轴承装配任务中，轴承外圈与壳体孔之间的过盈量为 0.02mm。若采用刚性协调，双臂分别夹持轴承和壳体进行压装，极易因轴线偏差导致卡滞。实际方案：左臂夹持壳体（位置控制），右臂夹持轴承（阻抗控制），初始阻抗参数设为 K_d=2000N/m、B_d=200Ns/m。当右臂检测到接触力超过 50N 时，自动将 K_d 降至 500N/m，允许 2mm 的径向偏移。通过力传感器反馈，系统在 0.8s 内完成寻位插入，峰值力控制在 120N 以内，远低于刚性压装的 350N。该方案将装配成功率从 82% 提升至 99.5%。

常见误区

• 误区一：将阻抗控制等同于简单的弹簧-阻尼模型，忽略机器人动力学耦合。
• 误区二：阻抗参数设置过大，导致系统接近刚性，失去柔顺效果。
• 误区三：未考虑双臂之间的内力耦合，左右臂各自独立调整阻抗，可能产生振荡。

4.3 主从协调：非对称控制与位姿传递

核心原理

主从协调（Master-Slave Coordination）定义了一条明确的信息传递链路：主臂（Master）负责规划期望轨迹，从臂（Slave）通过实时跟随主臂末端位姿来执行任务。从臂的控制目标为：

pose_slave_desired = pose_master_current ⊗ T_offset

这种模式适用于双臂需要保持固定相对位姿但主臂承担主要负载的场景。主从协调的关键在于通信延迟补偿和从臂的跟踪带宽设计。

判断方法

• 任务不对称性：双臂中是否有一侧承担主要力/力矩，另一侧仅起支撑或跟随作用？
• 控制权限：是否明确指定了主臂的轨迹生成权限？从臂是否只接收位姿指令而不参与规划？
• 通信架构：主从之间采用共享内存、EtherCAT 还是无线通信？延迟是否满足控制周期要求？

案例拆解：人形机器人端盘子

在服务场景中，机器人需要双臂端稳一个装有液体的托盘。左臂作为主臂，负责承载托盘主要重量并规划水平移动轨迹；右臂作为从臂，通过安装在手腕的六维力传感器感知托盘接触力，实时调整位姿以保持托盘水平。初始方案中从臂仅做位置跟随，结果在加速阶段托盘倾斜 8°，液体洒出。改进措施：① 将从臂控制模式切换为力-位混合控制，垂直方向采用力控（目标力 20N），水平方向采用位置跟随；② 增加前馈补偿，根据主臂加速度计算惯性力并叠加到从臂指令中；③ 将主从通信周期从 5ms 缩短至 1ms。最终托盘倾斜角控制在 1.5°以内。

常见误区

• 误区一：主从协调中从臂完全被动，忽略从臂自身的动力学补偿。
• 误区二：主臂轨迹变化过快，超出从臂跟踪能力，导致位姿误差累积。
• 误区三：未定义主从切换逻辑，当主臂发生故障时无法平滑转移控制权。

4.4 对等协调：双主动协同与任务级共享

核心原理

对等协调（Peer-to-Peer Coordination）中双臂在控制层面完全对等，不存在固定的主从关系。双臂通过共享任务描述（如共同搬运物体的目标轨迹）和各自的状态信息，在任务级进行协同决策。对等协调的数学描述通常基于双臂闭链动力学方程：

M(q)q̈ + C(q,q̇)q̇ + G(q) = τ + J^T F_ext

其中双臂状态 q 合并为一个向量，F_ext 为双臂末端与物体之间的内力/外力。控制目标是在满足任务约束的前提下，优化双臂的力分配和运动分配。

判断方法

• 任务对称性：双臂是否承担相近的负载？是否都需要主动规划轨迹？
• 控制架构：是否采用分布式控制器，双臂各自独立计算但通过高速总线共享状态？
• 冗余度：双臂自由度之和是否大于任务所需自由度？若是，则存在内力控制空间。

案例拆解：双臂协同拧螺丝

在汽车装配线上，机器人需要双臂协同完成螺丝拧紧任务：左臂夹持螺丝并对准螺纹孔，右臂操作电动螺丝刀。该任务看似主从，但实际要求双臂同时主动调整——左臂需要根据螺丝刀的扭矩反馈微调螺丝姿态，右臂需要根据左臂的位置变化调整拧紧角度。采用对等协调策略：双臂各有一个本地控制器，通过 EtherCAT 总线以 1kHz 频率交换位姿和力信息。任务层采用集中式优化器，每 10ms 计算一次双臂的最优力分配（左臂提供 60% 的支撑力，右臂提供 40% 的拧紧力）。当检测到螺纹滑丝时（扭矩突变），双臂协同退出一段距离并重新寻位。该方案将拧紧合格率从 96% 提升至 99.8%，且能适应不同公差范围的螺丝。

常见误区

• 误区一：将对等协调理解为双臂独立控制，仅在任务层做简单的时间同步。
• 误区二：忽略内力控制，导致双臂互相“较劲”，能耗增加且可能损坏工件。
• 误区三：未考虑双臂动力学差异（如左右臂负载能力不同），导致力分配不均。

4.5 四种协调模式的对比与选型

选型建议：当任务对双臂相对位姿有严格刚性要求时优先选择刚性协调；当存在接触力控制需求或工件尺寸公差较大时选择柔性协调；当任务具有明确的主次分工时选择主从协调；当双臂需要共同决策、动态分配任务时选择对等协调。实际工程中，超过 70% 的双臂任务采用组合模式，例如“刚性+主从”用于重物搬运，“柔性+对等”用于精密装配。

4.6 总结与复盘

本章详细阐述了双臂协调的四种基本模式。核心要点归纳如下：

• 刚性协调的本质是闭链约束下的高精度同步，适用于负载大、相对位姿要求严格的场景，但对机械刚度和控制带宽要求高。
• 柔性协调通过阻抗参数调节实现有控柔顺，是处理接触任务的首选，但参数整定需要结合任务动态调整。
• 主从协调以非对称控制简化了任务规划，适合主臂承载、从臂跟随的场景，但需注意从臂跟踪带宽限制。
• 对等协调实现了双臂在任务级的平等协同，灵活性最高，但对通信和算法复杂度要求也最高。

最后需要强调的是，四种协调模式并非孤立存在。一个复杂的双臂任务往往需要在不同阶段切换协调模式，例如先以刚性协调搬运重物，接近目标位置后切换为柔性协调进行微调，最后以对等协调完成精细装配。掌握每种模式的适用边界和切换条件，是双臂运动规划工程师的核心能力之一。