1. 课程导入
双臂机器人协同控制，是指让两条或多条机械臂在同一任务空间中共享感知、规划与控制信息，通过协调运动、力分配和时序配合，完成单臂难以胜任的复杂操作。它并不是简单地把两台机械臂放在一起，而是要让它们像人的双手一样，在抓取、搬运、装配、拧紧、插拔等动作中形成互补与约束。其核心问题可以概括为：任务如何分解、运动如何协调、力如何分配、冲突如何消解、状态如何同步。
1.1 核心原理：从单臂到双臂的跃迁
单臂控制通常以关节空间或笛卡尔空间轨迹跟踪为主，控制器只需保证末端执行器到达目标位姿。双臂协同则引入了一个新的约束层：当两臂共同夹持一个刚性物体时，系统构成闭链结构，两臂末端之间的相对位姿必须满足物体几何约束。此时若两臂各自独立跟踪轨迹，微小的位置误差就会在物体上产生巨大内力，甚至导致工件变形或机械臂过载。
因此，双臂协同控制通常采用主从协调、对称协调或混合协调三种策略。主从协调中，一条臂作为主导臂规划轨迹，另一条臂跟随并补偿相对位姿；对称协调中，两臂共同承担任务，通过虚拟约束或相对雅可比矩阵实现同步；混合协调则根据任务阶段动态切换主导权。无论哪种策略，都需要解决三个基础问题：
- 运动学协调：建立双臂相对雅可比矩阵，将物体运动映射到两臂关节速度。
- 力协调：将期望合力与内力解耦，避免两臂“打架”。
- 时序协调：保证抓取、移动、放置等阶段的动作顺序和同步精度。
下面用一张关系图概括双臂协同控制系统的核心组成与信息流。图中左侧为任务层，中间为协调层，右侧为执行层，底部为感知与状态反馈。
1.2 发展历程：从遥操作到智能协同
双臂机器人协同控制的发展大致经历了四个阶段。第一阶段是遥操作与主从跟随，操作员通过主手控制从手，双臂之间缺乏自主协调，主要用于核工业与深海作业。第二阶段是位置协调控制，研究者引入相对雅可比矩阵和闭链约束，使两臂能够共同搬运刚性物体，但力控制能力较弱。第三阶段是力位混合与柔顺控制，六维力传感器和阻抗控制被引入，双臂可以完成插拔、拧紧等接触任务。第四阶段是智能协同与学习控制，结合视觉、触觉和强化学习，双臂开始具备任务自适应和故障恢复能力。
| 阶段 | 核心技术 | 典型能力 | 局限 |
|---|---|---|---|
| 遥操作 | 主从映射、力反馈 | 远程抓取、危险环境作业 | 依赖人工、自主性低 |
| 位置协调 | 相对雅可比、闭链约束 | 共同搬运、刚性装配 | 内力不可控、易过载 |
| 力位混合 | 阻抗控制、力分配 | 插拔、拧紧、表面跟踪 | 建模复杂、参数敏感 |
| 智能协同 | 视觉伺服、强化学习 | 自适应抓取、故障恢复 | 数据需求大、可解释性弱 |
1.3 典型应用场景
双臂协同控制已进入多个真实场景。在工业装配中，双臂可以分别抓取壳体和盖板，完成对位、压合与螺钉拧紧；在物流分拣中，双臂可协同搬运大尺寸箱体，或一臂抓取、一臂辅助定位；在医疗康复中，双臂外骨骼可辅助患者完成双手协调训练；在家庭服务中，双臂机器人可完成开抽屉、倒水、叠衣服等需要双手配合的任务；在太空与核环境中，双臂协同可替代人类完成危险操作。
1.4 学习路线图与常见误区
本课程共30章，整体学习路线分为五个模块：基础建模（运动学、动力学、相对雅可比）、协调控制（主从、对称、力分配、阻抗控制）、感知与规划（视觉、触觉、避障、任务规划）、系统实现（实时通信、状态机、ROS/ROS2集成）、综合实战（装配、搬运、故障恢复）。建议学习顺序为：先建立单臂控制基础，再进入双臂协调，最后完成综合项目。
学习路线速览：
第1-6章 基础建模：运动学、动力学、相对雅可比、闭链约束
第7-14章 协调控制：主从协调、对称协调、力分配、阻抗控制
第15-21章 感知规划：视觉伺服、触觉反馈、避障、任务规划
第22-27章 系统实现：实时通信、状态机、ROS2集成、仿真
第28-30章 综合实战：装配、搬运、故障恢复与性能评估