ADRC实战用Python从零搭建一阶系统自抗扰控制器附完整代码控制工程领域一直在追求更鲁棒、更智能的算法来应对复杂系统中的不确定性。自抗扰控制Active Disturbance Rejection Control, ADRC作为一种不依赖精确模型的控制方法近年来在工业界获得广泛应用。本文将带您用Python从零实现一个完整的一阶系统ADRC控制器通过代码级解析揭示其核心原理。1. ADRC核心思想与架构设计自抗扰控制由韩京清研究员在1998年正式提出其核心思想是通过扩张状态观测器(ESO)实时估计并补偿系统内外扰动。与PID控制相比ADRC具有三大优势扰动估计与补偿ESO将系统模型不确定性、外部扰动等统一视为总扰动进行实时估计过渡过程安排通过跟踪微分器(TD)实现设定值的平滑过渡非线性组合采用非线性函数组合误差信号改善动态性能一阶系统ADRC的标准结构包含跟踪微分器(TD)处理阶跃指令扩张状态观测器(ESO)估计系统状态和总扰动非线性误差反馈(NLSEF)生成控制量class ADRC1stOrder: def __init__(self): # 控制器参数初始化 self.r 10 # TD速度因子 self.h 0.01 # 采样周期 self.beta01 100 # ESO参数 self.beta02 300 self.b0 1.0 # 系统系数 self.alpha 0.5 # 非线性因子 self.delta 0.1 # 线性区间宽度2. 关键模块实现与参数整定2.1 跟踪微分器(TD)实现TD的核心作用是安排过渡过程避免设定值突变引起的超调。我们采用最速跟踪算法def td(self, v): 跟踪微分器实现 :param v: 目标值 :return: (v1, v2) 过渡信号及其微分 e self.v1 - v fe self.fal(e, 0.5, self.h) self.v1 self.h * self.v2 self.v2 self.h * self.r * fe return self.v1, self.v2 def fal(self, x, alpha, delta): 非线性函数小误差大增益大误差小增益 if abs(x) delta: return x / (delta**(1-alpha)) else: return abs(x)**alpha * np.sign(x)参数整定要点r决定跟踪速度通常取5-50h为采样周期需与实际控制周期一致delta影响线性区间一般取h的5-10倍2.2 扩张状态观测器(ESO)实现ESO是ADRC的核心通过将扰动扩张为额外状态进行观测def eso(self, y, u): 扩张状态观测器 :param y: 系统输出 :param u: 控制输入 :return: (z1, z2) 状态估计和扰动估计 e self.z1 - y fe self.fal(e, 0.5, self.h) self.z1 self.h * (self.z2 self.b0*u self.beta01*e) self.z2 self.h * (self.beta02*fe) # 幅值限制 self.z1 np.clip(self.z1, -1e5, 1e5) self.z2 np.clip(self.z2, -1e5, 1e5) return self.z1, self.z2参数整定经验| 参数 | 作用 | 典型取值规律 | |----------|--------------------|-------------------| | beta01 | 状态跟踪带宽 | 50-200 | | beta02 | 扰动观测带宽 | 100-500 | | b0 | 系统增益估计 | 实际系统增益的0.8-1.2倍 |2.3 非线性误差反馈设计采用非线性组合取代PID的线性加权提升控制性能def nlf(self, e1, e2): 非线性误差反馈 :param e1: 误差 :param e2: 误差微分 :return: 控制量 fe1 self.fal(e1, self.alpha, self.delta) fe2 self.fal(e2, self.alpha0.5, self.delta) return 10*fe1 0.1*fe2 # 权重系数需根据系统调整3. 完整控制系统实现将各模块集成构建闭环控制系统def control_loop(self, target_func, plant, T30): 完整控制循环 N int(T/self.h) logger {t: [], y: [], v: [], u: [], z2: []} for i in range(N): t i * self.h v target_func(t) # 目标信号 # 各模块执行 v1, v2 self.td(v) y plant.observe() # 获取系统输出 z1, z2 self.eso(y, self.u) e1 v1 - z1 u0 self.nlf(e1, v2-z1) self.u (u0 - z2)/self.b0 # 扰动补偿 plant.update(self.u) # 施加控制量 # 数据记录 logger[t].append(t) logger[y].append(y) logger[v].append(v) logger[u].append(self.u) logger[z2].append(z2) return logger4. 仿真对比与性能分析4.1 测试环境搭建构建含复杂扰动的一阶测试系统class FirstOrderSystem: def __init__(self): self.x 0 self.h 0.01 def f(self, x, t): 总扰动未知 return x**2 0.5*np.sign(np.sin(2*t)) np.cos(x*t) def update(self, u): 系统状态更新 w self.f(self.x, self.t) self.x self.h * (w u) self.t self.h def observe(self): 系统输出 return self.x 0.01*np.random.randn() # 加入测量噪声4.2 ADRC与PID性能对比通过阶跃响应测试对比控制效果def compare_adrc_pid(): # 初始化控制器 adrc ADRC1stOrder() pid PID(Kp1.2, Ki0.5, Kd0.1) # 运行仿真 plant_adrc FirstOrderSystem() plant_pid FirstOrderSystem() logger_adrc adrc.control_loop(target_step, plant_adrc) logger_pid pid.control_loop(target_step, plant_pid) # 绘制对比曲线 plt.figure(figsize(12,6)) plt.plot(logger_adrc[t], logger_adrc[y], labelADRC) plt.plot(logger_pid[t], logger_pid[y], labelPID) plt.plot(logger_adrc[t], logger_adrc[v], k--, labelTarget) plt.legend() plt.xlabel(Time(s)) plt.ylabel(Output) plt.title(ADRC vs PID Performance Comparison) plt.show()典型对比结果特征调节时间ADRC比PID快约30%超调量ADRC接近零超调PID约15%抗扰动ADRC在扰动下保持更好跟踪性能4.3 参数调试技巧通过系统辨识初步确定参数范围def parameter_tuning_guide(): 参数调试指南 print( 1. 先调TD参数 - 保持h实际采样周期 - 增大r直到过渡过程速度满足需求 2. 再调ESO参数 - beta01 ≈ 带宽的平方 - beta02 ≈ 带宽的立方 - 实际带宽从5-50Hz开始尝试 3. 最后调NLSEF - 先设alpha0.5, delta0.1 - 调整权重使控制量不过大 )5. 工程应用建议在实际工程中应用ADRC时需要注意采样周期选择一般取系统响应时间的1/10~1/20需考虑控制器计算能力扰动补偿限制# 在控制量计算后加入限幅 u np.clip(u, -umax, umax)参数自适应策略# 根据工作点自动调整参数 if abs(y) threshold: self.beta01 * 1.2 # 增大观测带宽与现有系统集成可先替换PID的D项为ADRC逐步替换整个控制回路完整代码已托管在GitHub仓库包含详细注释和测试案例。实际应用中建议先进行系统辨识确定大致参数范围再通过本文介绍的方法精细调节。对于更高阶系统可采用相似思路扩展ESO的阶数。