2. 运动控制基础

多轴同步运动控制的核心挑战，在于让多个执行机构在时间与空间上保持严格协调。无论是五轴数控机床、SCARA机器人还是电子装配中的XYθ平台，其底层逻辑都建立在统一的数学描述之上。本章将系统梳理运动控制的四大基石：坐标系与轴定义、运动学与动力学建模、插补算法原理以及轨迹生成策略。理解这些概念，是后续学习同步耦合算法（如交叉耦合控制、主从跟随）的前提。我们先从全局视角审视这些概念之间的关系。

上图清晰地展示了本章内容的逻辑闭环：坐标系与轴定义是空间基准，运动学与动力学是对象模型，插补与轨迹生成是指令发生器，三者共同服务于多轴同步控制这一核心目标。下面我们逐一深入剖析。

2.1 坐标系与轴定义：空间基准的建立

2.1.1 核心原理：从机床坐标系到工件坐标系

在多轴系统中，坐标系是描述运动位置的参考。最基础的是机床坐标系（MCS），它由机床制造商定义，通常以机床零点为原点，X/Y/Z轴方向遵循右手定则。而工件坐标系（WCS）是编程人员根据工件装夹位置设定的坐标系统，通过G54-G59等指令进行偏置。两者之间的转换关系由坐标变换矩阵描述，包括平移和旋转。

轴定义则涉及两个层面：物理轴（实际电机驱动的轴）与逻辑轴（用户编程时使用的轴）。例如，五轴机床中，物理轴为X/Y/Z/A/C，而逻辑轴可能映射为刀尖点的笛卡尔坐标加两个旋转角度。轴的正方向、软限位、回零方式（增量式/式编码器）都必须在系统初始化时明确。

2.1.2 判断方法与操作流程

在实际调试中，判断坐标系定义是否正确，最直接的方法是执行“手轮试切”：在MDI模式下，用手轮分别沿各轴移动，观察刀具与工件的相对运动方向是否与预期一致。操作流程如下：

1. 确认各轴回零完成，MCS坐标显示稳定。
2. 用寻边器或对刀仪设定WCS原点，记录G54偏置值。
3. 手动移动至WCS原点，验证坐标显示是否为(0,0,0)。
4. 执行空运行程序，观察坐标变换是否引起异常跳变。

2.1.3 案例拆解：五轴机床的轴映射

某五轴联动加工中心，物理轴为X/Y/Z（直线轴）和A/C（旋转轴）。用户编程时使用刀尖点坐标(X,Y,Z)和刀轴矢量(I,J,K)。控制系统需要实时将刀轴矢量转换为A/C轴角度：

// 刀轴矢量转旋转角度（简化示例）
A_angle = atan2(J, K) * 180 / PI;  // A轴绕X轴旋转
C_angle = atan2(I, sqrt(J*J + K*K)) * 180 / PI; // C轴绕Z轴旋转

这里的关键在于，A/C轴的零点必须与刀轴矢量的初始方向对齐。若C轴零点偏了0.1°，在加工直径100mm的圆时，就会产生约0.17mm的轮廓误差。因此，轴定义不仅是软件配置，更涉及机械精度校准。

2.1.4 常见误区与复盘

• 误区一：认为坐标系变换只是简单的平移。实际上，旋转轴的变换涉及非线性映射，必须使用齐次变换矩阵。
• 误区二：忽略轴的正方向定义。不同厂商的机床，Y轴正方向可能相反，导致程序镜像加工。
• 复盘要点：每次更换工装或夹具后，必须重新验证WCS与MCS的偏置值，并执行“程序头校验”功能。

2.2 运动学与动力学基础：对象模型的建立

2.2.1 核心原理：从几何关系到力与运动

运动学研究位置、速度、加速度之间的关系，不考虑产生运动的力。正运动学是已知关节角度求末端位姿，逆运动学则相反。对于串联机构（如六轴机器人），逆运动学通常有多组解，需要根据关节限位和奇异位形进行最优选择。雅可比矩阵将关节速度映射到末端速度，其条件数反映了机构的灵巧度。

动力学则研究力/力矩与运动之间的关系。刚体动力学方程可表示为：

τ = M(q)q̈ + C(q,q̇)q̇ + G(q) + F_friction(q̇)

其中，M为惯量矩阵，C为科氏力和离心力项，G为重力项，F_friction为摩擦力。在高速高精加工中，动力学前馈（尤其是惯量前馈和摩擦力补偿）是提高轮廓精度的关键。

2.2.2 判断方法与参数辨识

判断动力学模型是否准确，最常用的方法是“力矩波动观测”：在恒定速度下运行各轴，记录伺服电机的实际力矩输出。若力矩波动超过额定值的10%，说明摩擦模型或惯量参数不准确。参数辨识的流程包括：

1. 离线辨识：使用专用测试程序，分别执行匀速、匀加速、正弦扫描运动，采集电流和位置数据。
2. 最小二乘拟合：将采集数据代入动力学方程，求解惯量、摩擦系数等参数。
3. 在线自适应：在运行过程中，通过自适应控制算法实时修正参数漂移（如温度变化引起的摩擦变化）。

2.2.3 案例拆解：XY平台轮廓误差分析

某高速贴片机XY平台，X轴行程800mm，Y轴行程600mm，最大加速度2g。在45°斜线运动时，发现轮廓误差达到0.15mm。分析过程如下：

• 初始现象：斜线运动时，X轴和Y轴的跟随误差方向相反，导致合成轨迹向内弯曲。
• 关键参数：X轴电机惯量0.002kg·m²，Y轴电机惯量0.0015kg·m²，但Y轴丝杠导程为20mm，X轴为10mm。
• 分析判断：等效到直线运动的惯量，X轴为0.002×(2π/0.01)²≈789kg，Y轴为0.0015×(2π/0.02)²≈148kg。两者差异巨大，导致Y轴动态响应快于X轴。
• 实际操作：在伺服参数中，将Y轴速度环增益降低30%，并增加X轴加速度前馈。
• 结果对比：调整后，轮廓误差从0.15mm降至0.04mm。

2.2.4 常见误区与总结

• 误区一：只关注单轴跟随误差，忽略多轴之间的动态失配。同步控制的核心是轴间动态一致性。
• 误区二：认为动力学模型越复杂越好。实际中，过参数化会导致辨识不稳定，建议从刚体模型+库仑摩擦开始。

2.3 插补与轨迹生成：指令序列的规划

2.3.1 核心原理：从路径到运动指令

插补是根据给定的路径起点、终点和速度，实时计算中间点坐标的过程。常见的有直线插补（G01）、圆弧插补（G02/G03）。插补周期通常为1ms或0.5ms，每个周期输出一个位置增量。轨迹生成则更高一层，它规划速度曲线（梯形、S形）和加速度曲线，确保运动平滑且不超出电机能力。

现代运动控制器普遍采用“前瞻控制”：提前扫描未来N个路径段，自动减速以平滑拐角。例如，在连续小线段加工中，前瞻算法可以避免频繁启停，将速度损失降到最低。

2.3.2 操作流程：S曲线速度规划

S曲线速度规划分为7个阶段：加加速、匀加速、减加速、匀速、加减速、匀减速、减减速。其核心参数包括：最大速度Vmax、最大加速度Amax、最大加加速度Jmax。实现流程如下：

1. 根据路径长度L和Vmax，计算理论最短时间T_min。
2. 判断是否达到Vmax：若L < Vmax²/Amax，则无法达到最大速度，需重新计算峰值速度。
3. 计算各阶段的时间分配，确保加加速度连续。
4. 在每个插补周期，根据当前时间t计算位置指令。

// S曲线位置计算（简化伪代码）
if (t < t1) s = Jmax * t³ / 6;
else if (t < t2) s = s1 + v1*(t-t1) + Amax*(t-t1)²/2;
// ... 后续阶段类似

2.3.3 案例拆解：连续小线段加工优化

某模具加工程序包含10,000条微线段，每条长度0.5mm。若采用传统逐段加减速，平均速度仅200mm/min。采用前瞻控制后：

关键操作：设置前瞻窗口为50段，拐角允许速度降为最大速度的30%，加速度变化率限制在0.5g/s。通过调整这些参数，在保证精度的前提下大幅提升效率。

2.3.4 常见误区与复盘

• 误区一：插补周期越短越好。实际上，过短的周期会放大量化噪声，且对实时性要求过高。
• 误区二：忽略加减速对轮廓误差的影响。在拐角处，过大的加速度会导致过冲，必须结合动力学约束进行轨迹规划。