2、运动控制基础：伺服系统、步进电机、编码器反馈、控制周期与插补周期的关系
运动控制系统的底层硬件与时间基准，决定了插补算法能否在物理世界中精确落地。本章聚焦四块基石：伺服系统与步进电机的执行特性、编码器反馈的精度闭环、控制周期与插补周期的协同机制。理解这些基础，是后续学习直线插补、圆弧插补、S型速度规划的前提——因为任何算法最终都要通过电机与反馈回路转化为实际位移。
2.1 伺服系统与步进电机的执行特性对比
核心原理：伺服系统与步进电机是运动控制中最常见的两类执行机构，它们在控制方式、动态特性、精度表现上存在本质差异。伺服系统采用闭环控制，电机内置或外接编码器，驱动器实时读取位置/速度反馈并与指令比较，通过PID或更高级算法调节电流，实现高精度、高动态响应。步进电机则将脉冲信号转换为角位移，每接收一个脉冲转动固定角度（步距角），通常工作在开环状态，结构简单、成本低，但存在失步、共振、高速力矩下降等固有问题。
判断方法：选择执行器时需评估负载惯量比、最高转速、定位精度、动态响应时间、成本预算。伺服系统适合负载变化大、要求高速高精的场合（如CNC机床、机器人关节）；步进电机适合负载稳定、速度较低、成本敏感的场合（如3D打印机、小型工作台）。
| 对比维度 | 伺服系统 | 步进电机 |
|---|---|---|
| 控制方式 | 闭环（位置/速度/电流三环） | 开环（脉冲计数） |
| 反馈元件 | 编码器（增量/） | 通常无，可选配编码器 |
| 动态响应 | 高（带宽可达数百Hz） | 低（受步进频率限制） |
| 低速性能 | 平稳，无共振 | 存在低频振动 |
| 高速性能 | 力矩平稳，转速高 | 力矩随转速下降明显 |
| 过载能力 | 强（可短时3倍过载） | 弱（易失步） |
| 定位精度 | 取决于编码器分辨率 | 取决于步距角（通常1.8°） |
| 成本 | 高 | 低 |
2.2 编码器反馈：精度闭环的关键
核心原理：编码器将机械位移转换为电信号，是闭环控制的“眼睛”。增量式编码器输出A/B/Z三路脉冲，通过相位差判断方向，Z信号用于原点定位；式编码器直接输出位置码，断电后仍保留位置信息。分辨率（线数/圈）决定最小检测单位，实际应用中常通过4倍频技术将分辨率提升4倍。
操作流程：编码器选型需考虑：①机械安装方式（轴套/空心轴）；②分辨率需求（精度要求÷传动比÷丝杠导程）；③输出接口（TTL/差分/串行）；④防护等级（IP等级适应环境）。安装时需保证编码器与电机轴同轴度，避免联轴器间隙引入误差。
2.3 控制周期与插补周期的协同机制
核心原理：插补周期（T_i）是轨迹规划器生成位置指令的时间间隔，控制周期（T_c）是伺服驱动器/运动控制器执行位置闭环调节的时间间隔。两者必须满足整数倍关系：T_i = N × T_c（N≥1）。插补器在每个T_i内计算目标位置，控制器在每个T_c内读取反馈并输出控制量。若T_i过长，轨迹逼近误差增大；若T_c过长，系统动态响应变差。
判断方法：典型工业参数：T_c = 0.125ms~1ms（伺服驱动器电流环通常0.0625ms~0.125ms，位置环1ms），T_i = 1ms~8ms。CNC系统常取T_i=2ms，T_c=0.5ms（N=4）。选择原则：T_i必须大于等于位置环T_c，且保证插补计算量在T_i内完成。
// 插补周期与控制周期同步伪代码
// 每个控制周期T_c执行一次
void ControlLoop() {
if (elapsed_time >= T_i) {
target_pos = Interpolator.GenerateNextPoint(); // 插补器生成新指令
elapsed_time = 0;
}
current_pos = Encoder.ReadPosition(); // 读取编码器
velocity_cmd = PositionPID(target_pos, current_pos); // 位置环
current_cmd = VelocityPID(velocity_cmd, encoder_velocity); // 速度环
CurrentLoop(current_cmd); // 电流环
}
2.4 案例拆解：三轴运动平台的周期匹配优化
背景与约束：某三轴点胶机使用伺服系统，要求轨迹速度120mm/s，轮廓误差<0.03mm。初始配置：T_c=1ms，T_i=4ms，编码器2500线（4倍频=10000脉冲/转），丝杠导程10mm。
初始现象：圆弧插补时轮廓误差达0.08mm，超出规格。通过示波器观察发现，位置指令呈阶梯状（每4ms跳变一次），导致伺服跟踪滞后。
分析过程：计算插补周期内位移：120mm/s × 4ms = 0.48mm/步，对应脉冲数=0.48/10×10000=480脉冲。位置环带宽约50Hz（周期20ms），4ms的指令跳变相当于25Hz激励，接近带宽边缘，相位滞后明显。
操作步骤：①将T_i缩短至2ms（N=2），指令步距减半至0.24mm；②同时将位置环增益Kp从20提升至35（需校验稳定性）；③增加速度前馈系数至0.85。
结果对比：轮廓误差从0.08mm降至0.025mm，满足规格。代价是CPU负载从35%升至52%，但仍在安全范围。
复盘经验：插补周期并非越短越好——过短会增加通信与计算负担，且当T_i小于位置环T_c时无法工作。工程上应优先保证T_i/T_c为整数，再通过前馈和增益调整优化跟踪性能。
2.5 常见误区与总结复盘
- 误区一：认为步进电机不需要反馈。实际在负载波动或高速时失步无法察觉，导致废品。建议关键工位加装编码器做闭环。
- 误区二：编码器分辨率越高越好。分辨率过高会放大机械振动噪声，且增加成本与通信负担。应匹配系统实际精度需求。
- 误区三：插补周期与控制周期随意设置。两者必须严格整数倍关系，否则产生周期性扰动。
- 误区四：忽略编码器采样延迟。高速时延迟导致的位置滞后不可忽略，需通过预测或前馈补偿。