2. 运动控制基础

运动控制系统的设计，无论是面向精密数控机床、工业机器人还是半导体封装设备，其底层逻辑都建立在一套严谨的数学与物理框架之上。本章作为多轴插补算法的基石，将系统梳理坐标系与轴定义、运动学三要素（位置、速度、加速度）的工程含义，并明确插补器在运动控制架构中的核心枢纽地位。理解这些基础概念，是后续掌握直线插补、圆弧插补及样条插补算法的前提。

上图展示了运动控制系统的整体知识框架。坐标系与轴定义构成了空间描述的基准，运动学三要素是规划与反馈的物理量，而插补器则是连接轨迹意图与伺服执行的关键桥梁。下面我们将逐一深入剖析。

2.1 坐标系与轴定义：空间描述的基准

核心原理

在运动控制中，坐标系是描述刀具或工件位置的参考框架。最常用的是笛卡尔直角坐标系，遵循右手定则。国际标准ISO 841定义了数控机床的坐标系规则：Z轴通常平行于主轴轴线，X轴水平且垂直于Z轴，Y轴由右手定则确定。旋转轴A、B、C分别绕X、Y、Z轴旋转。对于六轴工业机器人，则采用基坐标系、腕部坐标系和工具坐标系的多层嵌套结构。

轴定义不仅是命名，更涉及轴的类型（直线轴或旋转轴）、行程范围、参考点（零点）、正方向以及轴之间的耦合关系（如龙门轴的主从同步）。在五轴加工中心中，除了三个直线轴，还有两个旋转轴（如A轴绕X旋转，C轴绕Z旋转），旋转轴的中心线必须与直线轴有精确的几何位置关系，否则会产生RTCP（旋转刀具中心点）误差。

判断方法或操作流程

在实际系统调试中，轴定义的验证流程如下：

1. 机械回零：确认各轴回零方向与减速开关、编码器Z脉冲的匹配关系。
2. 方向验证：手动JOG正方向，观察坐标值变化与机械运动方向是否一致。
3. 软限位设定：根据机械行程设定正负软限位，防止超程。
4. 坐标系偏置：设定G54等工件坐标系偏置值，验证工件原点与机床原点的映射关系。

案例拆解或实战场景

以一台三轴立式加工中心为例，其轴定义参数如下表所示：

在调试过程中发现，当程序指令X轴正向移动时，工作台实际向右移动，导致加工镜像错误。排查过程：首先检查伺服电机相序，确认电机旋转方向正确；其次检查编码器反馈方向，发现编码器方向参数与电机方向不匹配。修正该参数后，轴方向恢复正常。此案例说明轴定义不仅是软件配置，更需与硬件接线、反馈方向协同验证。

2.2 运动学基础：位置、速度、加速度

核心原理

运动学三要素是描述任何运动状态的物理量。在运动控制中，位置通常以脉冲数或毫米为单位，速度以mm/min或r/min表示，加速度则影响设备的动态响应和机械冲击。更高级的运动控制还会考虑加加速度（Jerk），即加速度的变化率，用以平滑运动轨迹，减少振动。

位置控制是基础，速度控制是过渡，加速度控制是核心。在插补算法中，每个插补周期（通常为1ms或0.5ms）需要计算目标位置，而速度规划则决定了这些位置点之间的时间间隔。例如，一个梯形速度曲线包含加速段、匀速段和减速段，其加速度值决定了加速段的斜率。

判断方法或操作流程

运动学参数整定的流程通常包括：

• 计算最大加速度：根据伺服电机额定扭矩、负载惯量和机械传动比，计算理论最大加速度。
• 设定加减速时间常数：根据工艺要求（如表面质量、节拍时间）设定加速时间，通常为50~200ms。
• Jerk限制：设定Jerk值，避免加速度突变。例如，在高速高精加工中，Jerk值过大会导致机床共振。
• 测试与修正：通过激光干涉仪或球杆仪测量实际轮廓误差，反向修正加速度和Jerk参数。

案例拆解或实战场景

某半导体固晶机需要将芯片快速贴装到基板，要求运动时间最短且无过冲。初始参数：加速度1g，Jerk未限制。实际测试发现，在高速运动停止时，末端有约0.1mm的过冲，导致贴装偏移。分析过程：过冲源于加速度突变产生的冲击力，激发机械共振。解决方案：引入S型速度曲线，设定Jerk为加速度的10倍（即从0加速到1g需要0.1s的Jerk过渡时间）。修改后，过冲量降至0.01mm以内，且运动时间仅增加8%。

2.3 插补在运动控制中的角色

核心原理

插补（Interpolation）是根据给定的轮廓信息（如直线端点、圆弧半径），在轮廓的起点和终点之间，实时计算出一系列中间点的坐标值。插补器是运动控制器的“大脑”，它决定了实际运动轨迹与理想轮廓的逼近程度。插补分为粗插补和精插补：粗插补在轨迹规划层完成，以插补周期（如1ms）为间隔计算位置指令；精插补在伺服驱动层完成，以更小的周期（如125μs）进行位置闭环计算。

插补的角色可以概括为三个核心功能：轨迹生成（将G代码解析为几何路径）、速度规划（根据路径和工艺要求规划进给速度）、位置指令输出（将规划结果转换为各轴的位置增量）。

判断方法或操作流程

插补器的性能评估指标包括：

• 轮廓误差：实际轨迹与理想轮廓的最大偏差，通常要求小于0.01mm。
• 速度平稳性：在拐角处速度波动是否过大，是否引起振动。
• 实时性：插补计算是否能在规定周期内完成，不能有超时。
• 前瞻能力：能否预读未来N段程序，提前规划减速。

案例拆解或实战场景

以CNC加工一个正方形轮廓为例，若不进行拐角速度规划，刀具在四个角点处需要从进给速度瞬间降为零再加速，这会导致角点处轮廓误差增大和机械冲击。采用前瞻插补算法后，控制器预读后续路径，在拐角前提前减速，通过圆弧过渡或拐角减速策略，使刀具以允许的最大速度通过拐角。实测数据对比：无前瞻时，拐角处轮廓误差0.05mm，有前瞻时降至0.008mm，且加工时间缩短15%。

2.4 常见误区与总结复盘

常见误区

1. 混淆坐标系与工件偏置：机床坐标系是唯一的，工件坐标系是人为设定的，两者不能混用。编程时应始终使用工件坐标系，避免直接使用机床坐标。
2. 忽略加速度对轨迹的影响：有些工程师只关注最大速度，而忽略了加速度限制。在短线段加工中，加速度往往成为瓶颈，导致实际进给速度远低于设定值。
3. 插补周期与伺服周期混淆：插补周期是轨迹规划周期，伺服周期是电流环/速度环周期。若两者不匹配，会导致指令滞后。
4. 旋转轴与直线轴的插补处理：旋转轴的位移是角度，直线轴是长度，在联动插补时需要进行单位统一和坐标变换，否则会产生非线性误差。

总结复盘

本章内容是多轴插补算法的基石。坐标系和轴定义提供了空间描述的语言，运动学三要素是规划与控制的物理量，而插补器则是将抽象轨迹转化为具体轴运动的执行者。在实际系统设计中，必须从机械结构、伺服驱动、控制器算法三个层面综合考虑。下表总结了本章的核心知识点：