# 从增量 PID 到 ADRC：用 #WorkBuddy# 搞懂步进电机控制的"算法升级之路"

## 起点：增量 PID 跑得好好的，为什么要换？

在做 STM32G071 双轴步进电机的速度环时，我一开始用的是经典的**增量式 PID**：

```c
// 增量式 PID 的核心公式
zengliang_shuchu = Kp * (wucha - shangci_wucha)
                 + Ki * wucha
                 + Kd * (wucha - 2*shangci_wucha + shangshangci_wucha);
```

调参调了很久，Kp 从 0.1 试到 5.0，Ki 从 0.01 试到 1.0，Kd 从 0 试到 0.5。问题是：**一个参数组合在空载时效果很好，一加负载就震荡；调稳了加负载的情况，空载启停又超调**。

这就是经典 PID 的痛点：**固定的三个参数，无法适应变化的工况**。

项目需求要求做到负载自适应，于是我开始调研 ADRC（自抗扰控制）。但 ADRC 的论文和教材全是数学公式——跟踪微分器（TD）、扩张状态观测器（ESO）、非线性状态误差反馈（NLSEF）——看得我云里雾里。

## WorkBuddy 怎么帮我理解 ADRC

### 第 1 步：先搞清楚"ADRC 到底比 PID 多了什么"

我给 WorkBuddy 发了一句话：

> "我用增量 PID 做步进电机速度环，PID 调好了空载，加了负载就不行了。ADRC 能解决这个问题吗？帮我用'和 PID 对比'的方式讲清楚。"

WorkBuddy 的回复极其清晰：

```
PID 的视角：        ADRC 的视角：
┌────────┐         ┌────────────────────┐
│ 给定值   │         │ 跟踪微分器（TD）    │ ← 平滑目标轨迹
├────────┤         │ ↓                  │
│ 误差=PID│         │ 非线性反馈（NLSEF）  │ ← 根据状态控
├────────┤         │ ↓                  │
│ 输出    │         │ 扩张状态观测器（ESO） │ ← ★ 核心：实时估算扰动！
└────────┘         │ ↓                  │
                   │ 输出 - 扰动补偿     │ ← 主动消除扰动
                   └────────────────────┘
```

> **ADRC 比 PID 多了一个"旁观者"——ESO（扩张状态观测器）。这个旁观者时刻盯着系统的输入输出，实时估算"现在系统受到了多大的外部扰动"，然后主动补偿掉它。**

### 第 2 步：把 ADRC 拆成三个独立模块

WorkBuddy 帮我把 ADRC 拆成了三个独立模块，每个单独讲：

**模块 1：跟踪微分器（TD）—— "把台阶变成斜坡"**

```
阶跃输入（给定 300RPM）：
  PID 视角：瞬间要求 0→300RPM → 误差巨大 → 输出巨大 → 超调震荡
  ADRC TD：安排过渡过程，0→300 变成平滑斜坡 → 误差平缓 → 输出平缓
```

**模块 2：扩张状态观测器（ESO）—— "实时估算看不见的扰动"**

```
系统输入（控制量） + 系统输出（实际转速）
        ↓
   ESO 实时估算：
   - z1: 当前真实转速（滤波后）
   - z2: 当前加速度
   - z3: 总扰动（内部不确定性 + 外部负载）  ← 这是 PID 没有的！
        ↓
   输出 = 控制量 - z3/控制增益
   ↑ 主动补偿扰动，而不是等误差变大再反应
```

**模块 3：非线性状态误差反馈（NLSEF）—— "根据误差大小自适应调整增益"**

```
PID：             NLSEF（fal 函数）：
误差小 → 增益 K  误差小 → 增益大（精细调节）
误差大 → 增益 K  误差大 → 增益小（防止过冲）
↑ 固定            ↑ 自适应 ← 这就是 ADRC 适应负载变化的核心！
```

### 第 3 步：落实到代码层面

WorkBuddy 还帮我给出了 ADRC 三个模块的 C 语言框架，可以直接在 STM32G071 上用：

```c
// ESO（扩张状态观测器）—— ADRC 的核心
void ESO_Update(float y, float u, float h) {
    // y = 实际转速（编码器测量值）
    // u = 当前控制量
    // h = 采样周期（62.5μs = 0.0000625s）

    float e = z1 - y;          // 误差

    z1 += h * (z2 - beta1 * e);   // 状态1: 转速
    z2 += h * (z3 - beta2 * fal(e, 0.5) + b0 * u); // 状态2: 加速度
    z3 += h * (-beta3 * fal(e, 0.25));  // 状态3: ★ 总扰动估计
}
```

> `z3` 就是 ADRC 的"杀手锏"——它在每个采样周期实时估算系统受到的扰动，然后主动补偿。PID 是"等误差变大了再反应"，ADRC 是"预判扰动并提前消除"。

---

## 踩坑心得

| 坑 | 教训 |
|----|------|
| PID 调参靠"感觉" | 三个参数不是万能的——先理解算法原理再调参 |
| 把 ADRC 当成"更复杂的 PID" | ESO 才是 ADRC 的核心，TD 和 NLSEF 都是辅助 |
| 参数太多不会调 | beta1/2/3 可以按带宽法计算，不用瞎试 |

## 用 WorkBuddy 前后的对比

| | 没有 WorkBuddy | 有 WorkBuddy |
|--|--------------|-------------|
| 理解 ADRC | 看论文：全是数学，看不懂 | 拆成 TD/ESO/NLSEF 三模块，逐个击破 |
| 调参方向 | 不知道 ADRC 到底好在哪里 | 明确：ESO 解决了扰动抑制，NLSEF 解决了自适应 |
| 代码实现 | 不知道怎么从公式写到 C | 给出了完整的 C 框架，直接填参数就行 |

---

## 总结

ADRC 和 PID 的本质区别不是"多了几个参数"，而是**控制哲学的升级**：

- **PID** 是"看着误差调输出"（被动反应）
- **ADRC** 是"先估算扰动再主动补偿"（主动预测）

WorkBuddy 帮我做的不是"直接调好 ADRC 参数"，而是**帮我把论文里的数学公式翻译成嵌入式工程师能看懂的语言**——用代码、用框图、用对比表。一旦理解了 why，如何实现就是水到渠成的事。

---

*本文基于作者 STM32G071 步进电机速度环算法迭代经历撰写。*  
*算法演进路径：增量 PID → PLL 滤波 → ADRC（当前阶段）*

在做 STM32G071 双轴步进电机的速度环时，我一开始用的是经典的增量式 PID：

WorkBuddy_PID到ADRC

编程语言

算法

开发工具

本文探讨步进电机控制从增量PID升级到ADRC的算法优化过程。增量PID在负载变化时表现不佳，而ADRC通过扩张状态观测器实时估算扰动并主动补偿，实现负载自适应控制。文章详细拆解ADRC三大模块（TD、ESO、NLSEF）的工作原理，并提供STM32G071的C语言实现框架，帮助工程师理解ADRC相比PID的主动预测优势。

电机控制

代码解释

WorkBuddy 

文章

问答

视频

教程

学习中心

腾讯云实验室

直播

竞赛

腾讯云代码分析专区

腾讯iOA零信任安全管理系统专区

腾讯云架构师技术同盟交流圈

腾讯云数据库专区

腾讯云智能顾问专区

腾讯云原生专区

腾讯混元专区

腾讯云TCE专区

腾讯云Lighthouse专区

腾讯云HAI专区

腾讯云Edgeone专区

腾讯云存储专区

腾讯云智能专区

腾讯轻联专区 

腾讯云开发专区

TAPD专区

腾讯轻量云游戏服专区

EdgeOne AI 安全实战专区

腾讯云最具价值专家

腾讯云架构师技术同盟

腾讯云创作之星

腾讯云开发者先锋

腾讯云代码助手

云原生构建

TAPD 敏捷项目管理

Cloud Studio

SDK中心

API中心

命令行工具

涵盖代码开发、场景应用、自动测试全流程，助你从零构建专属AI助手

一站式MCP教程库，解锁AI应用新玩法

聚焦“写作效率、视觉美观与运行性能”三方面进行全面升级，为您提供更高效、稳定的创作环境

社区富文本&Markdown编辑器全新改版上线，欢迎大家体验!

诚挚邀请您参与本次调研，分享您的真实使用感受与建议。您的反馈至关重要，感谢您的支持与参与！

社区新版编辑器体验调研

本文探讨步进电机控制从增量PID升级到ADRC的算法优化过程。增量PID在负载变化时表现不佳，而ADRC通过扩张状态观测器实时估算扰动并主动补偿，实现负载自适应控制。文章详细拆解ADRC三大模块（TD、ESO、NLSEF）的工作原理，并提供STM32G071的C语言实现框架，帮助工程师理解ADRC相比PID的主动预测优...

WorkBuddy_PID到ADRC-腾讯云开发者社区-腾讯云

WorkBuddy_PID到ADRC

WorkBuddy_PID到ADRC

社区

活动

圈层

关于

腾讯云开发者

热门产品

热门推荐

更多推荐