4、电机控制核心算法：PID控制、FOC（磁场定向控制）、DTC（直接转矩控制）、六步换相、SVPWM等算法的原理与适用场景
电机控制算法的选择直接决定了系统的动态响应、稳态精度、效率与噪声表现。在工业伺服、电动汽车、家电变频、无人机电调等场景中，工程师需要在成本、性能与复杂度之间做出权衡。本章将系统梳理五种核心算法的数学原理、实现路径与适用边界，帮助读者建立从“会调参”到“懂选型”的认知升级。
4.1 PID控制：通用闭环调节的基石
核心原理
PID控制器通过比例（P）、积分（I）、微分（D）三项的线性组合，对偏差信号进行调节。其连续域表达式为：
u(t) = Kp·e(t) + Ki·∫e(τ)dτ + Kd·de(t)/dt在电机控制中，PID通常作为速度环或位置环的外环调节器，输出电流/转矩指令给内环。数字实现时采用位置式或增量式算法，增量式PID因不累积历史误差，在电机控制中更常用。
适用场景与判断方法
- 适用场景：对动态响应要求不极端、负载变化平缓的场合，如普通风机、水泵、传送带驱动。
- 判断依据：若系统对转矩脉动不敏感，且不需要精确的磁场解耦，PID配合PWM即可满足需求。
- 参数整定：工程上常用Ziegler-Nichols临界比例度法或试凑法，先调Kp使系统临界振荡，再引入Ki消除稳态误差，最后加Kd抑制超调。
案例拆解：直流有刷电机速度闭环
某自动化产线输送辊筒采用24V直流有刷电机，要求速度波动小于±3%。初始开环运行时，负载变化导致速度偏差达15%。工程师采用增量式PID，采样周期1ms，通过编码器反馈实际转速。整定过程：先设Ki=Kd=0，逐步增大Kp至系统出现等幅振荡（Kp=2.8），随后取Kp=1.68，Ti=0.01s，Td=0.0025s。最终速度波动降至±1.8%，但负载突变时恢复时间约200ms，满足产线节拍要求。
4.2 FOC磁场定向控制：高性能伺服的核心
核心原理
FOC通过Clark变换将三相静止坐标系（abc）变换到两相静止坐标系（αβ），再通过Park变换旋转到转子磁场定向的dq坐标系。在dq坐标系下，定子电流被解耦为励磁分量id和转矩分量iq，实现类似直流电机的独立控制。其数学基础是：
Te = 1.5·p·(λd·iq - λq·id) ≈ 1.5·p·λf·iq（表贴式PMSM）控制策略上，表贴式PMSM常采用id=0控制，内置式PMSM则采用最大转矩电流比（MTPA）控制，弱磁区还需调整id为负值。
实现流程与关键点
- 电流采样：通常采用双电阻或三电阻采样，重构三相电流。
- 坐标变换：需要精确的转子位置信号（编码器或观测器）。
- PI调节器：dq轴电流环PI参数需根据电机电感、电阻和开关频率整定。
- SVPWM调制：将dq电压指令逆变换后生成逆变器开关信号。
案例拆解：工业伺服驱动器FOC调优
某6轴机器人关节采用2kW内置式PMSM，额定转速3000rpm，要求带宽200Hz。初始调试时，电流环带宽仅80Hz，导致轨迹跟踪误差超差。工程师通过以下步骤优化：
- 测量电机参数：Ld=0.35mH，Lq=0.85mH，Rs=0.12Ω，λf=0.085Wb。
- 按带宽设计法整定电流环：Kp=L·ωc，Ki=Rs·ωc，取ωc=2000rad/s。
- 加入交叉耦合补偿项（ωe·Lq·iq和ωe·Ld·id），消除dq轴耦合。
- 速度环采用PI+陷波滤波器，抑制机械谐振频率（约1.2kHz）。
优化后电流环带宽提升至210Hz，轨迹跟踪误差从0.8mm降至0.15mm。但代价是增加了参数辨识工作量，且对编码器精度要求提高（需17位以上值编码器）。
4.3 DTC直接转矩控制：快速响应的另一种路径
核心原理
DTC摒弃了电流内环和坐标旋转，直接以定子磁链和电磁转矩为控制对象。通过滞环比较器将磁链幅值和转矩误差量化为开关信号，结合定子磁链所在扇区，从开关表中选择合适的电压矢量。其核心公式为：
Te = (3/2)·p·(1/Ls)·|ψs|·|ψr|·sin(δ)其中δ为定转子磁链夹角。通过快速改变δ即可实现转矩的瞬时控制。
适用场景与优缺点
| 维度 | DTC优势 | DTC劣势 |
|---|---|---|
| 动态响应 | 转矩响应可达1-2ms，优于FOC | 低速时磁链估算困难 |
| 参数依赖 | 仅需定子电阻，对电机参数不敏感 | 开关频率不固定，谐波较大 |
| 实现复杂度 | 无需坐标变换和PI整定 | 需磁链观测器，低速性能差 |
案例拆解：电力机车牵引电机DTC应用
某地铁牵引系统采用异步电机，额定功率190kW，要求起动转矩大、动态响应快。选用DTC方案后，在0-5Hz低频区采用基于电压模型的磁链观测器，并注入高频信号辅助辨识。实测起动转矩从0到额定值仅需1.5ms，较原FOC方案提升40%。但代价是电流谐波THD从8%升至14%，需增加输出LC滤波器。最终通过优化滞环宽度（磁链±0.02Wb，转矩±5%额定）在响应速度与谐波间取得平衡。
4.4 六步换相与SVPWM：调制策略的对比
六步换相原理
六步换相（方波驱动）是BLDC电机最简控制方式。每60°电角度切换一次导通相，任意时刻只有两相导通，第三相悬空。通过检测反电动势过零点（或霍尔传感器）确定换相时刻。其电压利用率较高，但转矩脉动大（约15%），且高速时反电动势检测困难。
SVPWM原理
SVPWM从逆变器电压矢量的角度出发，通过相邻两个非零矢量与零矢量的时间组合，合成任意方向、任意幅值的参考电压矢量。其直流电压利用率比SPWM高15.47%，且谐波畸变率更低。实现时需计算扇区、作用时间和比较值：
T1 = √3·Ts·|Vref|·sin(π/3 - θ) / Vdc
T2 = √3·Ts·|Vref|·sin(θ) / Vdc
T0 = Ts - T1 - T2对比与选型
| 对比项 | 六步换相 | SVPWM |
|---|---|---|
| 转矩脉动 | 大（约15%） | 小（<5%） |
| 噪声 | 明显 | 低 |
| MCU资源 | 极低（8位MCU即可） | 需16位MCU或DSP |
| 适用电机 | BLDC（梯形波反电动势） | PMSM/ACIM（正弦波） |
| 典型应用 | 电动工具、低成本风机 | 变频空调、伺服、EV |
案例拆解：无人机电调从六步换相升级到FOC+SVPWM
某消费级无人机电调原采用六步换相，最大转速下效率仅82%，且噪声明显。升级为FOC+SVPWM后，效率提升至91%，续航增加12%。但MCU从STM32F031（48MHz）升级到STM32F303（72MHz），成本增加约3元。关键改动包括：
- 增加相电流采样电阻（0.01Ω）和运放电路。
- 采用滑模观测器替代霍尔传感器，节省3个霍尔器件。
- SVPWM载波频率从20kHz提升至32kHz，进一步降低听觉噪声。
实测悬停电流从12.5A降至10.8A，电机温度降低8℃。但代价是软件复杂度显著增加，调试周期从2周延长至6周。