3. 同步轨迹控制概述
双臂机器人并不是两台单臂机器人的简单叠加。当两只机械臂共同搬运一个刚性工件、协同拧紧一颗螺栓，或是一手扶持、一手装配时，两条末端轨迹之间就产生了强耦合约束。同步轨迹控制的核心任务，就是让多个运动轴或两条机械臂在时间维度上保持协调，使被操作对象的位姿、内力与运动节奏同时满足工艺要求。理解同步控制，需要从基本概念、分类方式、性能指标与关键挑战四个层面建立整体认识。
一、同步控制的基本概念
同步控制是指在一个多轴或多机器人系统中，通过协调各运动主体的位置、速度、加速度乃至力矩，使它们按照预定的时空关系共同完成一项任务。它包含两层含义：一是时间同步，即各轴在同一时刻到达各自的目标点，保证动作节拍一致；二是空间同步，即各轴之间的相对位姿满足几何约束，例如双臂末端始终保持固定距离与姿态关系。
从数学上看，若将双臂末端位姿记为 x₁(t) 与 x₂(t)，同步约束可抽象为 Φ(x₁, x₂, t) = 0。控制器的目标是在跟踪各自期望轨迹的同时，使该约束误差收敛到零。因此同步控制本质上是一个带约束的多变量耦合控制问题，而非两个独立跟踪问题的拼接。
二、同步控制的分类
按照控制目标与耦合方式，同步轨迹控制可以划分为若干典型类型，理解分类有助于针对不同工艺选择合适的策略。
- 位置同步：以各轴位置误差最小为目标，常用于点位搬运、双臂同时到达指定位置。
- 速度同步：要求各轴速度按比例或相等，典型场景是传送带跟踪与连续涂胶。
- 力/位混合同步：在位置约束之外引入内力闭环，用于双臂夹持刚性工件，避免因位置误差产生过大挤压或拉扯。
- 主从同步：一臂为主，另一臂跟随，结构简单但主臂误差会直接传递。
- 交叉耦合同步：两臂误差相互反馈，形成对称耦合，抗扰能力更强。
- 虚拟轴同步：将双臂视为一个虚拟多轴机构，统一规划再分解到各臂，适合强约束任务。
三、性能指标
评价同步控制效果不能只看单臂跟踪精度，还要关注耦合层面的表现。常用指标如下表所示。
| 指标 | 含义 | 典型关注点 |
|---|---|---|
| 同步误差 | 实际相对位姿与期望约束的偏差 | 双臂末端距离、姿态角偏差 |
| 跟踪误差 | 单臂末端相对期望轨迹的偏差 | 轮廓误差、稳态误差 |
| 内力误差 | 闭链中非期望内力的幅值 | 夹持力波动、工件变形 |
| 同步带宽 | 系统能有效抑制同步扰动的频率范围 | 动态响应速度 |
| 节拍一致性 | 各轴完成动作的时间偏差 | 循环周期、相位差 |
| 鲁棒性 | 负载、摩擦、通信延迟变化下的稳定性 | 参数摄动容忍度 |
四、关键挑战与典型误区
双臂同步控制面临的首要挑战是闭链约束。两臂与工件构成闭链后，位置误差会转化为内力，轻则造成工件滑移，重则损坏末端执行器。其次是动力学耦合：一臂的加减速会通过工件反作用于另一臂，使原本独立的控制器相互干扰。第三是通信与采样延迟，分布式控制架构下，两臂状态交换存在毫秒级延迟，会削弱同步带宽。第四是建模不确定性，工件质量、刚度与摩擦难以精确已知，固定参数控制器容易在工况变化时失稳。
实际调试中常见三类误区。其一，把同步问题简化为两个独立跟踪问题，忽略耦合项，导致高速段同步误差急剧放大。其二，过度追求位置同步而忽视内力控制，双臂夹持时出现“越夹越紧”的力发散。其三，仅用静态标定补偿同步误差，未考虑动态过程中的相位滞后，使轨迹拐角处出现明显不同步。
下面用一段简化的伪代码说明同步误差的计算与耦合修正思路，便于建立直观印象。
# 双臂同步误差与耦合修正示意
x1_d, x2_d = 期望末端位姿
x1, x2 = 实际末端位姿
e1 = x1_d - x1 # 臂1跟踪误差
e2 = x2_d - x2 # 臂2跟踪误差
e_sync = (x1_d - x2_d) - (x1 - x2) # 同步误差
# 交叉耦合修正：将同步误差按增益分配到两臂
u1 = Kp * e1 + Kc * e_sync
u2 = Kp * e2 - Kc * e_sync
从系统视角看，同步控制的信息流可以概括为：期望轨迹生成 → 同步约束建模 → 各臂控制器 → 耦合对象 → 状态反馈与误差再分配。下图给出这一关系的结构化示意。
综合来看，同步轨迹控制的关键在于把“两条轨迹”当作“一个受约束的整体”来处理。分类决定了耦合方式，性能指标刻画了控制品质，而闭链内力、动力学耦合与延迟则是必须正面应对的挑战。只有同时把握约束建模、误差分配与动态补偿，双臂系统才能在高速高精场景下真正实现协调运动。