2. 运动控制基础
在嵌入式运动控制系统中，一切运动轨迹、定位精度、动态响应和力/力矩输出，最终都归结为对四个核心物理量的精确控制：位置、速度、加速度和力矩。理解这些量之间的微分/积分关系，以及它们在控制回路中的角色，是设计任何运动控制算法的前提。同时，开环与闭环控制的选择，直接决定了系统的抗扰动能力、稳态精度和成本。本章将从物理定义出发，逐步建立运动控制系统的“语言体系”，并深入剖析开环与闭环控制的本质差异。
核心原理：从物理量到控制变量的映射
运动控制系统的本质，是将期望的运动轨迹（目标位置随时间变化的曲线）转换为执行器（电机、液压缸等）的驱动力/力矩，并确保实际运动与期望轨迹的偏差在允许范围内。这一过程涉及四个关键物理量，它们之间存在严格的数学关系：位置是速度的时间积分，速度是加速度的时间积分，而加速度与力矩通过转动惯量（或质量）线性关联。在嵌入式系统中，这些物理量通常以数字量形式表示：位置对应编码器脉冲计数或角度值，速度由单位时间内的脉冲增量计算，加速度则通过速度差分获得，力矩则映射为电流环的给定值（对于伺服电机，力矩与电枢电流成正比）。
理解这一链条的意义在于：控制位置必然需要控制速度，控制速度必然需要控制加速度，而控制加速度最终要控制力矩。因此，现代伺服驱动器内部普遍采用“三环”结构——电流环（力矩环）、速度环、位置环，由内向外依次嵌套。内环带宽最高（通常1-2kHz），外环带宽递减（速度环约100-500Hz，位置环约10-100Hz）。这种级联结构使得每个环路的控制对象都近似为线性系统，便于PID参数整定。
判断方法：如何选择开环还是闭环
在实际工程中，选择开环还是闭环控制，需要从以下四个维度进行技术评估：
| 评估维度 | 开环控制适用场景 | 闭环控制适用场景 |
|---|---|---|
| 精度要求 | 定位精度 > 0.1mm，且负载恒定 | 定位精度 < 0.01mm，或负载变化大 |
| 扰动情况 | 外部扰动小，无突加负载 | 存在摩擦力变化、切削力波动、重力负载 |
| 成本预算 | 传感器成本受限，或安装空间不足 | 可接受编码器/光栅尺成本 |
| 动态响应 | 启停频率低，加减速时间充裕 | 需要高速高加速，或频繁启停 |
一个实用的判断流程是：首先明确系统的稳态精度指标和动态响应指标（如带宽、超调量）。如果精度要求低于执行器固有误差（如步进电机的失步角度），且负载基本恒定，则开环即可满足。反之，若存在以下任一情况，必须采用闭环：①负载力矩随位置变化（如垂直轴的重力）；②需要抵抗突加扰动（如切削力）；③要求高速下不失步（步进电机高速力矩骤降）；④需要连续跟踪轨迹（如插补运动）。
案例拆解：步进电机开环定位与伺服闭环定位的对比
我们以一个小型三轴桌面机械臂的Z轴为例，对比开环与闭环的实际表现。该Z轴负责上下移动，行程100mm，负载质量0.5kg，要求定位精度±0.05mm，移动速度50mm/s。
初始方案（开环）：采用42步进电机（步距角1.8°，细分数16），通过丝杠导程5mm驱动。理论分辨率 = 5mm / (200×16) = 0.00156mm/脉冲，远超精度要求。然而实际测试发现：当Z轴向下运动时，由于重力作用，电机需要持续输出保持力矩；当向上运动时，负载力矩方向改变。在加速阶段（0.2s内从0加速到50mm/s），加速度为250mm/s²，所需加速力矩约为0.125N·m，而步进电机在500pps（脉冲/秒）时的保持力矩约为0.4N·m，看似足够。但实际运行中，当温度升高（电机连续工作30分钟后），绕组电阻增大，输出力矩下降约15%，导致在加速段出现失步，定位误差达到0.3mm，超出规格。
改进方案（闭环）：在电机尾部加装500线增量式编码器（4倍频后2000脉冲/转），构成位置闭环。控制器采用STM32F405，以1kHz频率读取编码器，计算位置误差，通过PID输出PWM占空比控制电机电流。关键参数整定结果：Kp=2.5，Ki=0.8，Kd=0.1。实测数据如下：
// 闭环定位测试记录（单位：mm）
目标位置: 50.000
实际位置: 50.012 误差: +0.012
实际位置: 49.988 误差: -0.012
实际位置: 50.003 误差: +0.003
实际位置: 49.997 误差: -0.003
// 连续运行100次，最大误差 ±0.015mm，满足±0.05mm要求结果对比：开环方案成本约80元（电机+驱动），但精度不达标；闭环方案增加编码器（约35元）和主控资源，总成本约130元，精度提升20倍。更重要的是，闭环系统在负载变化（如夹爪抓取不同重量物体）时，仍能保持稳定精度，而开环系统则可能随时失步。
风险与代价：闭环系统需要处理编码器信号噪声、PID参数适配、以及电机电流环的稳定性问题。在本案例中，曾出现编码器Z信号毛刺导致位置跳变，最终通过硬件滤波（RC低通）和软件去毛刺（连续3次一致才更新）解决。此外，PID参数在低速时出现轻微振荡，通过引入速度前馈（前馈系数0.6）有效抑制。
常见误区与总结复盘
最后需要强调的是，位置、速度、加速度、力矩这四个量并非孤立存在。在实际系统中，它们通过控制环路的级联关系相互耦合：位置环的输出是速度环的给定，速度环的输出是电流环的给定，电流环的输出直接控制PWM占空比。理解这一链条，是后续学习PID整定、前馈控制、以及S曲线加减速规划的基础。开环与闭环的选择，本质上是在成本、复杂度、精度、鲁棒性之间做权衡，没有优劣，只有是否适合当前应用场景。