2. 基础知识
在进入双机械臂任务分配与协调规划之前，必须先把单机械臂的“语言”重新梳理清楚。双机械臂系统并不是两个单臂的简单叠加，它涉及两个运动链在同一物理空间中的耦合、约束与协同。如果对运动学、动力学、工作空间、自由度和雅可比矩阵这些基础概念理解不牢，后续的任务分配、避碰、协同搬运都会变成“凭感觉调参”。本节用一条从几何到力、从单臂到双臂的线索，把这些核心概念串起来。
一、运动学：从关节空间到任务空间
机械臂运动学研究的是“位置、速度、加速度”与关节变量之间的几何关系，不涉及力和质量。它分为正运动学和逆运动学两部分。
- 正运动学（FK）：已知各关节角度
q = [q1, q2, ..., qn]，求末端执行器在基坐标系下的位姿T。常用 DH 参数法或改进 DH 法建立连杆坐标系，通过齐次变换矩阵连乘得到。 - 逆运动学（IK）：已知末端目标位姿，反解关节角。它是任务分配后“把目标点交给哪条臂、以什么构型到达”的关键。逆解可能不存在、唯一或不唯一，这直接影响双臂的可行域判断。
对双机械臂而言，正运动学要分别建立左臂、右臂以及公共基座/工件坐标系之间的变换链。只有把两条链统一到同一世界坐标系，才能判断“左臂末端”和“右臂末端”是否会在同一时刻占据同一空间点。
二、自由度：决定“能做什么”的维度
自由度（DOF）是描述系统位形所需的独立变量数目。一个刚体在三维空间有 6 个自由度：3 个平移加 3 个旋转。机械臂的自由度通常指关节数，但有效自由度还取决于关节类型和构型。
| 概念 | 含义 | 对双臂规划的影响 |
|---|---|---|
| 关节自由度 | 可独立驱动的关节数量 | 决定单臂可达位姿集合的大小 |
| 任务自由度 | 完成任务实际需要的维度 | 如搬运只需 3T+1R，可留冗余用于避障 |
| 冗余自由度 | 关节数大于任务所需维度 | 双臂可借此实现零空间避碰与姿态优化 |
| 系统总自由度 | 两臂关节数之和（含移动基座） | 协调规划搜索空间随其指数增长 |
例如 6 自由度机械臂在三维空间做完整位姿控制时通常没有冗余；7 自由度臂则多出一个冗余维度，可以在保持末端位姿不变的前提下改变肘部位置，这对双臂共享工作空间中的避碰非常有利。
三、工作空间：可达不等于可操作
工作空间是末端执行器能够到达的所有位置的集合。它分为两类：
- 可达工作空间：末端至少能以某一姿态到达的点集。
- 灵巧工作空间：末端能以任意姿态到达的点集，通常是可达工作空间的子集。
双机械臂规划中，真正重要的是共享工作空间与重叠工作空间。两臂各自的可达空间相交区域，是协同搬运、交接、共同装配的候选区域；但该区域也恰恰是碰撞风险最高的区域。因此任务分配时不能只看“点是否在可达空间内”，还要看该点是否在灵巧空间内、是否远离奇异位形、是否与另一条臂的当前构型冲突。
四、雅可比矩阵：速度与力的桥梁
雅可比矩阵 J(q) 描述关节速度与末端笛卡尔速度之间的线性映射：
ẋ = J(q) · q̇
τ = Jᵀ(q) · F第一式说明关节速度如何合成末端速度，第二式说明末端受力如何映射为关节力矩。雅可比矩阵是连接运动学与动力学的核心工具，也是判断奇异位形、分析可操作度、做力分配的基础。
当 J(q) 降秩时，机械臂处于奇异位形：某些方向末端无法运动，逆解不稳定，关节速度可能趋于无穷。双臂协同中，若一条臂接近奇异，另一条臂可能需要承担更多运动或力，否则整体任务会失稳。因此协调规划常把“可操作度” √det(J·Jᵀ) 作为路径优化的指标之一。
五、动力学：从“能到”到“能稳”
运动学回答“能不能到达”，动力学回答“以多大力、多快、多稳地到达”。机械臂动力学方程一般写为：
M(q)q̈ + C(q,q̇)q̇ + G(q) = τ + Jᵀ(q)F_ext其中 M 为惯性矩阵，C 为科氏力与离心力项，G 为重力项，τ 为关节驱动力矩，F_ext 为末端与环境或另一臂的交互力。双机械臂协同搬运同一物体时，两臂通过物体形成闭链约束，内力与外力必须解耦分配：外力负责移动物体，内力负责保持夹持而不压坏工件。这正是动力学层面协调规划的核心问题。
六、案例：共享工作空间中的交接任务
假设左臂要把一个工件交给右臂。规划流程可概括为：
- 确定交接点位于两臂共享工作空间内，且双方逆解均存在、远离奇异。
- 用雅可比矩阵检查交接瞬间两臂末端速度是否匹配，避免相对滑动。
- 用动力学模型估算夹持力与关节力矩，确保交接过程中工件不掉落、不超限。
- 在时间轴上错开两臂运动，使重叠工作空间内的占用时段尽量不冲突。
这个案例说明：任务分配不是简单地把点分给某条臂，而是要在运动学可行、动力学可稳、空间不冲突三者之间同时满足。
七、常见误区与复盘
误区一：只看可达工作空间就分配任务，忽略灵巧空间和奇异位形，导致规划出的路径在仿真中可行、在实机上抖动或卡死。
误区二：把雅可比矩阵只当作速度映射，忘记它同时是力映射，结果在协同搬运时内力分配不合理，工件被压变形。
误区三：认为自由度越多越好。冗余自由度确实增加灵活性，但也让逆解和协调搜索空间变大，实时性下降。
复盘时建议建立一张“单臂能力卡”：记录每条臂的 DH 参数、关节限位、可达/灵巧工作空间范围、典型奇异位形、额定负载与力矩上限。双臂任务分配时，先查能力卡做粗筛，再用雅可比与动力学做细校验，可以显著减少无效搜索。
把上述概念连起来看：自由度决定系统能表达多少种位形，运动学决定这些位形对应末端在哪里，工作空间决定哪些位置值得分配，雅可比矩阵决定速度与力如何传递，动力学决定动作是否稳定可行。双机械臂的任务分配与协调规划，本质上就是在这五个约束的交集里寻找一条既安全又高效的时间—空间—力联合路径。