4、FOC核心架构：电流环、速度环、位置环的级联控制结构与各环节作用

FOC（Field-Oriented Control，磁场定向控制）之所以能在伺服驱动领域占据主导地位，其根本原因在于它将交流电机的强耦合、非线性数学模型，通过坐标变换解耦为类似于直流电机的独立励磁分量与转矩分量。然而，仅有坐标变换并不足以构成完整的伺服系统。真正让FOC具备高动态响应、高稳态精度和强抗扰能力的，是其内部层层嵌套、职责分明的级联控制架构。本章将深入剖析电流环、速度环、位置环这三层闭环的物理意义、数学模型、整定逻辑以及它们之间的协同关系，帮助读者建立起从“能转”到“转得准”再到“转得巧”的系统级认知。

4.1 级联控制结构的核心原理与设计动机

级联控制并非FOC的独创，它在过程控制领域已有数十年应用历史。其核心思想是：将复杂的多变量控制问题分解为若干个单变量控制回路，由内向外逐层包裹，内环负责快速消除扰动，外环负责缓慢修正偏差。在FOC中，这种结构体现为位置环→速度环→电流环的三层嵌套。

从物理层面看，电机控制本质上是一个机电能量转换过程。电流环控制的是电磁转矩的生成，速度环控制的是机械转速的建立，位置环控制的是空间角度的精确到达。三者时间常数差异巨大：电气时间常数（L/R）通常在毫秒级以下，机械时间常数（J/B）在几十毫秒到秒级。这种时间尺度的天然分离，使得级联控制成为最合理的选择——内环必须比外环快一个数量级以上，才能保证外环控制时内环已稳定跟随。

从数学层面看，级联结构将高阶系统降阶为多个一阶惯性环节的串联。例如，当电流环带宽足够高时，从速度环视角看，电流环可近似为增益为1的惯性环节；同理，当速度环带宽足够高时，从位置环视角看，速度环也可近似为比例环节。这种降阶处理极大简化了控制器设计。

4.2 电流环：FOC的“心脏”与转矩控制基石

电流环是FOC中最内层、也是最重要的控制回路。它的任务是在dq旋转坐标系下，分别控制励磁电流 i_d 和转矩电流 i_q 快速跟踪给定值。对于表贴式PMSM，通常采用 i_d=0 控制策略；对于内置式PMSM，则可能采用MTPA（最大转矩电流比）策略，此时 i_d 为负值。

电流环的数学模型：在dq坐标系下，PMSM的电压方程为：

Vd = Rs·id + Ld·(did/dt) - ωe·Lq·iq
Vq = Rs·iq + Lq·(diq/dt) + ωe·(Ld·id + ψf)

其中 ωe 为电角速度，ψf 为永磁体磁链。可以看到，d轴和q轴之间存在交叉耦合项（-ωe·Lq·iq 和 +ωe·Ld·id），以及反电动势项（ωe·ψf）。电流环控制器需要对这些扰动进行补偿，通常采用PI控制器加前馈解耦的方式。

电流环的整定方法：工程上最常用的是典型I型系统整定法。将电流环校正为典型I型系统后，其闭环传递函数为：

G(s) = ωn² / (s² + 2ζ·ωn·s + ωn²)

其中 ωn 为自然振荡频率，ζ 为阻尼比。工程上取 ζ=0.707（最佳阻尼比），此时超调量约4.3%，调节时间约 4.4/ωn。PI参数可按以下公式计算：

Kp = Ld·ωn² / (2·ζ·ωn - Rs/Ld)   （简化后 Kp ≈ Ld·ωn）
Ki = Rs·ωn

实际调试中，通常先根据电机参数计算初值，再通过阶跃响应微调。

4.3 速度环：机械动态的“指挥中枢”

速度环位于电流环外层，其输入是位置环给出的速度指令 ω*，输出是电流环的转矩电流指令 i_q*。速度环的核心任务是克服负载扰动、转动惯量变化等机械因素，保证实际转速快速、准确地跟随指令。

速度环的等效对象：当电流环带宽足够高时，从速度环视角看，电流环可近似为：

iq(s) / iq*(s) ≈ 1 / (τci·s + 1)

其中 τci 为电流环等效时间常数（约等于电流环带宽的倒数）。电机机械方程为：

J·(dω/dt) = Kt·iq - TL - B·ω

其中 J 为转动惯量，Kt 为转矩常数，TL 为负载转矩，B 为粘滞摩擦系数。因此，速度环被控对象近似为：

G(s) = Kt / (J·s + B) × 1 / (τci·s + 1)

速度环整定方法：工程上常用典型II型系统整定法，以获得较好的抗扰性能。典型II型系统的开环传递函数为：

G(s) = K·(τ·s + 1) / (s²·(T·s + 1))

其中中频带宽 h = τ/T 通常取 5~10。PI参数计算如下：

Kp = (h+1)·J / (2·h·T·Kt)
Ki = Kp / (h·T)

速度反馈滤波：由于编码器量化误差和采样噪声，速度反馈通常需要低通滤波。但滤波会引入相位延迟，降低系统稳定裕度。工程上可采用：

• M法测速：适用于中高速，测量固定时间内的脉冲数
• T法测速：适用于低速，测量相邻脉冲间的时间
• M/T法测速：结合两者，全速度范围适用

4.4 位置环：伺服精度的“最终裁决者”

位置环是最外层控制回路，直接决定伺服系统的定位精度和轨迹跟踪精度。位置环的输入是位置指令 θ*，输出是速度指令 ω*。位置环通常采用P控制器（比例控制）或PD控制器（比例+微分），较少使用PI控制器，因为积分项会引入相位滞后，降低系统稳定性。

位置环的等效对象：当速度环带宽足够高时，从位置环视角看，速度环可近似为：

ω(s) / ω*(s) ≈ 1 / (τcs·s + 1)

其中 τcs 为速度环等效时间常数。位置环被控对象为：

G(s) = 1 / (s·(τcs·s + 1))

位置环增益整定：位置环增益 Kp 直接决定系统刚度。增大 Kp 可减小跟随误差，但过大会引起振荡。工程上通常根据速度环带宽确定：

Kp = ωcs / 3 ~ ωcs / 5

其中 ωcs 为速度环带宽。对于高精度定位系统，还可加入速度前馈和加速度前馈，以消除跟踪误差。

4.5 三环协同的工程案例：高精度转台伺服系统调试

下面通过一个实际案例，展示三环级联控制在工程中的调试流程与协同逻辑。

背景与约束：某半导体设备用高精度转台，要求定位精度 ±5角秒，重复定位精度 ±2角秒，最大转速 300rpm，从静止加速到300rpm的时间不超过 50ms。转台负载惯量 J=0.02 kg·m²，电机额定转矩 2.4 Nm，编码器分辨率 23位（8388608线/圈），电流环控制周期 50μs。

初始现象：按照默认参数运行，转台在高速定位时出现明显超调（约15%），且伴随持续振荡，无法满足定位精度要求。

分析判断过程：

1. 首先检查电流环：通过示波器观察 iq 波形，发现电流响应快速且无振荡，说明电流环带宽足够（约2kHz），排除电流环问题。
2. 其次检查速度环：给定阶跃速度指令，观察实际速度响应，发现速度超调约20%，且存在约5ms的振荡。初步判断速度环增益偏高。
3. 最后检查位置环：位置环增益设置过高，导致系统等效阻尼比下降。

实际操作步骤：

步骤1：降低速度环Kp，从 0.85 降至 0.55，Ki 从 120 降至 80
步骤2：重新测试速度阶跃响应，超调降至 5%，振荡消失
步骤3：位置环Kp 从 40 降至 25，加入速度前馈系数 0.95
步骤4：测试定位响应，超调降至 2%，但定位时间略长（约65ms）
步骤5：微调位置环Kp 至 30，同时增加加速度前馈 0.8
步骤6：最终定位精度 ±3角秒，重复定位 ±1.5角秒，加速时间 48ms

结果对比：

风险与代价：降低速度环增益后，系统抗负载扰动能力有所下降。为弥补这一损失，增加了负载观测器（扰动观测器），将等效扰动前馈补偿到电流环指令中。这增加了约15%的代码量，但换来了鲁棒性的提升。

复盘经验：三环调试必须遵循“由内到外、逐层验证”的原则。任何外环的异常，首先要确认内环是否已经调好。此外，前馈补偿是提升跟踪性能的关键，但前馈系数过大会引入噪声，需要权衡。

4.6 常见误区与设计复盘

在三环级联控制的设计与调试中，工程师常陷入以下误区：

• 误区一：盲目追求高带宽。带宽越高，系统对噪声越敏感，且数字控制延时的影响越显著。应根据机械特性和应用需求合理设定。
• 误区二：忽视抗积分饱和。当速度环输出达到电流限幅时，积分项会持续累积，导致“积分饱和”。恢复时会产生大超调。必须采用条件积分或反算积分法。
• 误区三：位置环使用PI控制。位置环的积分项会引入相位滞后，降低系统稳定性。除非有特殊要求（如消除静差），否则不建议使用。
• 误区四：三环独立整定后直接串联。三环之间存在耦合，独立整定后串联可能不稳定。需要整体仿真验证或现场联调。
• 误区五：忽略采样延时与计算延时。数字控制中，从采样到PWM更新存在一拍延时，这会降低相位裕度。需要采用延时补偿或预测控制。

总结而言，FOC的三环级联架构是一种经过工程验证的、稳健的控制结构。它通过时间尺度分离，将复杂的电机控制问题分解为三个可独立设计、逐层验证的子问题。理解每一环的物理本质、数学模型和整定方法，是掌握FOC控制精髓的关键。在实际工程中，应根据具体应用场景（定位、轨迹跟踪、力控等）合理配置各环参数，并善用前馈补偿和扰动观测器，才能发挥出伺服系统的最佳性能。