2、运动控制基础：伺服系统、电机模型、位置/速度/电流环、控制周期与采样

运动控制算法的落地离不开对执行机构与信号链路的深刻理解。无论是传统的旋转伺服电机，还是直线电机、力矩电机，其控制性能的上限由机械结构、电机电气参数、驱动器功率级以及反馈传感器的分辨率共同决定。本章从伺服系统的整体架构出发，依次拆解电机数学模型、三环（电流环、速度环、位置环）控制结构，以及控制周期与采样同步对算法效果的影响。这些内容构成了后续学习PID参数整定与迭代学习控制（ILC）的物理基础。

2.1 伺服系统组成与信号链路

伺服系统是一个闭环机电控制系统，其核心任务是对位置、速度或力矩指令进行高带宽、高精度的跟踪。一个典型的旋转伺服系统由以下模块构成：运动控制器（位置环）、伺服驱动器（速度环+电流环）、功率逆变器、永磁同步电机（PMSM）或直流无刷电机（BLDC）、位置传感器（编码器/旋变）以及电流采样电阻或霍尔传感器。信号链路中，指令从控制器流向驱动器，而反馈信号（位置、速度、电流）则从传感器反向流回控制器，形成闭环。

在实际工程中，控制器与驱动器可能集成于同一硬件（如一体化伺服电机），也可能通过EtherCAT、CANopen或脉冲/方向接口分离。无论物理形态如何，信号流的方向与优先级是固定的：位置环输出速度指令，速度环输出电流指令，电流环输出PWM占空比。这种级联结构决定了内环（电流环）必须具有最高的带宽和采样率，外环（位置环）则相对较慢。

2.2 电机数学模型：从电压方程到机械方程

以表贴式永磁同步电机（SPMSM）为例，其在dq旋转坐标系下的电压方程和磁链方程是电流环设计的基础。定子电压方程可写为：

Vd = Rs·Id + Ld·(dId/dt) - ωe·Lq·Iq
Vq = Rs·Iq + Lq·(dIq/dt) + ωe·(Ld·Id + ψf)

其中，Rs为定子电阻，Ld、Lq为dq轴电感（表贴式电机Ld≈Lq），ωe为电角速度，ψf为永磁体磁链。对于表贴式电机，由于Ld=Lq，电磁转矩方程简化为：

Te = 1.5·p·ψf·Iq

这意味着转矩与q轴电流成正比，与d轴电流无关（在Id=0控制策略下）。因此，电流环的核心任务就是快速、精确地控制Iq，同时将Id控制在零附近。

机械运动方程则描述了转速与转矩的关系：

J·(dωm/dt) = Te - TL - B·ωm

其中J为转动惯量，TL为负载转矩，B为粘滞摩擦系数。该方程是速度环设计的基础，也是前馈补偿（如惯量前馈、摩擦前馈）的出发点。值得注意的是，实际系统中负载惯量可能随工况变化（如机器人关节在不同姿态下等效惯量不同），这要求速度环具有一定的鲁棒性。

2.3 三环控制结构：电流环、速度环、位置环

三环级联是工业伺服最经典的控制架构。电流环位于最内层，直接控制电机转矩；速度环位于中间层，输出电流指令；位置环位于最外层，输出速度指令。每一层都有其独立的控制器、采样频率和限幅逻辑。

电流环（内环）

电流环通常采用PI控制器，在dq坐标系下分别对Id和Iq进行闭环控制。由于电气时间常数（L/R）远小于机械时间常数，电流环的响应速度最快。电流环的带宽受限于PWM开关频率、电流采样延迟和逆变器死区效应。工程上，电流环采样频率通常等于PWM频率（10~20kHz），PI参数可通过零极点对消法整定：

Kp = L·αc
Ki = Rs·αc

其中αc为期望的电流环带宽（rad/s）。需要注意的是，数字控制中一拍延迟（采样到PWM更新）会引入相位滞后，因此实际带宽通常只能达到采样频率的1/10~1/20。

速度环（中环）

速度环的输入是位置环给出的速度指令，反馈来自编码器差分或专用速度观测器。速度环PI参数的设计需考虑机械谐振频率。若负载与电机之间通过弹性联轴器连接，系统会出现一对共轭谐振极点，此时简单的PI控制可能激发扭振。工程中常采用陷波滤波器（Notch Filter）或低通滤波器来抑制机械谐振。

位置环（外环）

位置环通常仅使用比例控制（P），因为积分作用会导致位置超调。位置环的增益Kpp决定了跟踪刚度，但过高的Kpp会放大速度环的噪声。对于高精度轨迹跟踪，位置环常加入速度前馈和加速度前馈，以减小跟踪滞后。

2.4 控制周期与采样同步

控制周期决定了算法的执行频率，而采样同步则决定了反馈数据的时效性。在数字伺服系统中，电流环、速度环、位置环通常运行在不同的时间基准上。电流环与PWM同步，在每个PWM周期内完成一次采样和控制更新；速度环和位置环则在较低的频率下运行，通过定时器中断触发。

采样同步的关键在于电流采样时刻的选择。对于三相PMSM，相电流通常通过低侧采样电阻或隔离放大器获取。若在PWM开关切换瞬间采样，会引入严重的开关噪声。工程上推荐使用PWM中心对齐采样：在PWM载波峰值或谷值处（即开关管全部导通或关断的中间时刻）触发ADC采样，此时相电流纹波最小，采样值最接近平均值。

PWM周期 = 100μs (10kHz)
电流环中断：在PWM中心点触发，采样Ia, Ib, Ic
速度环中断：每5个PWM周期触发一次 (1kHz)
位置环中断：每10个PWM周期触发一次 (500Hz)

控制周期的选择需权衡动态响应与计算负载。电流环周期过短（如低于50μs）会导致MCU计算资源紧张，且PWM死区效应占比增大；周期过长则电流环带宽不足。速度环周期通常为电流环的5~10倍，位置环周期为速度环的2~5倍。

2.5 案例拆解：伺服系统抖动排查与参数优化

背景： 某3C电子装配设备使用400W伺服电机驱动丝杠滑台，客户反馈在低速往复运动（10mm/s）时出现明显抖动，且伴随周期性噪声。设备采用标准三环控制，默认参数为：电流环带宽800Hz，速度环带宽50Hz，位置环增益30 1/s。

初始现象： 用示波器采集速度反馈信号，发现速度波动幅度达±15%，频率约12Hz。进一步分析发现，该频率与丝杠的轴向固有频率（约12.5Hz）接近，疑似机械谐振被速度环激发。

分析过程： 首先检查电流环，确认电流波形无明显畸变，排除电气问题。然后对速度环进行频率响应分析，发现在12Hz处存在一个明显的谐振峰，增益超过20dB。这说明速度环的PI参数在谐振频率处提供了过高的增益，导致系统在该频率点接近不稳定。

操作步骤：

1. 在速度环反馈路径中加入中心频率12Hz、带宽2Hz的陷波滤波器，衰减谐振峰。
2. 将速度环比例增益从0.5降至0.3，积分时间常数从20ms调整至30ms，降低低频增益。
3. 在位置环中加入速度前馈（前馈系数0.8），减小跟踪滞后。
4. 重新测量速度波动，降至±3%以内，噪声消失。

结果对比： 优化前速度波动±15%，优化后±2.8%；定位稳定时间从180ms缩短至95ms。但代价是速度环带宽从50Hz降至35Hz，高速跟踪性能略有下降。

复盘经验： 伺服抖动问题应首先区分电气与机械原因。通过频率响应分析定位谐振点，使用陷波滤波器是性价比最高的方案。同时，速度环增益并非越大越好，需结合机械特性综合权衡。

2.6 常见误区与总结

运动控制基础部分的常见误区包括：第一，忽视电流环带宽上限，盲目追求高响应，导致PWM占空比饱和；第二，将速度环和位置环的采样频率设置得过高，造成不必要的计算负担；第三，忽略编码器分辨率对速度估算的影响，低速时速度反馈噪声过大；第四，未考虑控制周期与PWM同步，导致电流采样混叠。

总结而言，伺服系统是一个多时间尺度的级联系统。理解电机模型中的电气时间常数与机械时间常数，是合理分配控制周期的基础。三环结构中的每一层都有其物理约束：电流环受限于PWM频率和电感，速度环受限于机械谐振，位置环受限于速度环带宽。采样同步则是保证反馈信号真实性的关键工程细节。掌握这些基础，后续的PID参数整定和迭代学习控制（ILC）才能有的放矢。