STM32实现LADRC电机控制：原理、优化与实测

1. 项目背景与LADRC控制原理

去年接手一个无刷电机控制项目时，传统PID在负载突变时总是出现明显超调，这让我开始寻找更鲁棒的控制方案。线性自抗扰控制器（LADRC）以其独特的扰动估计能力引起了我的注意。与PID不同，LADRC通过扩张状态观测器（ESO）实时估计并补偿系统内外扰动，这种主动抗扰思路在电机控制领域优势明显。

核心原理上，LADRC将系统总扰动（包括模型不确定性、外部干扰等）视为一个额外的状态变量。以二阶系统为例，其状态空间方程可表示为：

code复制ẋ1 = x2
ẋ2 = f(x1,x2,w,t) + b*u

其中f(·)代表总扰动。通过设计合适的观测器带宽w0，ESO可以准确跟踪x1（系统输出）并估计x2（微分项）和f(·)（扰动项）。控制律则通过前馈补偿将原系统转化为纯积分器串联形式，大幅简化了控制器设计。

2. STM32F103C8T6硬件适配方案

2.1 计算资源优化策略

STM32F103C8T6仅有64KB Flash和20KB RAM，在跑72MHz主频时，浮点运算会成为性能瓶颈。实测发现，直接实现LADRC算法会导致控制周期从预期的100μs延长到150μs。通过以下优化手段解决了这个问题：

1. 查表法预计算：将w0²、2*w0等重复计算的参数定义为宏

c复制#define WO_SQUARE(w) ((w)*(w)) 
#define TWO_WO(w)    (2*(w))

2. 定点数优化：对观测器状态量采用Q格式表示，通过移位替代浮点乘除

c复制int32_t z1_Q15 = z1 * 32768;  // Q15格式

3. 编译器优化：启用-O3优化并设置FPU快速模式

makefile复制CFLAGS += -O3 -ffast-math

2.2 定时器中断实现要点

使用TIM2作为控制周期定时器，关键配置如下：

c复制void TIM2_Config(void) {
    TIM_TimeBaseInitTypeDef timer;
    RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2, ENABLE);
    
    timer.TIM_Prescaler = 72 - 1;  // 1MHz计数频率
    timer.TIM_Period = 100 - 1;    // 100us周期
    TIM_TimeBaseInit(TIM2, &timer);
    
    TIM_ITConfig(TIM2, TIM_IT_Update, ENABLE);
    NVIC_EnableIRQ(TIM2_IRQn);
    TIM_Cmd(TIM2, ENABLE);
}

重要提示：避免在中断服务程序中进行浮点运算保存/恢复操作，这会导致额外的20个时钟周期开销。实测发现使用__attribute__((naked))修饰ISR可避免编译器自动生成FPU保护代码。

3. LADRC核心算法实现细节

3.1 控制器数据结构设计

采用面向对象思想封装LADRC控制器：

c复制typedef struct {
    float b0;     // 系统增益估计
    float w0;     // 观测器带宽
    float z[3];   // 状态向量(z1=输出估计,z2=微分估计,z3=扰动估计)
    float u_prev; // 上一周期控制量
} LADRC_2ndOrder;

3.2 状态观测器离散化实现

采用欧拉离散化方法，关键更新方程：

c复制void LADRC_Update(LADRC_2ndOrder* ctrl, float ref, float y) {
    float e = ctrl->z[0] - y;
    
    // 状态观测器更新
    ctrl->z[0] += CTRL_PERIOD * ctrl->z[1];
    ctrl->z[1] += CTRL_PERIOD * (ctrl->b0*ctrl->u_prev + ctrl->z[2] 
                - TWO_WO(ctrl->w0)*ctrl->z[1] - WO_SQUARE(ctrl->w0)*e);
    ctrl->z[2] += CTRL_PERIOD * (-WO_SQUARE(ctrl->w0)*ctrl->z[1]);
    
    // 控制量计算
    float u0 = (ref - ctrl->z[0]) * WO_SQUARE(ctrl->w0)/ctrl->b0;
    ctrl->u_prev = u0 - ctrl->z[2]/ctrl->b0;
}

3.3 参数整定经验公式

通过大量实验总结出适用于电机控制的参数规则：

1. 观测器带宽w0 = (3~5)*系统带宽
2. 控制器带宽wc = (0.2~0.5)*w0
3. b0取系统稳态增益的倒数

例如对于带宽50Hz的电机系统：

c复制ctrl.w0 = 2*PI*200;   // 200Hz观测器带宽
ctrl.b0 = 1.0/12.5;   // 实测增益倒数

4. LabVIEW上位机开发技巧

4.1 串口通信协议设计

采用轻量级帧结构保证实时性：

code复制帧头(0xAA) | 数据长度(1B) | 数据类型(1B) | 数据(4B) | 校验和(1B)

其中数据类型定义：

• 0x01: 设定值
• 0x02: 实际转速
• 0x03: 控制量

4.2 生产者-消费者模式实现

使用LabVIEW的队列机制防止界面卡顿：

1. 生产者循环：串口读取线程，将数据包推入队列
2. 消费者循环：从队列取出数据并更新波形图表

4.3 数据可视化优化

通过以下方式提升显示效果：

1. 使用Waveform Chart的"历史数据"属性实现滚动显示
2. 对转速数据添加移动平均滤波
3. 采用双Y轴显示设定值和实际值

5. 实测性能对比与调试心得

5.1 动态性能测试数据

在24V/3000rpm直流电机上对比PID与LADRC：

5.2 常见问题排查指南

1. 观测器发散：

   • 检查CTRL_PERIOD是否与定时器配置匹配
   • 降低w0值逐步调试

2. 控制量饱和：

   • 确认b0参数准确性
   • 添加输出限幅保护

3. LabVIEW数据错乱：

   • 检查串口波特率是否一致
   • 验证帧头校验逻辑

5.3 关键调试工具

1. STM32端：利用SWD接口实时查看变量
2. PC端：使用串口示波器(如COMTool)辅助调试
3. 联合调试：通过LabVIEW在线修改参数

这个项目让我深刻体会到LADRC在抗扰动方面的优势，特别是在电机负载突变场景下。建议初次使用者先用MATLAB进行频域分析，确定w0和wc的大致范围后再进行实物调试，可以节省大量现场调试时间。