1. 课程导入
双臂机器人同步轨迹控制，是指让两台机械臂在同一任务空间内，按照时间、位置、姿态与力约束协同运动的一类控制技术。它并不是“把两条单臂轨迹简单叠加”，而是要在关节空间、任务空间和时间轴上同时满足协调关系：两臂既要各自跟踪期望轨迹，又要在相对位姿、接触力、负载分配和避碰约束上保持一致。典型对象包括协作机器人双臂系统、人形机器人上肢、工业双臂装配单元以及空间/水下双臂作业平台。
一句话定义：双臂同步轨迹控制 = 多臂运动学/动力学约束 + 时间同步 + 相对位姿协调 + 闭环反馈修正，使两臂在动态环境中完成稳定、可重复的协同操作。
1.1 为什么需要“同步”而不是“各自控制”
单臂控制的目标通常是末端到达指定位置并保持姿态稳定；双臂控制则多了一层“关系约束”。例如双手搬运一个刚性箱体时，两臂末端必须保持固定的相对距离和相对姿态，否则箱体会被拉伸、挤压或滑脱。若两臂各自独立跟踪轨迹，即使每条轨迹误差都很小，误差在相对坐标系中也可能被放大，导致内力激增、工件损坏或抓取失败。
因此，同步轨迹控制的核心不是追求单臂绝对精度最高，而是追求相对精度、时间一致性和约束满足度。常见约束包括：
- 相对位姿约束：两末端保持固定变换矩阵，如双手持物。
- 时间同步约束：两臂在指定时刻到达对应路径点，避免“一快一慢”。
- 力/力矩约束：接触任务中限制内力，防止过载。
- 避碰约束：两臂之间、臂与本体/环境之间保持安全距离。
- 关节/速度/加速度约束：满足各臂物理极限与平滑性要求。
1.2 学习目标
完成本课程后，学习者应能：
- 理解双臂同步轨迹控制的数学描述，包括协调空间、相对雅可比与约束方程。
- 掌握主从同步、分布式同步、力位混合等典型控制结构的适用条件。
- 能够设计时间同步与轨迹缩放策略，处理两臂速度不匹配问题。
- 能够分析同步误差来源，并给出参数整定与补偿方案。
- 能够在仿真或实际平台上完成抓取、搬运、装配等双臂协同任务验证。
1.3 整体知识框架
本课程按“建模—规划—控制—验证”的主线展开。下图给出双臂同步轨迹控制的知识框架与信号关系：左侧为输入与任务层，中间为协调规划与同步控制核心，右侧为执行与反馈层。
1.4 典型应用场景
双臂同步轨迹控制的应用场景通常具有“需要两只手配合”的共性。下表列出典型场景及其关键约束：
| 应用场景 | 同步对象 | 关键约束 | 典型控制方式 |
|---|---|---|---|
| 双手搬运刚性箱体 | 两末端相对位姿 | 内力最小、防滑脱 | 主从同步 + 力位混合 |
| 双臂轴孔装配 | 插入方向与接触力 | 对中精度、柔顺性 | 阻抗控制 + 视觉伺服 |
| 双臂协同拧螺丝 | 旋转相位与轴向力 | 力矩同步、防过载 | 分布式同步 + 力矩分配 |
| 人形机器人端托盘 | 托盘水平与高度 | 动态平衡、避碰 | 协调规划 + 全身控制 |
| 空间双臂捕获目标 | 相对位姿与动量 | 微重力、时延 | 预测同步 + 自适应控制 |
1.5 常见误区与学习建议
误区一：认为“两臂各自PID调好，同步自然就好”。实际上相对误差会耦合放大，必须显式建立协调约束。
误区二：只关注位置同步，忽略时间同步。两臂到达同一路径点的时间差会直接转化为内力或轨迹偏差。
误区三：把同步控制等同于主从控制。主从只是其中一种结构，分布式同步在负载均衡和容错上更有优势。
误区二：只关注位置同步，忽略时间同步。两臂到达同一路径点的时间差会直接转化为内力或轨迹偏差。
误区三：把同步控制等同于主从控制。主从只是其中一种结构，分布式同步在负载均衡和容错上更有优势。
学习建议：先建立“协调空间”概念，再理解相对雅可比如何把两臂关节速度映射到相对位姿速度；随后用仿真验证时间缩放与力分配策略；最后在实机上做低速、小负载的抓取搬运实验，逐步提高动态性能。
本课程后续将围绕上述框架逐层展开：从双臂运动学与协调空间建模出发，进入轨迹规划与时间同步，再深入到力位混合、阻抗控制与优化求解，最终通过装配、搬运等综合案例完成闭环验证。掌握这一主线，就能把“两条臂”真正变成一个协调一致的操作系统。