ADRC在永磁同步电机控制中的应用与优化

1. 项目概述：当自抗扰控制遇上永磁同步电机

去年调试一台精密数控机床时，我遇到了一个棘手问题：传统PI控制在低速切削时总会出现0.5rpm左右的周期性波动。正是这次经历让我开始深入研究ADRC（Active Disturbance Rejection Control）在PMSM控制中的应用。这个"速度环ADRC+电流环PI+SVPWM"的架构，本质上是在解决电机控制中最核心的抗扰动问题。

ADRC的精妙之处在于它将所有未知扰动（包括模型误差、负载变化、参数摄动）都视为"总扰动"，通过扩张状态观测器(ESO)实时估计并补偿。这就好比经验丰富的司机开车时，不需要精确知道风阻系数和路面坡度，凭感觉就能平稳控制车速。我们团队实测数据显示，在突加负载工况下，ADRC的速度恢复时间比传统PI快40%，超调量减少60%。

2. 核心算法解析

2.1 ADRC速度环设计要点

ADRC的三阶结构包含跟踪微分器(TD)、扩张状态观测器(ESO)和非线性状态误差反馈(NLSEF)。在PMSM速度环中，我推荐采用二阶ESO，其离散化实现公式为：

c复制// 二阶ESO核心代码（STM32平台）
void ESO_Update(float z1, float z2, float z3, float y, float u, float h, float beta01, float beta02) {
    float e = z1 - y;
    z1 += h * (z2 - beta01 * e);
    z2 += h * (z3 - beta02 * fal(e,0.5,delta) + b * u);
    z3 += h * (-beta03 * fal(e,0.25,delta));
}

参数整定有门道：

• β系数决定观测器带宽，通常取ωo的3~5倍（ωo为系统带宽）
• 非线性函数fal的δ取值建议为采样周期的0.1~1倍
• 控制量增益b需要根据电机转矩系数估算

调试心得：ESO的初始状态务必设为电机实际初始转速，否则会引发剧烈震荡。我们曾因此烧毁过一个IGBT模块。

2.2 电流环PI参数工程整定

虽然ADRC在速度环大放异彩，但电流环仍建议采用PI控制。这不是保守，而是因为：

1. 电流环响应要求极高（带宽通常>1kHz）
2. 电机电流模型相对准确
3. 数字控制延迟会恶化ADRC性能

参数整定公式：

matlab复制Kp = Ld * 2π * BW_current_loop;
Ki = R * Kp / Ld; 

其中BW_current_loop建议取开关频率的1/5~1/10。比如20kHz PWM时，取2~4kHz带宽。

2.3 SVPWM实现优化技巧

七段式SVPWM虽然谐波更优，但在低调制比时会出现电流畸变。我们改进的方案是：

1. 当调制比<0.2时切换至DPWM模式
2. 采用对称中心对齐PWM
3. 插入死区补偿算法（实测可降低5%转矩脉动）

关键实现代码：

c复制void SVPWM_Gen(float Ualpha, float Ubeta) {
    // 扇区判断
    int sector = (Ubeta > 0) ? 1 : 4;
    sector += (fabs(Ubeta) > 0.866f*Ualpha) ? 2 : 0;
    
    // 作用时间计算
    float T1 = sqrt(3)*Ts/Udc * (sin(sector*60)*Ualpha - cos(sector*60)*Ubeta);
    float T2 = sqrt(3)*Ts/Udc * (-sin((sector-1)*60)*Ualpha + cos((sector-1)*60)*Ubeta);
    
    // 饱和处理
    if(T1+T2 > Ts) {
        T1 = T1/(T1+T2)*Ts;
        T2 = Ts - T1;
    }
}

3. 硬件实现关键点

3.1 采样同步策略

电流采样时刻对控制性能影响巨大。我们采用：

• PWM中点采样（消除开关噪声）
• ADC触发与PWM中心对齐
• 采样保持时间≥500ns

实测发现，采样不同步会导致5%~10%的电流谐波增加。解决方案是：

1. 使用定时器的TRGO触发ADC
2. 配置ADC的采样保持时间为PWM周期的1/20
3. 添加RC滤波（截止频率≥10倍PWM频率）

3.2 保护电路设计

教训来自一次IGBT爆炸事故，现在我们的保护策略包括：

• 硬件过流比较器（响应时间<1μs）
• 软件三级保护：
  • Level1：关断PWM
  • Level2：断开接触器
  • Level3：切断主电源
• 温度监控采用NTC+DS18B20双冗余

4. 实测性能对比

在3kW PMSM测试平台上（编码器分辨率17bit），获得如下数据：

特别在5rpm低速工况下，ADRC展现出明显优势：传统PI会出现0.5Hz左右的周期性波动，而ADRC能将速度波动控制在±0.1rpm内。

5. 调试避坑指南

5.1 ADRC参数整定步骤

1. 先关闭ESO，用TD+NLSEF构成PD控制器
2. 调节TD速度因子r使跟踪无超调
3. 调整NLSEF参数使阶跃响应满意
4. 最后启用ESO，从低频开始逐步提高β

5.2 常见异常处理

问题1：启动时电机剧烈抖动

• 检查ESO初始状态是否匹配电机实际位置
• 验证相序是否正确（交换UVW任意两相测试）

问题2：高速时出现周期性振荡

• 可能是延迟补偿不足，尝试增加ESO带宽
• 检查电流采样是否同步（用示波器观察PWM与ADC触发信号）

问题3：负载突变时响应迟缓

• 调整TD的r参数加快跟踪速度
• 检查b参数是否准确（可通过阶跃响应估算）

这套方案已在数控机床主轴控制中连续运行超过2000小时，期间经历多次突发断电、刀具卡死等极端情况，控制系统始终保持稳定。最让我自豪的是，有位客户原本因为振动问题准备退货的设备，在改用ADRC算法后，加工精度反而提升了30%。