故障诊断5——状态观测器和输出观测器

最新推荐文章于 2024-10-07 11:32:19 发布

路漫求索_CUMT

最新推荐文章于 2024-10-07 11:32:19 发布

阅读量1.7w

点赞数 17

分类专栏：故障诊断与容错控制文章标签：故障诊断观测器

本文链接：https://blog.csdn.net/jinpeng_cumt/article/details/87692579

版权

故障诊断与容错控制专栏收录该内容

6 篇文章 116 订阅

订阅专栏

1. 状态观测器分类

在现代控制理论中，控制系统的基本结构和经典控制理论一样，仍然是由受控对象和反馈控制器两部分构成的闭环系统。不过在经典理论中习惯于采用输出反馈，而在现代控制理论中则更多地采用状态反馈。由于状态反馈能提供更丰富的状态信息和可供选择的自由度，因而使系统容易获得更为优异的性能。

1.1 基于状态反馈的控制器设计

状态反馈是将系统的每一个状态变量乘以相应的反馈系数，然后反馈到输入端与参与输入相加形成控制律，作为受控系统的控制输入。图1是一个多输入—多输出系统状态反馈的基本结构。

图1 多输入多输出系统状态反馈结构图

系统状态方程如下：

$\left\{\begin{matrix} \dot{x}=Ax+Bu\\ y = Cx+Du \end{matrix}\right.$ （1）

式中 $x\in R^{n}$ ; $u\in R^{r}$ ; $y\in R^{m}$ ； $A_{n\times n}$ 、 $B_{n\times r}$ 、 $C_{m\times n}$ 、 $D_{m\times r}$ 。若 D=0 ，则受控系统简化为：

$\left\{\begin{matrix} \dot{x}=Ax+Bu\\ y = Cx \end{matrix}\right.$ （2）

简记为 $\sum=(A,B,C)$

状态线性反馈控制律为

u=Kx+v （3）

其中， $v\rightarrow r\times 1$ 维参考输入， $K\rightarrow r\times n$ 维状态反馈系数阵或状态反馈增益阵。对单输入系统，为 $1\times n$ 维行向量。

将（3）式代入（1）式整理可得状态反馈闭环系统的状态空间表达式如下：

$\left\{\begin{matrix} \dot{x}=(A+BK)x+Bv\\ y = (C+DK)x+Dv \end{matrix}\right.$ （4）

如 D=0 ，则

$\left\{\begin{matrix} \dot{x}=(A+BK)x+Bv\\ y = Cx \end{matrix}\right.$ （5）

简记为 $\sum=(A+BK,B,C)$

闭环系统的传递函数矩阵为

$W_{k}(s)=C[sI-(A+BK)]^{-1}B$ （6）

比较开环系统 $\sum=(A,B,C)$ 与闭环系统 $\sum=(A+BK,B,C)$ 可见，状态反馈阵的引入，并不增加系统的维数，但可通过的选择自由地改变闭环系统的特征值，从而使系统获得所要求的性能。

1.2 基于输出反馈的控制器设计

输出反馈是采用输出矢量构成线性反馈律。在经典控制理论中主要讨论这种反馈形式。图2示出多输入—多输出系统输出反馈的基本结构。

图2 多输入多输出系统输出反馈结构图

系统状态方程如下：

$\left\{\begin{matrix} \dot{x}=Ax+Bu\\ y = Cx+Du \end{matrix}\right.$ （7）

输出线性反馈控制律为

u=Hy+v （8）

式中， $H\rightarrow r\times m$ 维输出反馈增益阵。对单输出系统，为 $r\times 1$ 维列向量。闭环系统状态空间表达式可由式（7）代入（8）得：

u=H(Cx + Du)+v （9）

整理得：

$u=(I-HD)^{-1}(HCx+v)$ （10）

再把式（10）代入式（7）求得

$\left\{\begin{matrix} \dot{x}=[A+B(I-HD)^{-1}HC]x+B(I-HD)^{-1}v\\ y = [C+D(I-Hu)^{-1}HC]x+D(I-HD)^{-1}v \end{matrix}\right.$ （11）

若 D=0 ，则

$\left\{\begin{matrix} \dot{x}=(A+BHC)x+Bv\\ y = Cx \end{matrix}\right.$ （12）

简记 $\sum=(A+BHC,B,C)$ 。由式（12）可见，通过选择输出反馈增益阵也可以改变闭环系统的特征值，从而改变系统的控制特性。

输出反馈系统的传递函数矩阵为

$W_{H}(s)=C[sI-(A+BHC)]^{-1}B$ （13）

若受控系统的传递函数阵为

$W_{0}(s)=C[sI-A]^{-1}B$ （14）

则 $W_{H}(s)$ 和 $W_{0}(s)$ 存在下列关系

$W_{H}(s)=W_{0}(s)[I-HW_{0}(s)]^{-1}$ （15）

或者

$W_{H}(s)=[I-W_{0}(s)H]^{-1}W_{0}(s)$ （16）

比较上述两种基本形式的反馈可以看出，输出反馈中的与状态反馈中的相当。但由于 m<n ，所以可供选择的自由度远比小，因而输出反馈只能相当于一部分状态反馈。只有当 C=I 时， HC=K 才能等同于全状态反馈。因此，在不增加补偿器的条件下，输出反馈的效果显然不如状态反馈系统好。但输出反馈在技术实现上的方便性则是其突出优点。

2. 基于观测器的控制器

系统模型

$\left\{\begin{matrix} \dot{x}=Ax+Bu\\ y = Cx+Du \end{matrix}\right.$ （17）

假定系统是能控、能观的。使得闭环系统极点为 $\lambda _{1},\lambda _{2},\cdots,\lambda _{n}$ 的状态反馈控制律是 u=-Kx 。若系统状态不能直接测量，可以利用龙伯格观测器来估计系统的状态。

$\dot{\tilde{x}}=A\tilde{x}+Bu+L(y-C\tilde{x}) =(A-LC)\tilde{x}+Bu+Ly$ （18）

进而用 $u=-K\tilde{x}$ 来替代原来的控制。

将 $u=-K\tilde{x}$ 代入(18)式，可得利用状态估计值的反馈控制器如下：

$\dot{\tilde{x}}=A\tilde{x}+Bu+L(y-C\tilde{x}) =(A-LC-BK)\tilde{x}+Ly$ （19）

基于观测器的输出反馈控制系统结构图3所示：

图3 基于观测器的状态反馈控制系统结构

由图3可知，系统增加了积分器，闭环系统是2n 阶的。

（1）若选择 $\begin{bmatrix} x^{T} & \tilde{x}^{T} \end{bmatrix}^{T}$ 为闭环系统状态，则系统状态方程

$\dot{x}=Ax-Bu = Ax-BK\tilde{x}$ （20）

$\dot{\tilde{x}}=(A-LC-BK)\tilde{x}+LCx$ （21）

写成矩阵向量形式：

$\begin{bmatrix} \dot{x}\\ \dot{\tilde{x}} \end{bmatrix}=\begin{bmatrix} A &-BK \\ LC& A-LC-BK \end{bmatrix}\begin{bmatrix} x\\ \tilde{x} \end{bmatrix}$ （22）

定义误差向量： $e(t)=x(t)-\tilde{x}(t)$ ，则

$\dot{e}(t)=\dot{x}(t)-\dot{\tilde{x}}(t) \\ =Ax-BK\tilde{x}-(A-LC-BK)\tilde{x}-LCx \\ = (A-LC)x(t)-(A-LC)\tilde{x}(t)=(A-LC)e(t)$ （23）

其特征多项式为

$det\left [ \lambda I-(A-LC) \right ]=det\left [ \lambda I-(A-LC)^{T} \right ]=det\left [ \lambda I-(A^{T}-C^{T}L^{T})\right ]$ （24）

（2）若选择 $\begin{bmatrix} x^{T} & {e}^{T} \end{bmatrix}^{T}$ 为闭环系统状态，则系统状态方程

$\begin{bmatrix} \dot{x}\\ \dot{e} \end{bmatrix}=\begin{bmatrix} A-BK &BK \\ 0& A-LC \end{bmatrix}\begin{bmatrix} x\\e \end{bmatrix}$ （25）

其特征多项式为

$det\left ( \begin{bmatrix} \lambda I-A+BK &-BK \\ 0& \lambda I-A+LC \end{bmatrix} \right )=det\left ( \lambda I-A+BK \right )det\left ( \lambda I-A+LC \right )$ （26）

分离性原理 闭环系统的极点是极点配置单独设计产生的极点和由观测器单独设计产生的极点两部分组成。

3. 设计实例

系统状态空间模型的系数矩阵：

$A=\begin{bmatrix} 0 & 1\\ -1 & 0 \end{bmatrix}$ ， $B=\begin{bmatrix} 1\\ 0 \end{bmatrix}$ , $C=\begin{bmatrix} 1& 0 \end{bmatrix}$

已知系统状态不能直接测量，试设计控制器，使得闭环系统渐近稳定。

控制器一：输出反馈控制器

输出反馈控制器： u=-ky

系统闭环矩阵：

$\begin{bmatrix} 0 & 1\\ -1 & 0 \end{bmatrix}-\begin{bmatrix} 1\\ 0 \end{bmatrix}k\begin{bmatrix} 1 & 0 \end{bmatrix}=\begin{bmatrix} 0 &1-k \\ -1 &0 \end{bmatrix}$ （27）

特征多项式： $\lambda ^{2}+1-k$

结论：无论k取什么值，无法将两个闭环极点配置在左半开复平面。

控制器二：状态反馈控制器

第1步：判断系统能控性和能观性

% 系统矩阵
A = [0 1; -1,0];
B = [1;0];
C = [1 0];

% 判断系统是否完全能控
E_con = ctrb(A,B);           % 求解能控性矩阵
E_val_con = rank(E_con);     % 根据能控性矩阵是否满秩判断能控性

E_obs = obsv(A,C);           % 求解能观性矩阵
E_val_obs = rank(E_obs);     % 根据能观性矩阵是否满秩判断能观性

根据上述结果可知，系统完全能控、能观。

第二步：设计状态反馈控制器 $u=-\begin{bmatrix} k_{1} & k_{2} \end{bmatrix}y$

闭环矩阵：

$\begin{bmatrix} 0 & 1\\ -1 & 0 \end{bmatrix}-\begin{bmatrix} 1\\ 0 \end{bmatrix}\begin{bmatrix} k_{1} & k_{2} \end{bmatrix}=\begin{bmatrix} - k_{1}&1-k_{2} \\ -1 &0 \end{bmatrix}$ （28）

特征多项式： $\lambda ^{2}+k_{1}\lambda+1-k_{2}$

结论：选取 $K=\begin{bmatrix} k_{1} & k_{2} \end{bmatrix}=\begin{bmatrix} 1 & -1 \end{bmatrix}$ ，则闭环极点 $-0.5\pm j1.32$ 。

控制器三：基于观测器的状态反馈控制器

控制器二是在系统状态可测的情况下求得的，如果系统状态不可测，则需要设计相应状态观测器。假设观测器的两个极点为均为-2，则根据极点配置方法，可得观测器增益矩阵 $L=\begin{bmatrix} 4 & 3 \end{bmatrix}^{T}$ ，则观测器模型可写为：

$\dot{\tilde{x}}=\begin{bmatrix} -4 &1 \\ -4& 0 \end{bmatrix}\tilde{x}+\begin{bmatrix} 1\\ 0 \end{bmatrix}u+\begin{bmatrix} 4\\3 \end{bmatrix}y$ （29）

根据分离性原理，由以上分别得到的状态反馈和观测器增益矩阵可构造基于观测器的输出反馈控制器。

$\dot{\tilde{x}}=\begin{bmatrix} -5 &2 \\ -4& 0 \end{bmatrix}\tilde{x}+\begin{bmatrix} 4\\3 \end{bmatrix}y \\$ （30）

$u=-\begin{bmatrix} 1 & -1 \end{bmatrix}\tilde{x}$

系统的动态特性

$\begin{bmatrix} \dot{x}\\ \dot{e} \end{bmatrix}=\begin{bmatrix} A-BK &BK \\ 0& A-LC \end{bmatrix}\begin{bmatrix} x\\e \end{bmatrix}=\begin{bmatrix} -1 & 2 & 1 &-1 \\ -1& 0 &0 &0 \\ 0 &0 &-4 &1 \\ 0& 0 & -4& 0 \end{bmatrix}\begin{bmatrix} x\\e \end{bmatrix}$ （31）

检验系统的稳定性，对象和误差的初始条件

$x(0)=\begin{bmatrix} 1\\ 0 \end{bmatrix}$ ， $e(0)=\begin{bmatrix} 0.5\\ 0 \end{bmatrix}$

利用MATLAB实现的代码如下：

1. 求观测器增益系数L和控制器增益系数K

clc
clear all
% 系统矩阵
A = [0 1; -1,0];
B = [1;0];
C = [1 0];
D = 0;

x0 = [1;0];  % 初值
e0 = [0.5;0];

G=ss(A,B,C,D);

%判断系统是否完全能控
E_con = ctrb(A,B);           % 求解能控性矩阵
E_val_con = rank(E_con);     % 根据能控性矩阵是否满秩判断能控性
E_obs = obsv(A,C);           % 求解能观性矩阵
E_val_obs = rank(E_obs);     % 根据能观性矩阵是否满秩判断能观性

p_L = [-2;-2];    % 观测器期望极点
L = (acker(A',C',p_L))';  % 观测器增益系数L
p_K = [-0.5+1.32i;-0.5-1.32i]; % 系统期望极点
K = place(A,B,p_K);  % 状态反馈增益系数K

fprintf('观测器增益系数 L=\n')
disp(L);
fprintf('控制器增益系数 K=\n')
disp(K);

2. main.m

clc
clear all

x0 = [1;0;0.5;0];
[t,x] = ode45(@gcq,[0,10],x0);
figure;
hold off;
plot(t,x(:,1),'r-');
hold on;
plot(t,x(:,3),'b-');

figure;
plot(t,x(:,2),'r-');
hold on;
plot(t,x(:,4),'b-');

3. gcq.m

function dx = gcq(t,x)
%u = sin(t);
K = [1,-1];
u = -K*[x(3);x(4)];
y = x(1);

dx(1) = x(2) + u;
dx(2) = -x(1);

dx(3) = -4*x(3) + x(4) + u + 4*y;
dx(4) = -4*x(3) + 3*y;

dx = dx';

系统曲线如下：