2. 多轴平台运动学建模

节拍优化的第一步不是调参数，而是把“平台怎么动”写成可计算的数学表达。多轴运动平台通常由 X、Y、Z 直线轴与 A、B、C 旋转轴组合而成，若没有统一的坐标系与运动学模型，任何节拍估算都只能停留在经验层面。本节围绕四个核心问题展开：坐标系如何定义、轴与轴之间如何耦合、正解与逆解分别解决什么、轨迹如何被参数化描述。

一、坐标系定义：先约定，再计算

多轴平台至少涉及三类坐标系：基坐标系（Base）固定在设备机架上，是全局参考；工件坐标系（Work）定义在夹具或工件上，决定加工/装配位置；工具坐标系（Tool）定义在末端执行器上，如吸嘴、焊枪或探针。三者通过齐次变换矩阵串联：

^Base T_Tool = ^Base T_Work · ^Work T_Tool
^Base T_Work = Trans(x,y,z) · RotZ(C) · RotY(B) · RotX(A)

其中 Trans 为平移，Rot 为绕对应轴的旋转。约定顺序必须固定：本文统一采用“先平移、后旋转，旋转按 Z→Y→X”的顺序，即 RPY 角约定。若中途切换顺序，同一组 (x,y,z,A,B,C) 会得到不同位姿，逆解也会随之改变。方向约定同样要明确：X 向右为正、Y 向前为正、Z 向上为正，绕轴旋转按右手定则判定正方向。这些约定一旦写入模型，全文与图示必须保持一致。

二、轴耦合：为什么单轴速度不能直接相加

多轴平台的节拍不是各轴运动时间的简单叠加，原因在于轴间存在耦合。耦合主要有两类：

• 几何耦合：旋转轴运动会改变直线轴的有效力臂。例如 A 轴旋转 θ 后，末端在 Z 方向的位移为 L·sinθ，此时 Z 轴需要补偿的位移不再是常数，而是随 θ 变化的函数。
• 运动学耦合：末端在笛卡尔空间的速度 v 与关节速度 q̇ 之间通过雅可比矩阵 J 关联：v = J(q)·q̇。当 J 接近奇异（如两轴共线）时，末端速度对关节速度的放大倍数急剧上升，单轴即使达到额定速度，末端仍可能走不动。

因此节拍计算必须基于末端轨迹速度，而不是各轴速度的标量和。实际工程中常用“末端合成速度”作为约束，再反推各轴速度分配。

三、正解与逆解：两个方向，两种用途

正解是已知各轴位置 (x,y,z,A,B,C)，求末端位姿。它用于仿真验证、碰撞检查和轨迹可视化，计算直接、无多解问题。逆解是已知末端目标位姿，求各轴位置。它用于轨迹规划与伺服指令生成，难点在于多解与可达性判断。

以两轴平面平台为例，末端目标 (px, py)，轴长 L1、L2，逆解为：

cosθ2 = (px² + py² − L1² − L2²) / (2·L1·L2)
θ2 = ±acos(cosθ2)          // 肘上/肘下两解
θ1 = atan2(py, px) − atan2(L2·sinθ2, L1 + L2·cosθ2)

两个解对应两种姿态，选择依据是行程余量、奇异规避和节拍最短。若 cosθ2 超出 [−1,1]，说明目标点不可达，必须报错而不是强行输出。多轴平台逆解通常没有解析式，需用数值迭代（如牛顿-拉夫逊）求解，迭代初值取上一周期位置可保证连续性。

四、轨迹描述：几何路径与时间律分离

轨迹描述的关键是把“走什么形状”和“以什么速度走”分开。几何路径用参数 s∈[0,1] 表示，如直线段 P(s)=P0+s·(P1−P0)，圆弧段用圆心、半径和起止角表示。时间律则给出 s(t)，常见有梯形速度与 S 形速度。梯形速度分加速、匀速、减速三段，节拍最短但加速度突变；S 形速度加入加加速度限制，运动更平滑，节拍略长但振动小。

以一段 300 mm 直线为例，设定 v_max=500 mm/s、a_max=2000 mm/s²。加速段位移 s_a=v_max²/(2a_max)=62.5 mm，加速时间 t_a=v_max/a_max=0.25 s。若总位移 300 mm，则匀速段位移 300−2×62.5=175 mm，匀速时间 0.35 s，总节拍 T=2×0.25+0.35=0.85 s。若改用 S 形速度，加加速度取 20000 mm/s³，节拍约增加 0.06～0.10 s，但末端残余振动可下降一个量级。这类计算正是节拍优化的起点。

五、建模落地检查清单

把上述内容落到工程文件时，建议逐项确认：

完成本节建模后，平台的运动关系已经可以用一组明确的矩阵、雅可比和参数化轨迹表达。后续节拍计算与优化，都将在这套数学表达上进行：改变速度规划参数、调整选解策略或规避奇异区，都会直接反映到 T_total 上。建模的准确性，决定了节拍优化结果是否可信。