滑模控制学习笔记（三）

基于趋近律的滑模控制

  滑模运动包括趋近运动和滑模运动两个过程。系统从任意状态趋近于滑模面，直到到达切换面的运动称为趋近运动，即$s\to 0$的过程。根据滑模变结构原理，滑模可达性条件仅保证由状态空间任意运动点在有限时间内到达切换面的要求，而对于趋近运动具体轨迹未作任何限制，采用趋近律的方法可以改善趋近运动的动态品质。

几种典型的趋近律

等速趋近律

$$\dot{s}=-ϵsign(s)ϵ>0\text{\hspace{1em}(1)}$$特点：$ϵ$越小，趋近速度慢；$ϵ$越大，引起的抖动越大。

指数趋近律

$$\dot{s}=-ϵsign(s)-ksϵ>0,k>0\text{\hspace{1em}(2)}$$特点：指数项$-ks$能保证当$s$较大时，系统能以较大的速度趋近滑动模态。因此，指数趋近律尤其适合解决具有大阶跃的响应控制问题。
注：指数趋近律中，为了保证快速趋近的同时削弱抖振，应在增大$k$的同时减小$ϵ$。

幂次趋近律

$$\dot{s}=-k|s{|}^{\alpha }sign(s)k>0,1>\alpha >0\text{\hspace{1em}(3)}$$特点：通过调整$\alpha$可保证系统状态远离滑模面时以较大的速度趋近于滑动模态；系统状态趋近滑模面时以较小的速度趋近于滑动模态，以降低抖振。

一般趋近律

$$\dot{s}=-ϵsign(s)-f(s)ϵ>0\text{\hspace{1em}(4)}$$其中，$f(0)=0$，当$s\ne 0$时，$sf(s)>0$。

基于趋近律的控制器设计

  考虑如下被控对象：$$\ddot{\theta }=-f(\theta ,t)+bu(t)\text{\hspace{1em}(5)}$$其中，$f(\theta ,t)$和$b$为已知且$b>0$。
  滑模函数为：$$s(t)=ce(t)+\dot{e}(t)c>0\text{\hspace{1em}(6)}$$
  跟踪误差为：$$e(t)={\theta }_d(t)-\theta (t),\dot{e}(t)={\dot{\theta }}_d(t)-\dot{\theta }(t)\text{\hspace{1em}(7)}$$其中，${\theta }_d$为理想位置信号。
  设采用指数趋近律，则需要满足$$\dot{s}=-ϵsign(s)-ksϵ>0,k>0\text{\hspace{1em}(8)}$$
  根据滑模函数可得：$$\dot{s}=c\dot{e}+\ddot{e}=c({\dot{\theta }}_d-\dot{\theta })+({\ddot{\theta }}_d-\ddot{\theta })=c({\dot{\theta }}_d-\dot{\theta })+({\ddot{\theta }}_d+f(\theta ,t)-bu(t))\text{\hspace{1em}(9)}$$综合式(8)(9)，可得到：$$c({\dot{\theta }}_d-\dot{\theta })+({\ddot{\theta }}_d+f(\theta ,t)-bu(t))=-ϵsign(s)-ks\text{\hspace{1em}(10)}$$整理得指数趋近律对应控制律为：$$u(t)=\frac{1}{b}(ϵsign(s)+ks+c({\dot{\theta }}_d-\dot{\theta })+{\ddot{\theta }}_d+f(\theta ,t))\text{\hspace{1em}(11)}$$

仿真实例

  考虑被控对象如下：$$\ddot{\theta }(t)=-25\dot{\theta }(t)+133u(t)\text{\hspace{1em}(12)}$$

状态空间模型建立

  根据上述微分方程，建立状态空间模型如下：

滑模控制器模型建立

  根据式（11），取$K=10,C=15,ϵ=5$，建立指数趋近律滑模控制器如下：

function u  = fcn(x2,e,dthd,ddthd)
K = 10;
C = 15;
eps = 5;
dth = x2;
de = dthd - dth;
s = C*e + de;
u = (eps*sign(s) + K*s + C*de+ ddthd + 25*dth)/133;
end

仿真结果

  取位置函数为${\theta }_d=sint$，则${\dot{\theta }}_d=cost,{\ddot{\theta }}_d=-sint$，设初始状态$[x_1{x}_2]=[-0.15-0.15]$仿真结果如下：

  分别取$k=0,k=5,k=10$，并将$e$和$\dot{e}$输出至workspace绘制相轨迹：

  可以看到，通过增大k可以更快的趋近于滑模面，但抖振的问题仍然存在。

基于趋近律的滑模鲁棒控制

  考虑被控对象与上例相同，但收到扰动$d(t)$，则运动方程如下：$$\ddot{\theta }(t)=-f(\theta ,t)+bu(t)+d(t)\text{\hspace{1em}(13)}$$采用与上例相同的滑模函数，且选择指数趋近律，得到如下方程：$$c({\dot{\theta }}_d-\dot{\theta })+({\ddot{\theta }}_d+f-bu-d)=ϵsign(s)-ks\text{\hspace{1em}(14)}$$则控制律为：$$u(t)=\frac{1}{b}(ϵsign(s)+ks+c\dot{e}+{\ddot{\theta }}_d+f-d)\text{\hspace{1em}(15)}$$但由于扰动项$d(t)$为未知项，因此需要其上下界进行控制律设计。
  设$d_L\le d(t)\le d_U$，令$$u(t)=\frac{1}{b}(ϵsign(s)+ks+c\dot{e}+{\ddot{\theta }}_d+f-d_c)\text{\hspace{1em}(16)}$$则此时$$\dot{s}=-ϵsign(s)-ks+d_c-d\text{\hspace{1em}(17)}$$为满足李雅普诺夫稳定条件$s\dot{s}=-ϵ|s|-k{s}^2+(d_c-d)s<0$：
（1）若$s>0$，可取$d_c=d_L$;
（2）若$s<0$，可取$d_c=d_U$;
根据上述两个条件可以得到：$$d_c=\frac{d_U+d_L}{2}-\frac{d_U-d_L}{2}sign(s)\text{\hspace{1em}(18)}$$

仿真实例

对上例的输入添加扰动$d(t)=10sin(\pi t)$，则$d_L=-10,d_U=10，d_c=10sign(s)$，构建滑模鲁棒控制$u(t)=\frac{1}{133}(ϵsign(s)+ks+c\dot{e}+{\ddot{\theta }}_d+25\dot{\theta }-d_c)$，对比有无鲁棒项的控制律及角度跟踪情况。

function [u,de] = fcn(x2,e,dthd,ddthd)
K = 10;
C = 15;
eps = 5;
du = 10;
dl = -10;
dth = x2;
de = dthd - dth;
s = C*e + de;
d1 = (du-dl)/2;
d2 = (du+dl)/2;
dc = d2-d1*sign(s);
u = (eps*sign(s) + K*s + C*de+ ddthd + 25*dth -dc )/133;
end