2. KUKA机器人运动学基础

节拍优化的第一步不是调速度倍率，而是理解机器人“怎么动”。KUKA机器人的运动由两套坐标描述：关节空间（A1～A6六个轴角度）和笛卡尔空间（基坐标系下的 X、Y、Z 与 A、B、C 姿态）。同一段轨迹，用关节插值（PTP）还是笛卡尔直线插值（LIN/CIRC），其速度上限、路径形状和可达性完全不同，直接决定单循环时间。

关节空间与笛卡尔空间的本质差异

关节空间描述的是每个轴电机侧的转角，KUKA 用 $AXIS_ACT 可读取当前六轴角度。PTP 运动只在关节空间做同步插值，各轴按各自最大角速度与角加速度运行，因此路径在笛卡尔空间里是弯曲的、不可预知的，但速度最快。笛卡尔空间描述 TCP 在基坐标系中的位姿，LIN、CIRC、SPLINE 都属于此类，路径是确定的直线或圆弧，但需要实时求解逆运动学，速度受限于最慢的那个轴。

对节拍的影响可以这样理解：PTP 快但路径不可控，LIN 可控但慢。在搬运、码垛这类“点对点”任务中，若中间无障碍，用 PTP 往往比 LIN 快 20%～40%。而在涂胶、焊接、切割等要求轨迹精度的场合，必须用 LIN/CIRC，此时节拍优化空间主要来自姿态规划与速度重规划，而非插值方式切换。

奇异点：速度的隐形天花板

奇异点是机器人雅可比矩阵降秩的位姿。KUKA 六轴机器人常见三类奇异：

• 腕部奇异：A5 轴接近 0°，A4 与 A6 轴共线，此时绕 TCP 的微小姿态变化需要 A4/A6 极大角速度。
• 肘部奇异：A3 轴接近 0°，手臂接近完全伸展，径向运动能力骤降。
• 肩部奇异：腕部中心落在 A1 轴线上，A1 与 A4 的旋转效果重合。

奇异点附近，笛卡尔速度与关节速度的映射关系恶化。即使程序设定 TCP 速度 1 m/s，控制器为保持轨迹也会让某轴瞬间冲到极限，触发 $VEL_ACT 超限或 KUKA.EXCESSIVE 类报警，实际表现为“减速—停顿—再加速”，节拍被拉长。工程上判断是否靠近奇异，可观察 A5 绝对值是否小于 15°、A3 绝对值是否小于 10°，或直接看示教器上各轴速度条是否出现单轴饱和。

工作空间对可达性与节拍的约束

工作空间是机器人能到达的位姿集合，受臂长、关节限位和自身干涉限制。KUKA 的 $WORKSPACE 监控可设定允许的笛卡尔范围。当轨迹点靠近工作空间边缘时，逆解可能只有唯一解甚至无解，控制器被迫选择“绕远”的关节构型，路径变长、节拍变差。更隐蔽的是：同一个 TCP 点可能存在 8 组逆解（肩前/肩后、肘上/肘下、腕翻转），不同构型下各轴行程差异巨大，切换构型往往意味着额外的大角度回转。

四者对节拍的联合作用

把上述关系串起来看：工作空间决定“能不能到”，奇异点决定“能不能快”，关节/笛卡尔空间决定“用哪种插值”，而逆解构型决定“走哪条关节路径”。四者共同构成节拍的下限。下面这张图把同一段搬运任务在两种策略下的差异可视化出来，帮助建立直观判断。

图中左侧 PTP 路径弯曲但各轴可同时发挥最大能力，示例节拍约 2.6 s；右侧 LIN 路径精确，但 A5 从 30° 逼近 2°，进入腕部奇异区，控制器在接近奇异时主动降速，示例节拍约 3.4 s。两者相差约 30%，这就是运动学选择对节拍的直接影响。

工程判断与优化切入点

实际优化时，建议按以下顺序排查：

1. 先确认任务是否真的需要笛卡尔直线。若只是点到点搬运，优先改 PTP，并检查 $APO_DIST 与 $APO_FAC 是否可适当放宽。
2. 再检查轨迹是否穿越奇异区。若 A5 行程中必须经过 0° 附近，可调整 TCP 姿态或工件摆放，让 A5 保持在 20°～160° 区间。
3. 然后检查逆解构型是否一致。同一程序中若 P1 用肩前解、P2 用肩后解，A1 可能多转 180°，节拍白白增加。可用 $AXIS_ACT 记录各点轴角，确认构型连续。
4. 最后才考虑速度倍率与加速度参数。若前三条未处理，单纯提高倍率只会更快触发奇异报警或轴限位。