二阶倒立摆实验报告

研究生课程实验报告

课程名称：线性系统

实验名称：平面二级倒立摆实验

班级：12S0441

学号：12S104057

姓名：白俊林

实验时间：2012 年12 月21 日

控制科学与工程教学实验中心

1.实验目的

1)熟悉Matlab/Simulink仿真；

2)掌握LQR控制器设计和调节；

3)理解控制理论在实际中的应用。

倒立摆研究的意义是，作为一个实验装置，它形象直观，简单，而且参数和形状易于改变；但它又是一个高阶次、多变量、非线性、强耦合、不确定的绝对不稳定系统的被控系统，必须采用十分有效的控制手段才能使之稳定。因此，许多新的控制理论，都通过倒立摆试验对理论加以实物验证，然后在应用到实际工程中去。因此，倒立摆成为控制理论中经久不衰的研究课题，是验证各种控制算法的一个优秀平台，故通过设计倒立摆的控制器，可以对控制学科中的控制理论有一个学习和实践机会。

2.实验内容

1）建立直线二级倒立摆数学模型

对直线二级倒立摆进行数学建模，并将非线性数学模型在一定条件下化简成线性数学模型。对于倒立摆系统，由于其本身是自不稳定的系统，实验建立模型存在一定的困难，但是经过小心的假设忽略掉一些次要的因素后，倒立摆系统就是一个典型的运动的刚体系统，可以在惯性坐标系内应用经典力学理论建立系统的动力学方程。对于直线二级倒立摆，由于其复杂程度，在这里利用拉格朗日方程推导运动学方程。

由于模型的动力学方程中存在三角函数，因此方程是非线性的，通过小角度线性化处理，将动力学非线性方程变成线性方程，便于后续的工作的进行。

2）系统的MATLAB仿真

依据建立的数学模型，通过MATLAB仿真得出系统的开环特性，采取相应的控制策略，设计控制器，再加入到系统的闭环中，验证控制器的作用，并进一步调试。控制系统设计过程中需要分析内容主要包括得出原未加控制器时系统的极点分布，系统的能

观性，能控性。

3）LQR 控制器设计与调节实验

利用线性二次型最优（LQR ）调节器MATLAB 仿真设计的参数结果对平面二阶倒立摆进行实际控制实验，参数微调得到较好的控制效果，记录实验曲线。 4）改变控制对象的模型参数实验

调整摆杆位置，将摆杆1朝下，摆杆2朝上修改模型参数、起摆条件和控制参数，重复3的内容。

3. 实验步骤

1）倒立摆系统模型

在忽略了空气流动，各种摩擦之后，可将倒立摆系统抽象成小车、匀质杆和质量块组成的系统，如图1所示。

图1 直线两级倒立摆物理模型

下面利用拉格朗日方程推导运动学方程 。 拉格朗日方程为： ()()(),,,L q q T q q V q q =-&&&

(1)

i d L L

f dt q

q δδδδ-=& (2)

123M m m m T T T T T =+++

(3)

111m m

m T T T '''=+ (4) 222m m

m T T T '''=+ (5)

2

12

M T Mx =& (6)

()()22

11111122211111111sin sin 1211cos 22

m d x l d l T m dt dt m x m l x m l θθθθθ⎛⎫-⎛⎫⎛⎫ ⎪

'=+ ⎪ ⎪ ⎪⎝⎭⎝⎭⎝⎭=-+&&&& (7)

222221111111111112236m

p T J m l m l ωθθ⎛⎫

''=== ⎪⎝⎭

(8)

则

'''2221111111111112cos 23

m m m T T T m x m l x m l θθθ=+=-+&&&&

(9)

同样可以求出

()()

22

'112211222

222221112222111222(2sin sin (2cos cos )1122112cos cos 2sin sin 22

m d x l l d l l T m m dt dt m x l l m l l θθθθθθθθθθθθ--+⎛⎫⎛⎫

=+ ⎪ ⎪⎝⎭⎝⎭=--++&&&&&

(10)

''

22222222222

22211112236m T J m l m l ωωθ⎛⎫=

== ⎪⎝⎭

& (11)

(

)(

)

()'''

22222111222

222221122121221122cos cos 2

1444cos 23m m m T T T m x x l l m l l l l θθθθθθθθθθ=+=

-+⎛⎫+++- ⎪⎝⎭

&&&&&&&& (12)

22

11113322233111311

(2sin )(2cos )1212cos 22

m d x l d l T m dt dt m x m l x m l θθθθθ⎛⎫-⎛⎫⎛⎫=+ ⎪ ⎪ ⎪ ⎪⎝⎭⎝⎭⎝⎭

=-+&&&& (13)

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

(

)(

)

()123

22221111111122111222222221122121221222

33111311

112cos 223122cos cos 21444cos 2312cos 22M m m m T T T T T Mx m x m l x m l m x x l l m l l l l m x m l x m l θθθθθθθθθθθθθθθθ=+++=

+-++-+⎛⎫+++- ⎪⎝⎭+-+&&&&&&&&&&&&&&&&& (14)

系统的总势能为：

()

123

11131121122cos 2cos 2cos cos m m m V V V V m gl m gl m g l l θθθθ=++=+++ (15)

从而拉格朗日算子：

(

)(

)

()2222111111112211122222222112212122122233111311111311211112cos 223122cos cos 2

1444cos 2312cos 2cos 2

2cos 2cos L T V

Mx m x m l x m l m x x l l m l l l l m x m l x m l m gl m gl m g l θθθθθθθθθθθθθθθθθθθ=-=

+-++-+⎛⎫+++- ⎪⎝⎭+-+---&&&&&&&&&&&&&&&&&()22cos l θ+

(16)

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

11

0d L L

dt θθ⎛⎫∂∂-

= ⎪∂∂⎝⎭& (17)