线性状态观测器和线性控制器综合
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$ 越小系统收敛越快
一个小栗子

建立系统状态空间方程,令
$$ 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} $$