倒立摆MATLAB建模

线控大作业
如图所示的倒立摆系统。

图中，倒立摆安装在一个小车上。

这里仅考虑倒立摆在图面内运动的二维问题。

图倒立摆系统
假定倒立摆系统的参数如下。

摆杆的质量：m=0.1g
摆杆的长度：2l=1m
小车的质量：M=1kg
重力加速度：g=10/s2
摆杆惯量：I=0.003kgm2
摆杆的质量在摆杆的中心。

设计一个控制系统，使得当给定任意初始条件(由干扰引起)时，最大超调量 %≤10%，
调节时间ts ≤4s ，使摆返回至垂直位置，并使小车返回至参考位置(x=0)。

要求：1、建立倒立摆系统的状态方程
2、定量分析,定性分析系统的性能指标——能控性、能观性、稳定性
3、极点配置
设计分析报告
1 系统建模
在忽略了空气阻力和各种摩擦之后，可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统。

如下如所示。

图 一级倒立摆模型 其中：
φ 摆杆与垂直向上方向的夹角
θ 摆杆与垂直向下方向的夹角（考虑到摆杆初始位置为竖直向下） 图是系统中小车和摆杆的受力分析图。

其中，N 和P 为小车与摆杆相互作用力的水平和垂直方向的分量。

注意：在实际倒立摆系统中检测和执行装置的正负方向已经完全确定，因而矢量方向定义如图所示，图示方向为矢量正方向。

分析小车水平方向所受的合力，可以得到以下方程：
N x b F x
M --= 由摆杆水平方向的受力进行分析可以得到下面等式：
)sin (22
θl x dt d m N += 即：
θθθθsin cos 2 ml ml x
m N -+= 把这个等式代入式(3-1)中，就得到系统的第一个运动方程：
F ml ml x b x
m M =-+++θθθθsin cos )(2 为了推出系统的第二个运动方程，我们对摆杆垂直方向上的合力进行分析，可以得到下面方程：
)cos (22
θl dt
d m mg P =- θθθθ
cos sin 2 ml ml mg P --=- 力矩平衡方程如下：
θ
θθ I Nl Pl =--cos sin 注意：此方程中力矩的方向，由于θφθφφπθsin sin ,cos cos ,-=-=+=，故等式前面有负号。

合并这两个方程，约去P 和N ，得到第二个运动方程：
θθθcos sin )(2x
ml mgl ml I -=++ 设φπθ+=（φ是摆杆与垂直向上方向之间的夹角），假设φ与1（单位是弧度）相比很小，即1<<φ，则可以进行近似处理：0)(,sin ,1cos 2=-=-=dt
d θφθθ。

用u 来代表被控对象的输入力F ，线性化后两个运动方程如下： 2(+)()I ml mgl mlx M m x bx ml u ϕϕϕ⎧-=⎨++-=⎩
对式(3-9)进行拉普拉斯变换，得到
⎪⎩⎪⎨⎧=Φ-++=Φ-Φ+)
()()()()()()()()(22222s U s s ml s s bX s s X m M s s mlX s mgl s s ml I 注意：推导传递函数时假设初始条件为0。

由于输出为角度φ，求解方程组的第一个方程，可以得到：
)(])([)(22s s
g ml ml I s X Φ-+= 或 mgl
s ml I mls s X s -+=Φ222
)()()( 如果令x
v =，则有：
mgl
s ml I ml s V s -+=Φ22)()()( 把上式代入方程组的第二个方程，得到：
)()()()()()(2222s U s s ml s s s g ml ml I b s g ml
ml I m M =Φ-Φ⎥⎦⎤⎢⎣⎡+++⎥⎦⎤⎢⎣⎡-++ 整理后得到传递函数：
s q
bmgl s q mgl m M s q ml I b s s q ml s U s -+-++=Φ23242)()()()( 其中 []
22)())((ml ml I m M q -++=
设系统状态空间方程为： Du CX y Bu AX X
+=+=
方程组 对φ
,x 解代数方程，得到解如下： ⎪⎪⎪⎪⎩
⎪⎪⎪⎪⎨⎧+++++++++-==++++++++++-==u Mml m M I ml Mml m M I m M mgl x Mml m M I mlb u Mml m M I ml I Mml m M I gl m x Mml m M I b ml I x x x 2222222222)()()()()()()()()(φφφ
φφ 整理后得到系统状态空间方程：
u Mml m M I ml Mml m M I ml I x x Mml m M I m M mgl Mml m M I mlb Mml m M I gl m Mml m M I b ml I x x ⎥⎥⎥⎥⎥⎥⎦
⎤⎢⎢⎢⎢⎢⎢⎣⎡++++++⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎣⎡⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎣⎡+++++-+++++-=⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎣⎡2222222
222)(0)(00)()()(010000)()()(00010φφφφ u x x x y ⎥⎦⎤⎢⎣⎡+⎥⎥⎥⎥⎦
⎤⎢⎢⎢⎢⎣⎡⎥⎦⎤⎢⎣⎡=⎥⎦⎤⎢⎣⎡=0001000001φφφ 代入倒立摆系统的参数。

摆杆的质量：m=0.1g
摆杆的长度：2l =1m
小车的质量：M=1kg
重力加速度：g=10/s2
摆杆惯量：I=0.003kgm2
010
000010100010001101x x x x u ϕϕϕϕ⎡⎤⎡⎤⎡⎤⎡⎤⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥'=+⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎢⎥⎣⎦⎣⎦⎣⎦⎣⎦ u x x x y '⎥⎦⎤⎢⎣⎡+⎥⎥⎥⎥⎦
⎤⎢⎢⎢⎢⎣⎡⎥⎦⎤⎢⎣⎡=⎥⎦⎤⎢⎣⎡=0001000001φφφ 另外，也可以利用 MATLAB 中 tf2ss 命令对(3-13)式进行转化，求得上述状态方程。

2 系统分析
2.1 判断系统能控性和能观性
在MATLAB 中，可以利用ctrb()和obsv()函数直接求出能控性和能观性矩阵 A=[0 1 0 0;0 0 1 0;0 0 0 1;0 0 11 0];
B=[0;1;0;1];
C=[1 0 0 0;0 0 1 0];
D=[0;0];
Uc=ctrb(A,B);rc=rank(Uc);
n=size(A);
if rc==n
disp('system is controlled.')
elseif rc<n
disp('system is uncontrolled.')
end
V o=obsv(A,C);
ro=rank(V o);
if ro==n
disp('system is observable.')
elseif ro~=n disp('system is no observable.')
End
运行情况如下：
2.2 系统稳定性
A=[0 1 0 0;0 0 1 0;0 0 0 1;0 0 11 0];
B=[0;1;0;1];
C=[1 0 0 0;0 0 1 0];
D=[0;0];
P=poly(A),v=roots(P)
运行结果如下：
特征值为0（二重），3.3166,-3.3166，显然，其中一个极点在右半平面，该系统不稳定。

3 系统设计 极点配置与控制器设计
极点配置的方法就是通过一个适当的状态反馈增益矩阵的状态反馈方法 ,将闭环系统的极点配置到任意期望的位置。

()()()X t Ax t Bu t ，其中x 是状态变量（n 维），u 是控制信号，这里选取控制信号为u Kx ，
()()()x t A BK x t ，该方程的解为()()(0)A BK t x t e x ，
系统的稳态响应和瞬态响应特性由矩阵 A - B K 的特征决定。

1234K K K K K x ，闭环系统的方程为
()x
Ax Bf A BK x
，选取所希望的极点值为，1234p p p p 设计状态反馈阵时，要使系统的极点设计成具有两个主导极点，两个非主导
极点，这样就可以用二阶系统的分析方法进行参数的确定。

最大超调量小于等于10%，调节时间为4S ，
运用超调量的计算公式，
21%100%e ，其中为阻尼系数，有该公式可求得，阻尼系数=0.59，小于1，是欠阻尼。

33()s
n t 为极点实部，可以求得n =1.27 则极点公式为2
1,21n n p j ，得到两个共轭极点为
1,20.75 1.025p j .
配置非主导极点3415,15p p ，
在MATLAB 的控制系统工具箱中提供了单变量系统极点配置acker(),其格式为 K=acker(A,B,p)
程序如下：
A=[0 1 0 0;0 0 -2 0;0 0 0 1;0 0 22 0];
B=[0;1;0;-1];
C=[1 0 0 0;0 1 0 0；0 0 1 0；0 0 0 1];
D=0;
rc=rank(ctrb(A,B));
p=[-0.75+1.025j,-0.75-1.025j,-15,-15];
K=acker(A,B,p)
运行结果如下：
4 程序及其执行结果
该二阶系统的阶跃响应为下图所示
脉冲响应：。