4. KUKA机器人运动学建模与多机运动约束

在多机协调控制中，运动学模型是所有轨迹规划与协同约束的公共语言。如果两台机器人各自使用不同的建模约定，或者对同一台机器人的DH参数理解不一致，那么“协同”就无从谈起。本节围绕KUKA机器人的运动学建模展开，重点说明DH参数、正逆运动学、雅可比矩阵，以及多机协同中关节限位与奇异规避的实际处理方式。

4.1 DH参数：把机器人结构写成可计算的表

KUKA六轴串联机器人（如KR 6 R900、KR 10 R1100等）通常采用标准DH（Denavit-Hartenberg）约定建模。标准DH用四个参数描述相邻连杆坐标系之间的变换：连杆长度 a_i、连杆扭角 α_i、关节偏距 d_i、关节角 θ_i。其中旋转关节只有 θ_i 是变量，其余三个为常量。

以一台典型KR 6 R900为例，其标准DH参数可近似取为（示例参数，实际应以机器人随机文档为准）：

相邻坐标系变换矩阵为 T_i = Rot_z(θ_i)·Trans_z(d_i)·Trans_x(a_i)·Rot_x(α_i)。将六个矩阵依次相乘，得到基坐标系到法兰坐标系的齐次变换 T_0^6，即正运动学模型。注意：KUKA实际控制器内部使用自己的轴角与法兰坐标系定义，若要与外部算法对接，必须明确“基坐标系原点、法兰坐标系原点、工具坐标系TCP”三者的关系，否则同一组关节角会算出不同的末端位姿。

4.2 正逆运动学与多解选择

正运动学是唯一的：给定六个关节角，末端位姿唯一确定。逆运动学则通常存在多组解。对于KUKA这类带球形手腕的六轴机器人，逆解一般有8组，对应“肩前/肩后、肘上/肘下、腕翻转/腕不翻转”的组合。多机协同中，逆解选择不能只看单机可达性，还要考虑：

• 该解是否远离关节限位，给协同留出调整余量；
• 该解是否靠近奇异位形，导致雅可比矩阵病态；
• 该解与另一台机器人的空间距离是否满足安全间距；
• 该解是否与上一周期的关节角连续，避免关节突变。

实际工程中常用“最小关节位移”准则：在满足限位与奇异裕度的候选解中，选择与当前关节角欧氏距离最小的那组。若两台机器人共享同一工件坐标系，还需把工件坐标系变换统一到各自基坐标系下再求解。

4.3 雅可比矩阵：速度映射与奇异判据

雅可比矩阵 J(q) 描述关节速度到末端速度的线性映射：ẋ = J(q)·q̇。对六轴机器人，J 是6×6矩阵，前三行对应线速度，后三行对应角速度。雅可比矩阵的秩决定了机器人当前位形是否奇异：当 det(J)=0 或最小奇异值接近零时，机器人处于奇异位形，某些方向无法产生末端运动，逆解关节速度会趋于无穷。

KUKA机器人常见的奇异包括：腕部奇异（第4、6轴共线，第5轴接近0°）、肘部奇异（第3轴接近0°或180°）、肩部奇异（腕心落在第1轴轴线上）。多机协同中，奇异不仅影响单机跟踪精度，还会导致协同轨迹在时间上不同步。因此，规划阶段应计算每个路径点的雅可比最小奇异值 σ_min，并设定阈值（例如 σ_min > 0.05）作为可执行判据。

4.4 多机协同中的关节限位处理

单机规划时，关节限位通常作为硬约束直接裁剪。但在多机协同中，两台机器人可能共享一个工件或共同搬运一个部件，此时限位处理需要更谨慎。假设机器人A和B共同夹持一个刚性工件，A的第2轴接近下限，B的第2轴还有较大余量。如果简单让A停止、B继续，工件会被拉扯甚至导致碰撞。正确做法是：在协同轨迹规划阶段，把两台机器人的关节限位统一映射到“工件位姿空间”，检查是否存在同时满足双方限位的工件位姿区间。若不存在，则需要调整工件姿态或更换逆解分支。

实际实现时，可以按以下顺序处理：

1. 对每个协同路径点，分别计算A、B的全部逆解；
2. 剔除超出关节限位的解，记录剩余解的限位裕度；
3. 在剩余解中计算雅可比最小奇异值，剔除低于阈值的解；
4. 对A、B的可行解进行配对，检查配对后工件位姿是否一致；
5. 若存在多组可行配对，选择关节位移最小且限位裕度最大的一组。

4.5 奇异规避的工程做法

奇异规避不能等到运行时才处理，而应在轨迹规划阶段完成。常用方法有三种：一是路径绕行，在接近奇异位形时改变末端路径，使机器人绕开奇异区域；二是阻尼最小二乘（DLS），在逆解中引入阻尼因子 λ，用 q̇ = J^T(JJ^T + λ^2I)^{-1}ẋ 代替直接求逆，牺牲少量末端精度换取关节速度有界；三是任务优先级降级，在接近奇异时暂时放弃某些次要方向（如工具姿态微调），优先保证主运动方向。

在多机协同中，推荐把奇异裕度作为协同约束的一部分：当任一机器人的 σ_min 低于阈值时，触发协同减速或路径重规划，而不是让单机独自处理。这样两台机器人的时间基准仍然一致，避免一台减速、另一台继续造成工件受力不均。

4.6 一个可复用的检查清单

在多机协同项目调试前，建议按以下清单逐项确认：

运动学建模是多机协同的底层基础。DH参数决定了模型是否可信，逆解选择决定了轨迹是否连续，雅可比判据决定了运动是否安全，而关节限位与奇异规避则决定了协同任务能否真正落地。把这四件事在规划阶段处理清楚，运行时的协同控制才会稳定可靠。