前言凌晨 5 点你的无人机终于能悬停了。但当你给无人机挂上一个待投放的小沙包时原本完美的 PID 参数瞬间失效无人机疯狂摇摆直至炸机。为什么PID 的痛点它只能“看到误差才去补救”反应永远慢半拍而且参数完全绑定了当前的重量和重心重量一变参数全废LQR 的痛点它需要你写出绝对精确的“物理数学模型”。但现实中地毯的摩擦力、电机的磨损、风的阻力你怎么可能精确建模有没有一种算法既不需要精确的物理模型又能瞬间把所有未知干扰不管你是挂了重物还是被大风吹强行抵消掉有它就是中国学者的骄傲、被誉为“面向 21 世纪的控制理论”——ADRC自抗扰控制。本文将带你跨越理论的鸿沟用最直白的人话和短短几十行 C 代码在 STM32 里装上这个工业界最顶级的“抗扰引擎”TOC一、 认知颠覆ADRC 到底在干一件什么“神仙事”不管是系统内部的老化电机没力气了还是外部的干扰大风吹、撞到石头在 ADRC 的眼里统统被打包成一个词——“总扰动Total Disturbance”。ADRC 的核心哲学我不需要知道干扰是怎么来的我只需要把它“看”出来然后在它破坏系统之前反向干掉它 核心灵魂扩张状态观测器ESO这是 ADRC 最牛逼的地方。假设你给电机发了 50 的 PWM按照经验电机应该转 100 圈/秒。但是传感器传回来的数据是 80 圈/秒。PID 是怎么做的“哦差了 20 圈我加大一点 PWM 试试。”ESO观测器是怎么做的“我发了 50 的力你应该转 100 圈但你只转了 80 圈。说明现实世界中有一个等效于 -20圈 的‘未知妖孽总扰动’在阻碍你”ESO 极其敏锐它能在微秒级的时间内实时计算出这个“总扰动”的大小既然知道了扰动有多大接下来就太简单了在原本的控制输出上直接加上一个反向的力把扰动“同等抵消”掉这就是“自抗扰”。二、 化繁为简为什么我们要用 LADRC线性自抗扰如果你去查文献标准的 ADRC 包含 TD跟踪微分器、NLSEF非线性状态误差反馈和 ESO。它足足有10 多个参数要调在电赛四天三夜里调这 10 个参数会让你精神分裂。降维打击高志强教授提出的 LADRC线性自抗扰高教授用极其巧妙的频域理论把这 10 个玄学参数强行缩减成了3 个具有明确物理意义的参数b0b0​控制增益代表你的系统“给多大推力就有多大加速度”。这是唯一需要大概估算的物理量。ωoωo​观测器带宽代表 ESO “看”扰动的速度有多快。越大抗干扰越敏锐但太大容易引入传感器噪声。ωcωc​控制器带宽代表系统追踪目标的速度有多快。越大响应越快。震撼事实用了 LADRC你调参就像调收音机频道一样简单只需要拧ωoωo​和ωcωc​这两个旋钮系统就能稳如磐石三、 STM32 纯 C 语言实战二阶 LADRC 极速部署代码别看论文里的矩阵微分方程吓人。在单片机的离散时间dtdt里二阶 LADRC 仅仅是几个极简的迭代公式下面这段代码完美适用于电机位置控制、倒立摆角度控制、无人机姿态控制这些都是典型的二阶系统输出受加速度控制。1. 参数与结构体定义codeCtypedef struct { // 【需要你调的 3 个核心参数】 float wc; // 控制器带宽 (决定响应速度) float wo; // 观测器带宽 (决定抗干扰速度通常设为 wc 的 3~5 倍) float b0; // 系统增益 (PWM - 加速度的转换比例) // ESO 观测器增益 (根据 wo 自动计算无需手调) float beta1; float beta2; float beta3; // ESO 内部状态估计变量 float z1; // 估计的位置 (或角度) float z2; // 估计的速度 (或角速度) float z3; // 估计的总扰动 (ADRC的灵魂) float dt; // 运行周期 (如 0.005s) float u; // 最终的输出控制量 (PWM) } LADRC_TypeDef; /** * brief LADRC 参数初始化 (自动计算观测器增益) */ void LADRC_Init(LADRC_TypeDef *adrc, float wc, float wo, float b0, float dt) { adrc-wc wc; adrc-wo wo; adrc-b0 b0; adrc-dt dt; // 核心黑魔法基于带宽极点配置自动计算 beta 参数 adrc-beta1 3.0f * wo; adrc-beta2 3.0f * wo * wo; adrc-beta3 wo * wo * wo; adrc-z1 0; adrc-z2 0; adrc-z3 0; adrc-u 0; }2. 核心控制执行函数放进 5ms 定时器中断这段代码分两步第一步让 ESO 观测出总扰动z3z3​第二步利用z3z3​抵消扰动并输出控制量codeC/** * brief 执行一次 LADRC 计算 * param target: 目标值 (期望角度/位置) * param measure: 传感器真实测量值 * retval 最终输出的控制量 (PWM) */ float LADRC_Calculate(LADRC_TypeDef *adrc, float target, float measure) { // // 第一步线性扩张状态观测器 (LESO) - “火眼金睛”看透一切干扰 // float e adrc-z1 - measure; // 观测值与真实值的误差 // 更新状态估计 (离散化欧拉积分) adrc-z1 adrc-dt * (adrc-z2 - adrc-beta1 * e); adrc-z2 adrc-dt * (adrc-z3 adrc-b0 * adrc-u - adrc-beta2 * e); // 这里算出来的 z3就是包含了摩擦力、风阻、负载变化的所有“总扰动” adrc-z3 adrc-dt * (-adrc-beta3 * e); // // 第二步线性误差反馈控制 (LSEF) - 抵消扰动精准打击 // // 1. 计算 PD 控制规律 (这里也利用了自动配置参数的黑魔法) float Kp adrc-wc * adrc-wc; float Kd 2.0f * adrc-wc; // 基础控制量 u0 (基于估计状态因为经过ESO过滤自带极强平滑效果) float u0 Kp * (target - adrc-z1) - Kd * adrc-z2; // 2. 终极杀招扰动补偿 // 无论外界怎么干扰我直接减去观测到的总扰动 z3 adrc-u (u0 - adrc-z3) / adrc-b0; // (可选) 加上输出限幅保护代码 // if(adrc-u MAX_PWM) adrc-u MAX_PWM; ... return adrc-u; }看到没没有积分器I也就永远没有积分饱和、撞墙疯跑的危险而且你连微分噪声都不用怕因为 z2 是 ESO 自己推算出的丝滑微分信号根本不是传感器原始数据求导来的四、 玄学破局LADRC 怎么调参工业级套路PID 调参是门玄学但 LADRC 调参是纯粹的工程学第一步估算b0b0​唯一需要试错的物理量先随便给一个数比如 1.0 或 10.0。如果系统震荡得很厉害b0b0​给大一点欺骗系统说它自己很强它输出的力就会变柔和。如果系统反应迟钝像没吃饭一样b0b0​给小一点。只要b0b0​调到了一个刚好不震荡的范围剩下的事情就交给ωω了第二步调节观测器ωoωo​和控制器ωcωc​原则ωoωo​通常是ωcωc​的3 到 5 倍。因为观测器必须比控制器“看”得快系统才稳。操作逐渐增大ωcωc​比如从 5 慢慢加到 30并保持ωo4×ωcωo​4×ωc​。什么时候停当你的电机开始发出“滋滋”的高频噪声时说明ωoωo​太高把传感器的底噪当成扰动放大了立刻停止并把带宽回调 20%。大功告成整个调参过程可能只需要 3 分钟你的系统鲁棒性就能直接碾压调了 3 天的 PID五、 赛场实战ADRC 降维打击的表现是什么样的如果你在电赛中选了两轮平衡自行车或者风力摆在答辩现场评委要求“在你的车上放一块 500g 的配重铁块。”PID 队伍重心大变I 环积分缓慢累加小车剧烈摇晃好几秒才勉强站住甚至直接倒地。ADRC 队伍加上铁块的瞬间ESO 在 5 毫秒内计算出 z3 扰动发生了突变控制量uu瞬间补偿。肉眼看过去小车几乎纹丝不动仿佛铁块根本不存在评委要求“用手拨一下无人机的机臂。”ADRC 队伍你的手会感觉到一种极度强烈的“肌肉抵抗感”外力撤除瞬间无人机毫无超调地死死钉回原点。在你的《系统设计报告》上写下“本系统摒弃了传统 PID 对精确模型的依赖与积分饱和缺陷采用二阶自抗扰控制器LADRC。利用扩张状态观测器ESO对系统内部耦合及外部气流扰动进行实时在线估计与前馈补偿实现了变负载工况下的极高鲁棒性控制。”评委看完不仅国一稳了甚至可能问你有没有兴趣读他的研究生结语如果说 PID 是古典物理LQR 是精英物理那么 ADRC 就是现代工程控制领域的“黑客帝国”。它打破了西方控制理论中“必须精确建立数学模型”的教条用极具东方哲学意味的“见招拆招”思想把所有未知的混沌与无序全部打包成一个z3z3​然后一剑封喉。不要再让你的电机在微积分的误差中悲鸣了用扩张状态观测器去洞悉物理世界的真实吧预祝各位挑战控制巅峰的开发者扰动秒抵消悬停如定海神针负载千变万化系统稳如泰山