2. 伺服电机运动控制基础
伺服电机运动控制是工业自动化、机器人和高端装备领域的核心技术底座。无论是数控机床的进给轴、六轴工业机器人的关节，还是半导体设备中的晶圆搬运臂，其高精度、高动态响应的本质都依赖于一套完整的伺服系统。理解伺服系统的物理组成、三种基本控制模式（位置、速度、力矩）以及运动规划在其中的“大脑”角色，是掌握S曲线与多项式运动规划算法的前提。本章将从系统架构、模式对比、规划作用三个维度，建立伺服运动控制的整体认知框架。
2.1 伺服系统的组成与信号流向
一个完整的伺服系统，从控制层级看，通常由上位控制器（运动控制器/PLC/CNC）、伺服驱动器、伺服电机及反馈元件（编码器/旋转变压器）三大部分构成。上位控制器负责生成运动轨迹（即运动规划），输出位置或速度指令；伺服驱动器接收指令后，通过内部的三环控制结构（电流环、速度环、位置环）进行闭环调节，输出PWM电压驱动电机旋转；电机轴端的编码器实时反馈位置和速度信号，形成闭环。
从物理连接上看，信号流向分为两条关键路径：指令路径（上位机→驱动器→电机）和反馈路径（编码器→驱动器→上位机）。指令路径中，运动规划算法产生的离散位置点或速度值，通过总线（如EtherCAT、PROFINET）或脉冲接口传输给驱动器。反馈路径中，编码器信号不仅用于驱动器内部的闭环调节，也常被上位机用于监控实际位置，实现全闭环控制。
2.2 位置、速度、力矩三种控制模式详解
伺服驱动器通常支持三种基本控制模式，其本质区别在于最外层的闭环对象不同。理解这三种模式，是选择运动规划策略的基础。
| 控制模式 | 闭环结构 | 指令形式 | 典型应用 | 运动规划侧重点 |
|---|---|---|---|---|
| 位置模式 | 位置环+速度环+电流环 | 脉冲/总线位置指令 | 数控机床进给、机械手关节 | 规划位置曲线，隐含速度/加速度约束 |
| 速度模式 | 速度环+电流环 | 模拟量/总线速度指令 | 传送带恒速、卷绕张力控制 | 规划速度曲线，需限制加速度 |
| 力矩模式 | 仅电流环 | 模拟量/总线力矩指令 | 压装、打磨、力控装配 | 规划力矩斜坡，需考虑负载变化 |
在位置模式下，上位机规划出连续的位置-时间函数，驱动器内部的位置环负责跟踪。此时，运动规划算法（如S曲线）需要同时考虑位置、速度、加速度甚至加加速度的约束，因为位置曲线的二阶导、三阶导直接对应着机械系统的受力变化。在速度模式下，规划器只需输出速度-时间曲线，但必须确保速度变化率（加速度）不超过电机和机械系统的允许范围。力矩模式则更直接，规划器输出力矩指令，常用于需要精确控制接触力的场景，此时运动规划往往与力/位混合控制结合。
2.3 运动规划在伺服控制中的核心作用
运动规划（Motion Planning）在伺服控制中扮演着“大脑”与“交通警察”的双重角色。它负责回答三个核心问题：去哪里？怎么去？去的过程中如何不损坏设备？具体而言，其作用体现在以下四个方面：
- 轨迹生成：将用户的目标位置、速度、时间等抽象需求，转化为一条具体的、时间参数化的位置/速度曲线。例如，从A点运动到B点，规划器会生成一条连续的位置曲线，并计算出每个插补周期（如1ms）的位置指令值。
- 平滑与约束：机械系统存在物理极限（电机最大转速、最大扭矩、机械结构承受的最大加速度）。运动规划必须将这些约束转化为数学边界，确保生成的轨迹不超出安全范围。S曲线规划的核心价值就在于限制加加速度（Jerk），从而减小冲击和振动。
- 前瞻与优化：在连续轨迹加工（如CNC加工圆弧）或多段路径衔接中，运动规划需要具备“前瞻”（Look-ahead）能力，预读后续路径的拐点、曲率变化，提前减速或调整速度，避免在拐角处因速度过高导致过切或冲击。
- 稳定性保障：不合理的规划（如阶跃速度指令）会激发机械谐振，导致跟踪误差增大甚至失步。通过多项式插值或S曲线滤波，可以显著降低指令中的高频分量，提高系统的稳定裕度。
2.4 实战场景：从“梯形”到“S曲线”的升级案例
为直观理解运动规划的作用，我们以一个典型的半导体固晶机XY工作台为例。该设备要求将芯片从供料台搬运至基板，单次移动距离为50mm，节拍要求为0.2秒完成一次搬运（含稳定时间）。
初始方案（梯形速度规划）：控制器输出最大速度1m/s，加速时间0.05s，减速时间0.05s，匀速时间0.1s。加速度为20m/s²（约2g）。实际运行中发现：工作台在加减速切换瞬间产生明显振动，导致芯片拾取偏移量达到±15μm，超出±5μm的工艺要求。同时，电机电流在切换点出现尖峰，驱动器偶尔报警过流。
分析过程：通过示波器采集编码器位置微分后的加速度信号，发现加速度在切换点并非理想阶跃，而是伴随约200Hz的衰减振荡。这是典型的机械谐振被加速度突变激励的表现。梯形规划虽然时间最短，但加速度不连续，激发出机械结构的固有模态。
优化方案（S曲线规划）：将运动规划改为S曲线，设定最大加加速度Jerk=2000m/s³。重新计算轨迹：加速阶段分为加加速、匀加速、减加速三段，总加速时间延长至0.08s，匀速时间缩短至0.06s，总运动时间仍为0.2s。修改后，加速度曲线变为连续三角波，无阶跃突变。
结果对比：
| 指标 | 梯形规划 | S曲线规划 | 改善幅度 |
|---|---|---|---|
| 最大加速度突变 | 20m/s²阶跃 | 0（连续） | 消除冲击 |
| 定位稳定时间（±5μm） | 45ms | 22ms | 缩短51% |
| 电机峰值电流 | 8.5A | 6.2A | 降低27% |
| 振动幅值（工作台） | ±15μm | ±3μm | 降低80% |
复盘经验：该案例揭示了运动规划的核心价值——用微小的节拍时间代价换取巨大的动态性能提升。S曲线规划虽然增加了约10%的运动时间，但稳定时间大幅缩短，实际节拍反而提升。更重要的是，机械振动减小后，设备寿命和产品良率均显著改善。这提醒我们：在伺服系统调试中，不要盲目追求“最快速度”，而应关注“最短稳定时间”和“最小冲击”。
2.5 常见误区与总结复盘
在伺服运动控制基础学习中，以下误区值得警惕：
- 误区一：将伺服驱动器当作“黑盒”。只发送指令，不关注驱动器内部三环的响应特性。实际上，运动规划必须与驱动器的带宽匹配。若规划的速度频率分量超过速度环带宽，跟踪误差会急剧增大。
- 误区二：混淆“定位精度”与“运动平滑性”。定位精度由编码器分辨率和位置环增益决定，而运动平滑性由规划算法决定。两者独立，但相互影响。不平滑的运动会导致过冲，反而降低实际定位精度。
- 误区三：忽略加加速度（Jerk）的影响。很多工程师只关注加速度限制，认为加速度不超限即可。但加速度的导数（Jerk）才是引起机械振动和噪声的关键因素。S曲线规划的本质就是对Jerk进行约束。
- 误区四：所有场景都使用位置模式。在需要力控或速度同步的场景（如多轴同步印刷），位置模式反而难以实现。应根据末端执行器的物理需求选择模式。