单级倒立摆系统的极点配置与状态观测器设计

单级倒立摆系统的极点配置与状态观测器设计

14122156 杨郁佳

（1）倒立摆的运动方程并将其线性化

选取小车的位移z ，及其速度z g 、摆的角位置θ及其角速度θg

作为状态变量，即T x z z θθ⎡⎤=⎢⎥⎣

⎦g g 则系统的状态空间模型为 01000100000010()1000mg M M x u M m g Ml

Ml x ⎡⎤⎡⎤⎢⎥⎢⎥⎢⎥⎢⎥-⎢⎥⎢⎥=+⎢⎥⎢⎥⎢⎥⎢⎥+-⎢⎥⎢⎥⎢⎥⎢⎥⎣⎦⎣⎦g []1000y x

= 设M=2kg ，m=0.2kg ，g=9.81m/2

s ，则单级倒立摆系统的状态方程为 (1010)

01010

01020.500013030

011040.54x x x x u x x x x ⎡⎤⎢⎥⎡⎤⎡⎤⎡⎤⎢⎥⎢⎥⎢⎥⎢⎥-⎢⎥⎢⎥⎢⎥⎢⎥=+⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥-⎢⎥⎣⎦⎣⎦⎣⎦⎢⎥⎣⎦ []12100034x x y x x ⎡⎤⎢⎥

⎢⎥=⎢⎥⎢⎥⎣⎦

（2）状态反馈系统的极点配置。

首先，使用MATLAB ，判断系统的能控性矩阵是否为满秩。

MATLAB 程序如下：

A=[0 1 0 0; 0 0 -1 0; 0 0 0 1; 0 0 11 0]; B=[0; 0.5; 0; -0.5];

C=[1 0 0 0];

D=0;

rct=rank(ctrb(A,B))

[z,p,k]=ss2zp(A,B,C,D)

MATLAB程序执行结果如下：

系统能控，系统的极点为

1=0

λ

2=0

λ

3=3.3166

λ

4=-3.3166

λ

可以通过状态反馈来任意配置极点，将极点配置在

1=-3

λ*

2=-4

λ*

3=-5

λ*

4=-6

λ*

MATLAB程序如下：

A=[0 1 0 0; 0 0 -1 0; 0 0 0 1; 0 0 11 0];

B=[0; 0.5; 0; -0.5];

P=[-3 -4 -5 -6];

K=place(A,B,P)

MATLAB程序执行结果如下：

因此，求出状态反馈矩阵为

K=[-72.0 -68.4 -332.0 -104.4]

采用MATLAB/Simulink构造单级倒立摆状态反馈控制系统的仿真模型。

首先，在MATLAB的Command Window中输入各个矩阵的值，并且在模型中的积分器中设置非零初值：2。运行仿真程序，显示仿真曲线，如下。

o处。仿真结果表明倒立摆的杆子与数值方向的偏角从初值2，经过控制稳定在=0

（3）状态观测器实现状态反馈极点配置。

MATLAB程序如下：

A=[0 1 0 0; 0 0 -1 0; 0 0 0 1; 0 0 11 0];

B=[0; 0.5; 0; -0.5];

C=[1 0 0 0];

rob=rank(obsv(A,C))

MATLAB程序执行结果如下：

Rob=4说明系统能观，可以设计状态观测器。取状态观测器的特征值为-3，-4，-5，-6 MATLAB程序如下：

A=[0 1 0 0; 0 0 -1 0; 0 0 0 1; 0 0 11 0];

A1=A’;

C=[1 0 0 0];

C1=C’;

P=[-3 -4 -5 -6];

H1=place(A1,C1,P);

H=H1’

MATLAB 程序执行结果如下：

状态观测器矩阵[]18 130 540 1790T

H =--

采用MATLAB/Simulink 构造具有状态观测器的单级倒立摆状态反馈控制系统的仿真模型。

首先，在MATLAB的Command Window中输入各个矩阵的值，并且在模型中的积分器中设置非零初值：2。运行仿真程序，显示仿真曲线，如下。

对比两个仿真图，可以发现加上状态观测器对单级倒立摆的控制效果基本上无影响。