这里写目录标题
- TD跟踪微分器
- ESO
- NLSEF
- 后续把公式的核心原理分析一下
参考链接：ADRC自抗扰控制，有手就行
ADRC是升级版的PID，由TD（跟踪微分器），ESO（扩张状态观测器），NLSEF（非线性控制律）。
其中TD主要是为了防止目标值突变而安排的过渡过程，ADRC的灵魂在于ESO，NLSEF则是改良PID直接线性加权（输出=比例+积分+微分）而引进的非线性控制律，使其更符合非线性系统。
TD跟踪微分器
在c++中的实现为：
fhan函数
#include <iostream>
#include <cmath>
float sign(float x)
{
if(x>0)
return 1;
else if(x<0)
return -1;
else
return 0;
}
float fhan(float x1,float x2,float r,float h)
float deltaa =0,
deltaa0 =0,
y =0,
a0 =0,
a =0,
fhan =0;
deltaa = r*h;
deltaa0 = deltaa*h;
y=x1+x2*h;
a0 = sqrtf(deltaa*deltaa+8*r*fabsf(y));
if(fabsf(y)<=deltaa0)
a=x2+y/h;
else
a=x2+0.5*(a0-deltaa)*sign(y);
if(fabsf(a)<=deltaa)
fhan = -r*a/deltaa;
else
fhan = -r*sign(a);
return fhan;
}
ESO
c++代码为：
/*******************************fal函数**********************************/
float fal(float e,float alpha,float delta)
{
float result = 0,fabsf_e = 0;
fabsf_e = fabsf(e);
if(delta>=fabsf_e)
result = e/powf(delta,1.0-alpha);
else //if(delta<fabsf_e)
result = powf(fabsf_e,alpha)*sign(e);
return result;
}
NLSEF
反应到程序上就是：
u0 = belta1*fal(e1,alpha1,delta) + belta2*fal(e2,alpha2,delta);//其中0<alpha1<1<alpha2
u = u0 - z3/b;
return u;
后续把公式的核心原理分析一下
然后就是参数整定的过程：
参数整定的规律是先将TD参数整定好，再整定ESO和NLSEF。
TD的参数整定是最简单的，观测v1的输出和输入v0的线性，其跟随的快慢并没有规定一定要多快多慢，取决于你想要的效果。TD参数只有两个：快速因子r 和滤波因子h 。其中，r 与跟踪速度呈正相关，然而，随之带来的是噪声放大的副作用;h与滤波效果呈正相关，但当h增大时，跟踪信号的相位损失也会随之增加。滤波因子经常取值为ADRC控制周期，比如1ms调用一次，h就是0.001，这也不是死定的，可以根据自己的效果做细微调整。
ESO共有b、delta、belta01、belta02、belta03共5个参数，其中delta取值范围在5h<=delta<=10h,h为ADRC控制周期。参数整定可以先将b定下来，比如取1或者2（最好还是能够知道你的二阶系统系数），然后先后调整belta01、belta02、belta03，观测z1能不能够很好的跟随反馈y，如果是，那么大概参数就调好了；如果不是，可以改动一下b，还是不行的话就得认认真真的检测一下反馈y是不是出了什么问题，比如变量数据类型转换有没有做好。如果懂得自己在输出中加入随机数（白噪声），注意幅值不能过大，观测一下z3是不是能够很好的观测到随机扰动。若以上两个条件都成立，那么ADRC就几乎被整定好了。
NLSEF参数有alpha1，alpha2，belta1，belta2四个，其中0<alpha1<1<alpha2。belta1和belta2则视效果而定，通常ESO和NLSEF一起调，在整定ESO参数时，可以先把delta1和delta2定为1，再调ESO，待ESO有一定效果后，反复调整ESO参数无果，可以加入NLSEF参数整定，取得更好的效果。
