线性状态观测器和线性控制器综合

#线性控制器
Table of Contents

对于一个不可观测的系统的控制,就需要用到设计观测器和控制器结合

对于一个系统

$$ \dot{X}=AX+Bu\\y=CX+Du $$

观测器

根据之前的观测器设计,可以得到

$$ \dot{e_x}=(A-LC)e_x\\e_x={X}-{\hat{X}}\\L=\begin{bmatrix}l_1\\l_2\end{bmatrix} $$

需要 $A-LC$ 的特征值小于 0 ,才能使得该误差值逐渐趋近于 0

控制器

其中需要设计控制器为

$$ u=-K\hat{X} $$

带入到系统状态方程中可以得到

$$ \dot{X}=AX-BK(X-e_x)=(A-BK)X+BKe_x $$

与观测器中的式子合并可以得到

$$ \begin{bmatrix}\dot{e_x}\\\dot{x}\end{bmatrix}=\begin{bmatrix}A-LC&0\\BK&A-BK\end{bmatrix}\begin{bmatrix}{e_x}\\{x}\end{bmatrix}=M\begin{bmatrix}{e_x}\\{x}\end{bmatrix} $$

这里就看出来了,M 矩阵的特征值得实部必须小于 0 ,实际上该矩阵的特征值就是 $A-LC$ 和 $A-BK$ 的特征值

最后就是要求观测器的 $A-LC$ 特征值与控制器的 $A-BK$ 的特征值小于 0,它们两个就分离开了

有一个要求就是观测器的收敛速度一定要大于控制器的收敛速度,以此来保证观测到的数据都是较为准确的

一般来说极点位置 $s=-a$ 越小系统收敛越快

一个小栗子

Untitled

建立系统状态空间方程,令

$$ X=\begin{bmatrix}x_1\\x_2\end{bmatrix}\\\\ x_1=\phi\\\\ x_2=\dot{\phi}(不可测)\\\\ u=\frac{1}{L}\ddot{x}_{block} $$

则从上式可以得到状态空间方程

$$ \dot{X}=\begin{bmatrix}0&1\\\frac{g}{L}&0\end{bmatrix}X+\begin{bmatrix}0\\-1\end{bmatrix}u\\\\ y=\begin{bmatrix}1&0\end{bmatrix}X+[0]u $$

可以得到

$$ A-LC=\begin{bmatrix}0&1\\\frac{g}{L}&0\end{bmatrix}-\begin{bmatrix}l_1\\l_2\end{bmatrix}\begin{bmatrix}1&0\end{bmatrix}=\begin{bmatrix}-l_1&1\\\frac{g}{L}-l_2&0\end{bmatrix} $$

可以假设

$$ g=10~N/m^2\\\\ L=1~m $$

带入后得到

$$ A-LC=\begin{bmatrix}-l_1&1\\10-l_2&0\end{bmatrix} $$

求其特征方程为

$$ |\lambda I-(A-LC)|=0\\\\ \Downarrow\\\\ \lambda^2+l_1\lambda+l_2-10=0 $$

所以,令该特征方程的两个根都为 -1 ,可以得到

$$ l_1=2\\\\ l_2=11 $$

所以带入到估计值的方程中可以得到

$$ \dot{\hat{X}}=(A-LC)\hat{X}+(B-LD)u+Ly\\\\ \Downarrow\\\\ \dot{\hat{X}}=\begin{bmatrix}-2&1\\-1&0\end{bmatrix}\hat{X}+\begin{bmatrix}0\\-1\end{bmatrix}u+\begin{bmatrix}2\\11\end{bmatrix}y $$

对于线性控制器来说,输入 $u$ 满足

$$ u=-K\hat{X} $$$$ \begin{bmatrix}\dot{e_x}\\\dot{x}\end{bmatrix}=\begin{bmatrix}A-LC&0\\BK&A-BK\end{bmatrix}\begin{bmatrix}{e_x}\\{x}\end{bmatrix}=M\begin{bmatrix}{e_x}\\{x}\end{bmatrix} $$

特征方程为

$$ \lambda^2-k_2\lambda-10-k_1=0 $$

令 $A-BK$ 的特征方程的两个根都为 -1,可以得到

$$ k_1=-11\\\\ k_2=-2 $$

所以得到

$$ u=\begin{bmatrix}11&2\end{bmatrix}\hat{X} $$