1、线性系统实验报告姓名：院系：航天学院学号：2015 年 12 月研究生课程实验报告二阶倒立摆实验11. 实验目的1) 熟悉 Matlab/Simulink 仿真；2) 掌握 LQR 控制器设计和调节；3) 理解控制理论在实际中的应用。倒立摆研究的意义是，作为一个实验装置，它形象直观，简单，而且参数和形状易于改变；但它又是一个高阶次、多变量、非线性、强耦合、不确定的绝对不稳定系统的被控系统，必须采用十分有效的控制手段才能使之稳定。因此，许多新的控制理论，都通过倒立摆试验对理论加以实物验证，然后在应用到实际工程中去。因此，倒立摆成为控制理论中经久不衰的研究课题，是验证各种控制算法的一个优秀平台，故
2、通过设计倒立摆的控制器，可以对控制学科中的控制理论有一个学习和实践机会。2. 实验内容1）建立直线二级倒立摆数学模型对直线二级倒立摆进行数学建模，并将非线性数学模型在一定条件下化简成线性数学模型。对于倒立摆系统，由于其本身是自不稳定的系统，实验建立模型存在一定的困难，但是经过小心的假设忽略掉一些次要的因素后，倒立摆系统就是一个典型的运动的刚体系统，可以在惯性坐标系内应用经典力学理论建立系统的动力学方程。对于直线二级倒立摆，由于其复杂程度，在这里利用拉格朗日方程推导运动学方程。由于模型的动力学方程中存在三角函数，因此方程是非线性的，通过小 角度线性化处理，将动力学非线性方程变成线性方程，便于后续
3、的工作的进行。2）系统的 MATLAB 仿真依据建立的数学模型，通过 MATLAB 仿真得出系统的开环特性，采取相应的控制策略，设计控制器，再加入到系统的闭环中，验证控制器的作用，并进一步调试。控制系统设计过程中需要分析内容主要包括得出原未加控制器时系统的极点分布，系统的能研究生课程实验报告二阶倒立摆实验2观性，能控性。3）LQR 控制器设计与调节实验利用线性二次型最优（LQR）调节器 MATLAB 仿真设计的参数结果对平面二阶倒立摆进行实际控制实验，参数微调得到较好的控制效果，记录实验曲线。4）改变控制对象的模型参数实验调整摆杆位置，将摆杆 1 朝下，摆杆 2 朝上修改模型参数、起摆条件和控
4、制参数，重复 3 的内容。3. 实验步骤1）倒立摆系统模型在忽略了空气流动，各种摩擦之后，可将倒立摆系统抽象成小车、匀质杆和质量块组成的系统，如图 1 所示。图 1 直线两级倒立摆物理模型下面利用拉格朗日方程推导运动学方程。拉格朗日方程为：* MERGEFORMAT (1),LqTVq* MERGEFORMAT (2)idLft* MERGEFORMAT (3)13MmTT研究生课程实验报告二阶倒立摆实验3* MERGEFORMAT (4)11mT* MERGEFORMAT (5)22* MERGEFORMAT (6)Mx* MERGEFORMAT (7)22111221111sinsinco
5、mdldlTttxlml * MERGEFORMAT (8)222111136mpTJll则* MERGEFORMAT (9) 2211111cos3mxmll同样可以求出 2 2 12122 2 21212(sini(cos)cosinimdxlldllTt tllmll* MERGEFORMAT (10)* MERGEFORMAT (11) 2222136mTJll* MERGEFORMAT (12) 222122121coss43xllll 研究生课程实验报告二阶倒立摆实验4* MERGEFORMAT (13)221132 2331131(sin)(cos)comdxldlTttlml
6、因此，可以得到系统的总动能为：* MERGEFORMAT (14)1232 21112 2221112 233131cos4coscsMmTTxlxllllmxm 系统的总势能为：* MERGEFORMAT (15)12311212coscoscosVglglgll从而拉格朗日算子：* MERGEFORMAT (16)22211112 2221112 23313112cos34coscsosLTMxmlxmllllmxmglglgl csl由于因为在广义坐标 上均无外力作用，有以下等式成立：,* MERGEFORMAT (17)10dLt研究生课程实验报告二阶倒立摆实验5* MERGEFORM
7、AT (18)20dLt展开（17） ， （18）式，分别得到（19） ， （20）式* MERGEFORMAT (19)2121231221136sin()4()(cos()(sicos0mlmlmlgx * MERGEFORMAT (20)2112212123sii()6cs()3cs0gll x将（19） ， （20）式对 求解代数方程，得到以下两式,* MERGEFORMAT (21)112131221222121312122(sin4sisincos()in6co)()()4cco/(9sgmmgl lmxxxxl 22221231211222311221231112()(in6si
8、()cos)9cos(6s)3(in)/36()4cos()9mlglxl mgll * MERGEFORMAT (22)表示成以下形式：* MERGEFORMAT (23)11212(,fxx* MERGEFORMAT (24)2 )取平衡位置时各变量的初值为零，* MERGEFORMAT (25)1212(,)(0,)0Axx将（23）式在平衡位置进行泰勒级数展开，并线性化，令:研究生课程实验报告二阶倒立摆实验6* MERGEFORMAT (26)10AfKx* MERGEFORMAT (27)123120 13(4)2Agmgf l* MERGEFORMAT (28)123021319(
9、)AfKl* MERGEFORMAT (29)140Afx* MERGEFORMAT (30)150AfK* MERGEFORMAT (31)1602Af* MERGEFORMAT (32)123170 13(4)AmfKxl带入（21）式，得到线性化之后的公式* MERGEFORMAT (33)1213217Kx将（24）式在平衡位置进行泰勒级数展开，并线性化，令* MERGEFORMAT (34)210Afx* MERGEFORMAT (35)1232012 2()64(9AgmfKl l* MERGEFORMAT (36)1232302 2()3(Afl l* MERGEFORMAT (
10、37)240AfKx研究生课程实验报告二阶倒立摆实验7* MERGEFORMAT (38)2501AfK* MERGEFORMAT (39)260Af* MERGEFORMAT (40)1231232704()()49AmmfKxl l带入（22）式，得到* MERGEFORMAT (41)212327Kx即：* MERGEFORMAT (42)1213217* MERGEFORMAT (43)x现在得到了两个线性微分方程，由于我们采用加速度作为输入，因此还需加上一个方程* MERGEFORMAT (44)u取状态变量如下：* MERGEFORMAT (45)12345162xx由（33） ，
11、 （41） ， （42）式得到状态空间方程如下：研究生课程实验报告二阶倒立摆实验8* MERGEFORMAT (46)1 12 23 34 451235176 6200000xxuxKxK其中直线两级倒立摆系统参数为：小车质量 2.32kgM摆杆 1 质量 0.04kg1m摆杆 2 质量 0.132kg2质量块质量 0.208kg3摆杆 1 与垂直向上方向的夹角1摆杆 2 与垂直向上方向的夹角2摆杆 1 到转动中心质心的距离 0.09m1l摆杆 1 到转动中心质心的距离 0.27m2作用在系统上的外力F由以上方程，将以下参数代入* MERGEFORMAT (47)12312.04.89.0.7
12、Mmgl求出各个 值：K研究生课程实验报告二阶倒立摆实验9* MERGEFORMAT (48)1223377.064-8.51-965.0.K得到状态矩阵为：A =0 0 0 1.0000 0 00 0 0 0 1.0000 00 0 0 0 0 1.00000 0 0 0 0 00 86.6907 -21.6172 0 0 00 -40.3112 39.4500 0 0 0B =0001.00006.6402-0.0877C =1 0 0 0 0 00 1 0 0 0 00 0 1 0 0 00 0 0 1 0 00 0 0 0 1 0研究生课程实验报告二阶倒立摆实验100 0 0 0 0
13、1D=0 0 0 0 0 02）根据建模结果仔细计算并寻找合适的理论控制器参数。设 R=1，Q=diag(200 300 300 0 0 0)，利用 matlab 提供的 lqr 函数，可求得：K =14.1421 103.1881-174.1691 15.2682 3.0199 -28.24513）进入 matlab command 窗口，键入仿真文件，进行仿真实验利用固高公司提供的 Simulink 方框图，输入控制参数 k，进行实物仿真，并通过调整 Q 的值来调整 k 的值，以达到控制系统的设计要求。通过调节参数请仔细观察思考控制器参数对系统瞬态响应和稳态响应的影响。找到几组合适的控制器
14、参数作为实际控制的参数。4）倒立摆系统实物调试具体步骤如下：将小车推到导轨的中央，并且使摆杆处于自由下垂的静止状态，给小车的驱动器的电源接通电源，进入 MATLAB 的SIUMLINK 中，调出实物仿真文件，填入设计的控制器参数(0,pi,pi)，编译，连接实物，双手将倒立摆竖直的缓慢的立起，倒立摆进入到与竖直方向夹角小于 10 度的范围内，控制器启动，观察控制器的控制效果。成功后，从新设计控制器，并使参考位置为设为(0,0,pi)，重复(0,pi,pi)试验过程。5）将保存的实验数据画出图形，分析实际控制效果与仿真曲线的区别。4. 实验数据和曲线实验一中，实验数据为：研究生课程实验报告二阶倒
15、立摆实验11Q=diag(200 300 300 0 0 0)K =14.1421 103.1881-174.1691 15.2682 3.0199 -28.2451实验仿真曲线为：图 2 参考位置为设为（0，pi，pi）仿真图实验实物曲线为：研究生课程实验报告二阶倒立摆实验12图 3 参考位置为设为（0，pi，pi）实验曲线实验二数据为：k =-14.1421 -55.3918 121.8639 -13.4838 -5.8227 20.6980Q=diag(200 300 100 0 0 0)实验二数据为：Q=diag(200 300 300 0 0 0)K =-14.1421 -56.21
16、17 124.5101 -13.6940 -5.8802 21.0735实验仿真曲线为：研究生课程实验报告二阶倒立摆实验13图 4 参考位置为设为（0，0，pi）仿真图实物仿真曲线为：研究生课程实验报告二阶倒立摆实验14图 5 参考位置为设为（0，0，pi）实验曲线5. 实验结果分析从仿真和实验曲线来看两个实验都达到了预期目标。两实验的仿真曲线都约在 2.5S 左右达到平衡位置，而实际结果来看，第一个实验在 12S 左右才达到平衡，第二个实验相对较好，摆杆在5S 左右达到平衡，但是小车位置确一直在滑动。设备实际运行结果没有仿真结果好，这说明模型与实际系统是存在差别的。6. 实验收获和新实验内容设想相比其他实验而言，这个实验有很多特别的地方：首先，本实验有一定的危险性，在手动立起来时小车带着二阶倒立摆快速的移动，容易伤人；因此实验时需要特别小心，同时也要注意队员之间的默契配合；其次，本实验为二阶摆，摆杆不能自己立起来，需要手动扶起来，在摆杆快到目标角度时，手需要特别的轻并且要稳，否则小车速度过高系统停止工作，导致实验失败。通过本实验，从新复习了 Matlab/Simulink 环境下的控制系统设计，了解了控制系统设计的过程，加深了线性系统理论知识的理解，体会了现代控制的魅力。
