4、电机控制核心算法：FOC（磁场定向控制）、DTC（直接转矩控制）、六步换相的基本原理与对比

在电机控制嵌入式软件开发中，算法选型直接决定了系统的动态响应、稳态精度、效率以及代码实现的复杂度。FOC、DTC与六步换相分别代表了从高性能伺服到低成本调速的不同技术层级。本章将深入剖析三种算法的数学本质、工程实现路径与适用边界，帮助开发者在架构设计初期做出正确的技术决策。

上图从控制目标、动态响应、稳态精度、实现复杂度和应用场景五个维度建立了三种算法的对比框架。下面将逐一拆解每种算法的数学基础、工程实现要点与代码架构特征。

4.1 FOC（磁场定向控制）核心原理与工程实现

4.1.1 核心原理：坐标变换与解耦控制

FOC的本质是通过数学变换将三相交流电机的强耦合、非线性模型等效为直流电机模型。其核心步骤包括：

• Clarke变换：将三相静止坐标系（a-b-c）变换为两相静止坐标系（α-β），公式为 \( I_\alpha = I_a - \frac{1}{2}(I_b + I_c) \)，\( I_\beta = \frac{\sqrt{3}}{2}(I_b - I_c) \)。
• Park变换：将α-β坐标系旋转至转子磁场定向的d-q旋转坐标系，公式为 \( I_d = I_\alpha \cos\theta + I_\beta \sin\theta \)，\( I_q = -I_\alpha \sin\theta + I_\beta \cos\theta \)。
• 解耦控制：在d-q坐标系下，电磁转矩 \( T_e = \frac{3}{2} p \psi_f I_q \)，其中 \( \psi_f \) 为转子磁链，\( p \) 为极对数。通过控制 \( I_d=0 \) 实现转矩与磁链的完全解耦。

工程实现中，电流环采样频率通常为10-20kHz，速度环为1-2kHz。PI调节器的参数整定需依据电机电气时间常数 \( \tau_e = L_s/R_s \) 和机械时间常数 \( \tau_m \)。

void FOC_ISR(void) {
    // 1. 采样三相电流 Ia, Ib, Ic (或两相+重构)
    // 2. Clarke变换: I_alpha, I_beta
    // 3. Park变换: Id, Iq (需获取转子角度theta)
    // 4. 电流环PI: Vd_ref = PI_Id(Id_ref - Id); Vq_ref = PI_Iq(Iq_ref - Iq)
    // 5. 反Park变换: V_alpha, V_beta
    // 6. SVPWM调制: 生成占空比Ta, Tb, Tc
    // 7. 更新PWM寄存器
}

4.1.2 转子角度获取与观测器设计

FOC性能高度依赖转子位置的准确性。对于永磁同步电机（PMSM），常用方案包括：

• 霍尔传感器：分辨率60°电角度，需通过插值算法提高精度，适用于低速。
• 增量式编码器：分辨率可达1024-4096线，需上电寻零，适用于中高速。
• 无感观测器：滑模观测器（SMO）或扩展卡尔曼滤波（EKF），适用于中高速，低速时需注入高频信号。

在代码架构中，角度获取模块应独立封装，便于切换不同传感器类型。观测器计算量较大，需评估MCU的算力余量。

4.1.3 案例拆解：伺服驱动器电流环优化

背景与约束：某工业伺服驱动器采用STM32H743（主频480MHz），要求电流环带宽2kHz，转矩波动小于0.5%。初始方案直接使用浮点运算，ISR执行时间达85μs，超出50μs预算。

分析过程：通过性能分析器定位，Park变换和SVPWM中的三角函数计算占用了60%时间。进一步发现，浮点库的sin/cos调用每次约需1.2μs。

优化措施：

1. 将角度归一化到0-65535范围，使用查表法（256点线性插值）替代sin/cos，误差小于0.1%，耗时降至0.3μs。
2. 将PI调节器改为定点Q15格式，避免浮点转定点开销。
3. 使用CMSIS-DSP库的Clarke/Park变换函数，利用SIMD指令加速。

结果对比：优化后ISR执行时间降至42μs，电流环带宽达到2.3kHz，转矩波动降至0.4%。代价是查表法占用1KB Flash，定点化需注意饱和处理。

4.1.4 常见误区与复盘

• 误区1：忽略电流采样延时补偿。实际采样点与PWM更新点存在延时，需在PI输出中加入一拍延时补偿，否则带宽受限。
• 误区2：PI参数整定仅依赖仿真。电机参数随温度变化，需加入在线参数辨识或鲁棒控制。
• 误区3：SVPWM过调制处理不当。当电压指令超过逆变器最大输出时，需采用过调制策略，否则电流波形畸变。

4.2 DTC（直接转矩控制）核心原理与工程实现

4.2.1 核心原理：滞环控制与开关表

DTC摒弃了电流内环和坐标旋转，直接以定子磁链和电磁转矩为控制对象。其核心思想是：

• 磁链控制：通过选择适当的电压矢量，使定子磁链幅值保持在滞环带内（通常±2%）。
• 转矩控制：通过电压矢量对转矩角的直接调节，使转矩快速跟踪给定值。
• 开关表：根据磁链扇区、磁链误差符号和转矩误差符号，查表选择最优电压矢量（共8个，含2个零矢量）。

DTC的转矩响应时间可小于1ms，远快于FOC，但稳态转矩脉动较大。其核心公式为：

\[ T_e = \frac{3}{2} p \frac{1}{L_s L_r - L_m^2} |\psi_s| |\psi_r| \sin\delta \]

其中 \( \delta \) 为定转子磁链夹角。通过电压矢量控制 \( \delta \) 的变化率即可快速调节转矩。

4.2.2 磁链观测与电压矢量选择

定子磁链观测是DTC的关键，常用方法包括：

• 电压模型：\( \psi_s = \int (V_s - R_s I_s) dt \)，适用于中高速，低速时积分漂移严重。
• 电流模型：\( \psi_s = L_s I_s + L_m I_r \)，需转子磁链信息，适用于低速。
• 混合模型：低速用电流模型，高速用电压模型，切换需平滑。

开关表的设计直接影响性能。典型开关表如下（以扇区I为例）：

工程实现中，开关表可存储为二维数组，索引为扇区号、磁链误差符号和转矩误差符号，查询时间极短。

4.2.3 案例拆解：轨道交通牵引变流器DTC应用

背景与约束：某地铁牵引系统采用大功率异步电机（300kW），要求转矩响应小于5ms，开关频率限制在500Hz以内（受限于IGBT损耗）。

初始现象：采用传统FOC时，转矩响应约8ms，且低速时磁链辨识不准导致启动困难。

分析判断：DTC的滞环控制天然适合低开关频率场景，且无需转子磁场定向，对参数鲁棒性更好。

实施步骤：

1. 采用混合磁链观测器，低速（<5Hz）用电流模型，高速切换至电压模型。
2. 设计滞环比较器：磁链滞环宽度0.02Wb，转矩滞环宽度50Nm。
3. 优化开关表，加入零矢量分配策略，降低开关频率波动。

结果对比：转矩响应降至3ms，开关频率稳定在450Hz左右，低速启动转矩提升20%。代价是稳态转矩脉动增大至8%，需在机械传动系统增加阻尼设计。

4.2.4 常见误区与复盘

• 误区1：忽视采样延时对滞环比较的影响。数字实现中，电压矢量更新滞后一拍，可能导致转矩超调。
• 误区2：开关表固定不变。实际应用中，需根据直流母线电压和电机转速调整开关表，否则低速时性能恶化。
• 误区3：磁链观测积分饱和。需加入抗饱和限幅和反算补偿，否则磁链漂移导致系统失稳。

4.3 六步换相核心原理与工程实现

4.3.1 核心原理：梯形波驱动与换相逻辑

六步换相（也称方波驱动或120°导通）是BLDC电机最基础的驱动方式。其原理是：

• 导通模式：任意时刻只有两相绕组导通，第三相悬空。每60°电角度换相一次，一个电周期内共6个换相状态。
• 反电动势检测：通过检测悬空相的反电动势过零点，确定换相时刻。也可使用霍尔传感器直接获取转子位置。
• 转矩产生：由于反电动势为梯形波，相电流为方波，电磁转矩存在约15%的脉动。

六步换相的数学模型相对简单，其平均电磁转矩为：

\[ T_{avg} = \frac{2 E I}{\omega} \]

其中 \( E \) 为反电动势幅值，\( I \) 为相电流幅值，\( \omega \) 为电角速度。

4.3.2 换相时序与PWM调制策略

换相时序表是六步换相的核心代码模块。以霍尔传感器为例，典型换相逻辑如下：

PWM调制策略通常采用PWM_ON模式（即每个导通区间内，上桥臂PWM调制，下桥臂恒通），或H_PWM-L_ON模式。调制方式影响换相转矩脉动和噪声。

4.3.3 案例拆解：电动工具无感BLDC驱动

背景与约束：某手持电钻采用无感BLDC，MCU为STM32G0（主频64MHz），要求成本极低，无霍尔传感器，转速范围0-30000rpm。

初始现象：启动阶段反电动势幅值太小，无法检测过零点，导致启动失败。

分析判断：需采用三段式启动策略：预定位→强制换相加速→切换至反电动势检测闭环。

实施步骤：

1. 预定位：给定固定电压矢量，使转子转到已知位置。
2. 强制换相：按固定频率换相，同时逐步提高PWM占空比，使电机加速至可检测反电动势的转速（约500rpm）。
3. 闭环切换：检测到连续3次有效过零点后，切换至反电动势检测模式。

结果对比：启动成功率从85%提升至99.5%，启动时间从200ms缩短至80ms。代价是强制换相阶段电流较大，需设置限流保护。

4.3.4 常见误区与复盘

• 误区1：忽略换相延时补偿。从检测到过零点到实际换相需延时30°电角度，需根据转速动态调整延时时间。
• 误区2：PWM频率选择不当。过低导致电流纹波大，过高增加开关损耗，通常选择16-20kHz。
• 误区3：无感方案在低速时盲目增加占空比。应使用升压启动或注入脉冲法，否则可能失步。

4.4 三种算法综合对比与选型决策

选型决策应遵循以下原则：

• 高性能伺服（机器人、CNC）：首选FOC，需编码器反馈。
• 大功率牵引（轨道交通、船舶）：DTC凭借快速转矩响应和低开关频率优势胜出。
• 低成本调速（风扇、水泵、电动工具）：六步换相性价比最高。
• 中间地带（家电变频、电动自行车）：FOC无感化方案逐渐普及，成本可控。

三种算法并非互斥，现代高端驱动器常采用混合策略：低速用FOC保证平稳，高速切换至DTC提升动态响应，或采用FOC+六步换相作为故障降级方案。理解每种算法的数学本质与工程约束，是电机控制嵌入式架构师的核心能力。