1. 线性自抗扰控制（LADRC）核心思想解析
线性自抗扰控制（Linear Active Disturbance Rejection Control, LADRC）是一种不依赖精确数学模型、具有强抗干扰能力的控制策略。它的核心思想可以用一个生活场景来理解：想象你正端着一碗水走路，目标是保持水面平稳不洒出。在这个过程中，你会遇到各种干扰因素——走路时的颠簸（外部干扰）、碗中水量变化（系统参数变化）、地面不平（不确定性）。人类大脑不会精确计算需要施加多少力来平衡，而是通过三个本能反应：
- 实时感知碗的倾斜程度（状态观测）
- 自动抵消手部抖动和颠簸的影响（扰动估计与补偿）
- 微调手臂动作使水面恢复平稳（误差反馈）
这种"观测-补偿-调节"的自然机制正是LADRC的精髓所在。与传统PID控制相比，LADRC最大的突破在于它将所有未知干扰和模型误差统一视为"总扰动"，通过扩张状态观测器实时估计并立即补偿，使控制系统具备"不管风吹浪打，胜似闲庭信步"的鲁棒性。
2. LADRC三大核心组件深度剖析
2.1 跟踪微分器（TD）——指令平滑引擎
跟踪微分器相当于控制系统的"缓冲器"，其核心作用是防止目标指令突变导致的系统冲击。以无人机悬停控制为例，当从0米突然指令升至10米高度时，直接阶跃指令会导致电机过载甚至失稳。TD通过数学上的"弹簧-阻尼"系统生成平滑过渡指令：
c复制// TD离散化实现（二阶系统）
float td_r = 2 * LADRC_BW; // 速度因子
float td_h0 = control_period; // 控制周期
float td_fh = (td_r*td_r)*(ref - x1) - 2*td_r*x2; // 等效弹簧阻尼系统
x1 += td_h0 * x2; // 位置更新
x2 += td_h0 * td_fh; // 速度更新
实际工程中，TD参数调节遵循以下原则：
- 带宽(td_r)越大，跟踪速度越快但可能引入超调
- 对于慢响应系统（如温度控制），可设置为目标变化时间的倒数
- 在STM32等MCU上实现时，需确保计算周期(td_h0)稳定
关键技巧：在电机控制等快速系统中，可将TD带宽设为系统带宽的3-5倍；而在化工过程控制等慢速系统中，设为1-2倍即可平衡响应速度与稳定性。
2.2 扩张状态观测器（ESO）——扰动雷达
ESO是LADRC的灵魂组件，其创新性地将扰动作为扩展状态进行实时观测。以一阶系统为例，ESO通过三状态模型同时估计：
- 系统输出(z1)
- 输出微分(z2)
- 总扰动(z3)
c复制// ESO核心算法（一阶）
float beta1 = 3 * bandwidth;
float beta2 = 3 * bandwidth * bandwidth;
float beta3 = bandwidth * bandwidth * bandwidth;
float e = z1 - actual_output; // 观测误差
z1 += h * (z2 - beta1*e); // 输出状态更新
z2 += h * (z3 - beta2*e + b0*u); // 微分状态更新
z3 += h * (-beta3*e); // 扰动状态更新
ESO的工程实现要点：
- 带宽参数决定观测速度，通常设为控制系统带宽的3-10倍
- b0参数代表控制增益的粗略估计，即使误差50%仍能工作
- 在STM32中可采用定点数运算优化计算效率
典型应用场景对比：
| 系统类型 | ESO带宽选择 | 特殊处理 |
|---|---|---|
| 电机转速控制 | 50-200rad/s | 注意电流采样噪声滤波 |
| 无人机姿态控制 | 20-100rad/s | 需补偿传感器延迟 |
| 温度控制系统 | 0.1-5rad/s | 关注低频扰动观测精度 |
2.3 状态误差反馈（SEF）——精准调节器
经过TD和ESO处理后，SEF只需处理"纯净"的系统误差。以一阶LADRC为例，其控制律为：
c复制// SEF控制律实现
float kp = bandwidth; // 比例增益
float kd = 0.5 * bandwidth; // 微分增益
float e1 = td_x1 - eso_z1; // 位置误差
float e2 = td_x2 - eso_z2; // 速度误差
float u0 = kp*e1 + kd*e2; // 基础控制量
float u = u0 - eso_z3/b0; // 扰动补偿
SEF参数设计黄金法则：
- 带宽决定整体响应速度，一般先设为系统固有频率的2-3倍
- 比例和微分增益与带宽存在固定关系，无需单独调节
- 在资源受限的单片机中，可采用查表法实现非线性增益调度
3. LADRC在STM32上的工程实现
3.1 硬件适配与优化技巧
在STM32F4系列上的实现示例：
c复制// 使用TIM2定时器触发1kHz控制周期
void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim) {
if(htim == &htim2) {
float ref = get_target_value(); // 获取目标值
float y = read_sensor_value(); // 读取传感器
// 执行LADRC计算
float u = LADRC_Calc(&ladrc, ref, y);
// 输出控制量
set_actuator_output(u);
}
}
关键优化策略：
- 使用DMA加速传感器数据采集
- 将ESO矩阵运算转换为并行计算
- 对三角函数等复杂运算使用查表法
- 采用Q格式定点数提升计算效率
3.2 参数整定实战指南
LADRC参数调试三步法：
-
初步设定：
c复制#define LADRC_BW 10.0f // 初始带宽(保守值) #define LADRC_B0 1.0f // 初始控制增益 -
带宽调节：
- 每次增加5-10，观察系统响应
- 出现震荡时回退到前一个稳定值
- 最终值通常在15-30之间（1ms控制周期）
-
扰动补偿验证：
- 人为施加干扰（如突加负载）
- 监测eso_z3的响应速度和稳态误差
- 理想情况下扰动应在3-5个控制周期内被抑制
调试工具推荐：
- STM32CubeMonitor实时观测变量
- JScope可视化关键参数曲线
- 串口printf输出调试信息
4. 典型问题解决方案库
4.1 高频振荡问题
现象：系统输出出现小幅高频抖动
解决方案：
- 检查TD带宽是否过高
- 降低ESO带宽5-10个单位
- 在传感器输入端增加低通滤波
- 验证控制量限幅是否合理
4.2 抗扰性能不足
现象：大扰动下恢复时间过长
优化步骤：
- 逐步增加ESO带宽（每次+5）
- 验证b0参数是否偏离实际值超过30%
- 检查传感器延迟是否引入相位滞后
- 考虑升级为二阶LADRC结构
4.3 计算资源不足
应对策略：
- 将浮点运算转换为Q15/Q31格式
- 降低控制频率（最低可至100Hz）
- 使用STM32硬件FPU加速计算
- 简化TD模型为最速跟踪微分器
5. 进阶应用：二阶LADRC实现
对于电机位置控制等二阶系统，需要扩展为二阶LADRC：
c复制typedef struct {
// 三阶TD状态
float td_x1, td_x2, td_x3;
// 四阶ESO状态
float eso_z1, eso_z2, eso_z3, eso_z4;
float u;
} LADRC2_HandleTypeDef;
void LADRC2_Update(LADRC2_HandleTypeDef *c, float ref, float y) {
// 三阶TD更新
float td_fh = -pow(3*bw,2)*(c->td_x1-ref) - 3*bw*c->td_x2 - c->td_x3;
c->td_x1 += h * c->td_x2;
c->td_x2 += h * c->td_x3;
c->td_x3 += h * td_fh;
// 四阶ESO更新
float e = c->eso_z1 - y;
c->eso_z1 += h * (c->eso_z2 - beta1*e);
c->eso_z2 += h * (c->eso_z3 - beta2*e + b0*c->u);
c->eso_z3 += h * (c->eso_z4 - beta3*e);
c->eso_z4 += h * (-beta4*e);
// 三阶SEF
float e1 = c->td_x1 - c->eso_z1;
float e2 = c->td_x2 - c->eso_z2;
float e3 = c->td_x3 - c->eso_z3;
c->u = (kp*e1 + kd*e2 + kdd*e3 - c->eso_z4)/b0;
}
二阶系统调参要点：
- 带宽选择应大于系统自然频率的3倍
- ESO增益系数变为β1=4ω, β2=6ω², β3=4ω³, β4=ω⁴
- SEF需增加二阶微分项(kdd≈0.25ω²)
- 特别注意传感器噪声对高阶微分的影响
在实际的直流电机控制项目中，采用二阶LADRC可使位置跟踪误差减小60%以上，且对负载变化的适应时间缩短为传统PID的1/3。一个典型的应用案例是3D打印机热床控制，其中LADRC成功解决了加热不均匀和外界温度波动导致的打印质量问题。