现代控制理论-大作业-倒立摆

摘要

倒立摆系统是一个复杂的、高度非线性的、不稳定的高阶系统，

是学习和研究现代控制理论最合适的实验装置。倒立摆的控制是控制

理论应用的一个典型范例，一个稳定的倒立摆系统对于证实状态空间

理论的实用性是非常有用的。

本文主要研究的是二级倒立摆的极点配置方法，首先用Lagrange

方程建立了二级倒立摆的数学模型，然后对二级倒立摆系统的稳定性

进行了分析和研究，并给出了系统能控能观性的判别。基于现代控制

理论中的极点配置理论，根据超调量和调整时间来配置极点，求出反

馈矩阵并利用Simulink对其进行仿真，得到二级倒立摆的变化曲线，

实现了对闭环系统的稳定控制。

关键词：二级倒立摆；极点配置；Simulink

目录

1.绪论................................................................3

2数学模型的建立和分析................................................3

2.1数学建模的方法..................................................3

2.2二级倒立摆的结构和工作原理.....................................4

2.3才“格朗日动方程

2.4推导建立数学模型...............................................5

3二级倒立摆系统性能分析.............................................11

3.1稳定性分析....................................................11

3.2能控性能观性分析...............................................12

4状态反馈极点配置...................................................13

4.1二级倒立摆的最优极点配置1.........................................................................13

4.2二级倒立摆最优极点配置2............................................................................14

5.二级倒立摆matlab仿真.............................................16

5.1Simulink搭建开环系统..........................................16

5.2开环系统Simulink仿真结果.....................................16

5.3Simulink搭建极点配置后的闭环系统.............................17

5.4极点配置Simulink仿真结果.....................................18

5.4.1第一组极点配置仿真结果....................................18

5.4.2第二组极点配置仿真结果....................................20

6.结论..............................................................21

7.参考文献..........................................................22

附录...............................................................23

1.绪论

倒立摆最初诞生于麻省理工学院，仅有一级摆杆，另一端钱接于可以在直线导轨上自由滑动

的小车上。后来在此基础上，人们又进行拓展，设计出了直线二级倒立摆、环型倒立摆、平面倒

立摆、柔性连接倒立摆、多级倒立摆等实验设备。

在控制理论的发展过程中，为验证某一理论在实际应用中的可行性需要按其理论设计的控制

器去控制一个典型对象来验证。倒立摆系统作为一个实验装置，形象直观，结构简单，成本低廉;

作为一个控制对象，他又相当复杂，同时就其本身而言，是一个高阶次、不稳定、多变量、非线

性、强耦合系统，只有采取吁之有效的控制方法才能使之稳定，因此倒立摆装置被公认为是自动

控制理论中的典型实验设备。

综合文献资料，倒立摆控制的方法主要有：PID控制，状态反馈，利用云模型，神经网络控

制，遗传算法，自适应控制，模糊控制，变论域自适应模糊控制理论，智能控制等多种算法来实

现倒立摆的控制。

本文主要构建二级倒立摆的数学模型的建立与分析，对倒立摆系统进行控制方法

的研究。本文就以下几个问题进行了论述。

1.二级倒立摆的数学模型的建立与分析。

在建模部分，首先采用拉格朗日方程推导数学模型，并时系统的可控性可观性进行分析，并

分析倒立摆系统控制的难易程度。

2.二级倒立摆的控制原理及方法的研究。

本文主要采用状态反馈极点配置的方法对二级倒立摆进行研究。

3.采用Matlab语言进行数字仿真，分析仿真结果。

2数学模型的建立和分析

2.1数学建模的方法

所谓系统的数学模型就是利用数学结构来反映系统内部之间、内部与外部某些因素之间的精

确的定量的表示。它是分析、设计、预报和控制一个系统的基础，所以要对一个系统进行研究，

首先要建立它的数学模型。

建立倒立摆系统的模型时，一般采用牛顿运动规律，结果要解算大后的微分方程组，而且考

虑到质点组受到的约束条件，建模问题将更加复杂，为此本文采用分析力学方法中的Lagrange

方程推导倒立摆的系统模型。Lagrange方程有如下特点：

1.它是以广义坐标表达的任意完整系统的运动力程式，力程式的数目和系统的自由度是一致

的。

2.理想约束反力不出现在方程组中，因此在建立运动方程式时，只需分析已知的主动力，而

不必分析未知的约束反力。

3.Lagrange方程是以能量观点建立起来的运动方程，为了列出系统的运动方程，只需要从两

个方面去分析，一个是表征系统运动的动力学量一系统的动能，另一个是表征主动力作用的动力

学量一广义力。

因此用Lagrange方程来求解系统的动力学方程可以大大简化建模过程。

2.2二级倒立摆的结构和工作原理

如图2.1,系统包括计算机、运动控制卡、伺服机构、倒立摆本体（小车，上摆，下摆，皮

带轮等）和光电码盘几大部分，组成了一个闭环系统。光电码盘1将小车的位移、速度信号反馈

给伺服驱动器和运动控制卡，下面一节摆杆（和小车相连）的角度、角速度信号由光电码盘2反

馈回控制卡和伺服驱动器，上面一节摆杆的角度和角速度信号则由光电码盘3反馈。计算机从运

动控制卡中读取实时数据，确定控制决策（小车向哪个方向移动、移动速度、加速度等），并由运

动控制卡来实现该控制决策，产生相应的控制量，使电机转动，带动小车运动，保持两节摆杆的

平衡。

图2,1系统结构和工作原理图

2.3拉格朗日运动方程

拉格朗日提出了用能量的方法推导物理系统的数学模型，首先我们引入广义坐

标，拉格朗日方程。

广义坐标：系统的广义坐标是描述系统运动必需的一组独立坐标，广义坐标数等

同于系统自由度数。如果系统的运动用〃维广义坐标内⑪…s来表示，我们可以把

这〃维广义坐标看成是右维空间的〃位坐标系中的坐标。对于任一系统可由〃维空间

中的一点来表征。系统在〃维空间中运动形成的若干系统点连成一条曲线，此曲线表

示系统点的轨迹。

拉格朗F1方程：

⑵1)

式中，L一一拉格朗日算子，

(I----系统的广义坐标，

T一一系统的动能，

V——系统的势能。

拉格朗日方程由广义坐标/和心表示为：

(2.2)

式中，，=1,2,3…〃，f]——系统沿该广义坐标方向上的外力，在本系统中，设系统的三个广义

坐标分别是北4，名。

2.4推导建立数学模型

在推导数学模型之前，我们需要几点必要的假设：

1.上摆、下摆及小车均是刚体：

2.皮带轮与传动带之间无相对滑动；传动皮带无伸长现象；

3.小车运动时所受的摩擦力正比于小车的速度：

4.小车的驱动力与直流放大器的输入成正比，且无滞后，忽略电机电枢绕组中的电感:

5.下摆转动时所受到的摩擦力矩正比于下摆的转动速度；

6.上摆运动时所受到的摩擦力矩正比于上摆对下摆的相对角速度；

二级倒立摆的运动分析示意图如图2.2

图2.2二级倒立摆运动分析示意图

倒立摆系统参数如下:

小车系统的等效质量.沪L32Kg

摆杆1质最吗=0.04Kg摆杆1转动中心到杆质心距离h0.09ni

摆杆2质量@=0.132Kg摆杆2转动中心到杆质心距离，2=0.27m

质量块质量生二0.208Kg作用在系统上的外力厂

摆杆1与垂直向上方向的夹角4摆杆2与垂直向上方向的夹角4

首先，计算系统的动能：

7=Zw+&+&+刀“3(2.3)

心小车动能:

*

(2.4)

T〃〃摆杆1动能:

(2.5)

式中，七.一摆杆1质心平东动能

匚■一摆杆1绕质心转动动能

2

rsing)'d(hcos0)

I+x=；仍工27Mcosq+优(2.6)

dtkdt

(2.7)

则

।2

4=+Tm\=-m,x2-m/^cosd+-/n/2^,2(2.8)

111JI1

图2摆杆2动能:

(2.9)

式中，J,一摆杆I质心平东动能

七，一摆杆1绕质心转动动能

T1

d(x-2l}sin0}-/2sin'丫1d(2/]cos0]+/2cos02)]

一十产

&dtdt

向同一；nt

=g(x-2/cosl2O2cos2)+i121&sina+/2asin02y(2.10)

T”1-11

T,n2=-J2^=--QmJ；=-tnJ；0；(2.11)

~/6

1

=—"L匕12-2工(2/]qcos〃[+/.cos。?))

2

+一2+?滋+4“加c0s(%_q)(2.12)

2~

TJH3质量块动能:

d(x-2/]sin4)丫十(d(2(cos巧)2

dtJdt

〃“］工〃“：*

=gm3x~-24cos44-2(2.13)

因此，可以得到系统总动能：

T=&+&+&+&

\y।2

—Mx2+—mx2-"“/acos巧十一〃久1衿；

}3

+—m23-2.耳2胸cosg+1202cos。?))

1

H----IH+%；氏+4/"/血cos(%-q)

27~3>

2

4-myx-2ZH3/IX/9Icos^j+2〃”；。：(2.14)

系统的势能为:

V叱“+L+L

=叫cosq+2m3glicos^+m2g(2licos^(+Z2cos幻(2.15)

至此得到拉格朗日算子L：

L=T-V

22

=；Mx+；m1x-町6WcosU+g&衿:

12

+—m2(x-2H2/]«cos'+l2O2cos^2))

2

+J也4/冶2+§；居+4仙阳2期(，2-4)

2

H■—m3x—2加3，|文«cos。1+2,nJ；0；—migl}cos，1

-2加3，|COSa-〃72g(2/|COS。］+1cosa)

2(2.16)

由于因为在广义坐标d,％上均无外力作用，有以下笔式成立：

(2.17)

(2.18)

展开(2.17)、(2.18)式,分别得到(2.19)、(2.20)式

6叫厌sin(M一。2)+4(町+3(叫+m3))/1^1-3(-2加cos(4一4)

+〔码+2(四+加3))(gsinq+1cosa))=0(2.19)

-3gsin0,-640：sin(4-0」)+M,0,+611acos(0231cos02=O(2.20)

将(2.19)、(2.20)式对吊,4求解代数方程，得到以下两式

31=(3(-2g加।sin4-sin4一4用3gsin6+3叫gcos。一4)sin02

+6〃“|cos他一4)sin(G-4)0+4in2l2sin(^-61)3;-2m]xcos0]

-4W2XCOS^-4W3XCOS01+3〃?21cos(4-OJCOSOJ)/

2

(2/1(-4叫一⑵的一12〃3+9/W2COS(^-FT)))(2.21)

2

02=-(——m2{m{+3Q〃2+))/,Z2(-3^sin02-6//：sin(q-，)一3xcos^2)

+—A?I2/(-/-,cos(^-O2)(6m2l2Olsin(a-%)-3(〃4+2(/4+sinq+xcos^)))/

(一与明(g+3("4+"4))/；/；+4m；/：/；cos2-%))(2.22)

表示成以下形式:

12,

=工(再仇,。尤无)⑵23)

闰⑵24)

取平衡位置时各变量的初值为零，

A=(x,。、，%,x,4,4,x)=(0,0,0,0,0,0,0)=0⑵25)

将(2.23)式在平衡位置进行泰勒级数展开，并线性化，令

&L匏x=0

⑵26)

I=3(2g叫4g/44g-3)

(2.27)

2(-4加]一3吗-12m3)4

K_<

&L寇⑵28)

2(-4叫-3m2-12m3M

A-0=0(2.29)

/t-K/

&5=凯。=。

⑵30)

A=0=°⑵31)

3(-2//21一〃!2一4〃b)

跖=⑵32)

"=o2(-4/zz,-3m-,-1hny)/,

得到线性化之后的公式

4=+K\@2+

A17X⑵33)

将4=启1,3。2，尤4以,功在平衡位置进行泰勒级数展开，并线性化，令

心啜”。⑵34)

2I_2g(町+2(吗+[%))⑵35)

K、，=FI八=0—16

47M2/2--(〃％-3。%+/))，2

___________4g(/4+3(〃A+g))

(2.36)

4-0

4专dO-16

2

3(47772/2——(叫+3(〃?2+)乂2)

A-0=0⑵37)

A=0=°⑵38)

4飞小一°(2.39)

4

2(町+2(m2+niy))——(叫+3(w2+吗)

3(2.40)

K-四16

27aJ=。

4/W2/2-----(班+3("224-7H3))/2

得到

4=(2.41)

即：

VK的+KM+K/(2.42)

+Kvx⑵43)

现在得到了两个线性微分方程，由于我们采用加速度作为输入，因此还需加上--个方程:

U-定⑵44

取状态变最如卜.:

X一-X

4

X2-

X3-仇

-⑵45

.

X4^-X

4

X5-

4

X

.6-

则状态空间方程如下:

0

0

0

⑵46)

0

.1/=1.32

%=0.04

m2=0.132

将以下参数代入,03=0.208

g=9.8

7,=0.09

12=0.27

求出各个K值:

七二77.0642K,,=-38.5321

(3=-21.1927K“二37.8186

K”5.7012Ky]--0.0728

得到状态方程各个参数矩阵:

00010()■

000010

000001

A=

000000

077.0642-21.1927000

0-38.532137.8186000

-0-

0

0

B=

1

5.7012

-0.0728

~10000o-

C=010000

001000

3二级倒立摆系统性能分析

3.1稳定性分析

二级倒立摆的特征方程为：

dct(2Z->4)=0(3.1)

Matlab'|>,用函数eig%)来计算系统矩阵的特征值，经过计算，系统的特征值为：

2=[9.59724.7725-9.5972-4.772500](3.2)

开环系统有两个开环极点位于S平面右半平面I-.,所以系统是不稳定的。

同时，根据前面的状态空间表达式，在matlab中，用stcp(A,B,C,D)函数时系统的阶跃响应

进行分析：

StepFtesponse

23467

Tme(seconds)

图1开环系统单位阶跃响应

从上图可以看出，在阶跃响应的作用下，系统是发散的。

3.2能控性能观性分析

对于线形状态方程

X=AX+BU,、

(3.3)

Y=CX

其能控性矩阵为：

Z)=[B,AB,A2B,A3B,A4B,A5B](3.4)

求4的秩

rank5)=6(3.5)

所以系统是完全能控的.

其能观性矩阵为：

■=以⑶6)

求C0的秩

rank(C0)=6(3.7)

所以系统是完全能观的,(代码见附录)

由上述计算结果可知，二级倒立摆系统是开环不稳定系统，但它的状态是完全能控且完全能

观测的。因此，可以对其实现闭环最优控制。

4状态反馈极点配置

4.1二级倒立摆的最优极点配置1

在式3.3中，A为6*6降；B为6*1阵；C为3*6阵。是一个单输入系统，且完全能控、能观

测。因此，可按照最优控制系统的极点配置方法进行设计。

对于一般控制系统，闭环主导极点的选取应使160.8。但二级倒立摆是一个特殊的高阶

系统，稳定性是主要矛盾，因此可适当增加・，即适当降低响应速度，来弥补系统稳定性要求。

相应在选择性能指标时，应适当减小系统的超调量。

对于二阶倒立摆系统，主要针对如下两个主要的性能指标进行设计：

超调量：

调节时间：

(4.1)

(4.2)

这里，误差范围取为2%将上述性能指标代入式4.1和式4.2得到二级倒立摆系统的2个性

能指标满足，，取,A=2.17

将得到的阻尼比与自然常好传灯岷§

(4.3)

得到二级倒立摆系统的2个主导极点为：

=IL87+1.1,(4.4)

对于其他四个非主导极点，不妨设为四重极点，且距主导极点10倍以上，即满足下式：

|1$/1=1匕1|=|b5H=瓦1|11OIZ17=2L7(4.5)

所以，另外四个非主导极点取为：s.a=、=H.=SS=I22

到此，二级倒立摆的6个极点都己确定。

P-[-1.87+l.llj-1.87-1.11J-22-22-22-22](4.6)

tEmatlab中输入K=acker(A,B,P)可求得:

K=

1.0e+03*

0.52810.4618-2.63790.5136-0.0797-0.4476

至此，完成了一级倒立摆控制器的设计。接下来在mat中仿直得到:

x1Q'3StepFtesponse

2

=

¥1

0

8

10

-1

x10

2

&

Q=

Pn

2o

6

QI.1

VU

-2

5

cho

n

o0

一

1。

■5

00.511.522.533.54

Time(seconds)

图2极点配置后单位阶跃响应1

4.2二级倒立摆最优极点配置2

在上述基础上，继续调整超调量和调整时间，使二级倒立摆达到稳定。第二次取：

超调量：

调节时间：

这里，误差范围仍取为2%,代入式4.1和式4.2得到二级倒立摆系统的2个性能指标满足,

,取6■0.69，4.=231

将得到的阻尼比与自然用频率式4.3得到第二组主导极点：

心=11.734-1.81/,(4.4)

对于其他四个非主导极点，不妨设为四重极点，且距主导极点1。倍以上，即满足下式:

11$J-1匕1|■lUsll-||»41||12123=30(4.5)

所以，另外四个非主导极点取为：S.2=5,=S，=S£=I3。

因此，第二组极点P2=[-1.73+1.81j-1.73-1.81j-30-30-30-30]

在matlab中输入K2=acker(A,B,P2)可求得：

K2=

1.0o+03*

2.42050.5209-7.49771.6587-0.2846-1.2008

接下来绘制极点配置后系统的单位阶跃响应图：

4

xioStepResponse

5

0

5

1

①G

p=

nn

u

-o

d0

E。:

<1

s

D

o

b

J0

.

-2

00.511.522.533.544.5

Time(seconds)

图3极点配置后单位阶跃响应2

5.二级倒立摆matlab仿真

5.1Simulink搭建开环系统

图4开环系统仿真图

5.2开环系统Simulink仿真结果

目◎|回飞11口厢。|E!•中~*

Timeoffset:0.1

图5开环系统matlab仿真结果图

由上图可知，在Simulink中搭建的开环系统是发散的，与理论计算的结果吻介。

5.3Simulink搭建极点配置后的闭环系统

y-04

Scope

♦CD

oun

soopei

Soopt2

口

Scope!

Soopex

[—]

scopes

Soope6

图6极点配置优化后的系统结构图

5.4极点配置Simulink仿真结果

5.4.1第一组极点配置仿真结果

图7极点配置优化后的结果图

图8小车位移曲线

QScope2110|回

|吕◎回q由国用后回而^

图9一级倒立摆角及曲线

Scope3了j回

台◎亶|q蜃国甩脂回台审、

图10二级倒立摆角度曲线

从以上的图片可以看出，系统在给定输入的情况下，।秒左右恢复到平衡点的位置附近，系

统较好的快速性、稳定性和精确性都非常理想，且无超调最，符合要求。

5.4.2第二组极点配置仿真结果

图11极点配置优化后的结果图

图12小车位移曲线

图13一级倒立摆角度曲线