1、摘要倒立摆系统是一个复杂的、高度非线性的、不稳定的高阶系统，是学习和研究现代控制理论最合适的实验装置。倒立摆的控制是控制理论应用的一个典型范例，一个稳定的倒立摆系统对于证实状态空间理论的实用性是非常有用的。本文主要研究的是二级倒立摆的极点配置方法，首先用Lagrange方程建立了二级倒立摆的数学模型，然后对二级倒立摆系统的稳定性进行了分析和研究，并给出了系统能控能观性的判别。基于现代控制理论中的极点配置理论，根据超调量和调整时间来配置极点，求出反馈矩阵并利用Simulink对其进行仿真，得到二级倒立摆的变化曲线，实现了对闭环系统的稳定控制。关键词：二级倒立摆；极点配置；Simulink目录1.
2、绪论 12 数学模型的建立和分析 12.1 数学建模的方法 12.2 二级倒立摆的结构和工作原理 22.3 拉格朗日运动方程 32.4 推导建立数学模型 43 二级倒立摆系统性能分析 .103.1 稳定性分析 .103.2 能控性能观性分析 .114 状态反馈极点配置 .124.1 二级倒立摆的最优极点配置 1 .124.2 二级倒立摆最优极点配置 2 .135. 二级倒立摆 matlab 仿真 .155.1 Simulink 搭建开环系统 155.2 开环系统 Simulink 仿真结果 155.3 Simulink 搭建极点配置后的闭环系统 165.4 极点配置 Simulink 仿真结果
3、 175.4.1 第一组极点配置仿真结果 .175.4.2 第二组极点配置仿真结果 .196.结论 .207.参考文献 .21附录一 .2211. 绪论倒立摆最初诞生于麻省理工学院，仅有一级摆杆，另一端铰接于可以在直线导轨上自由滑动的小车上。后来在此基础上，人们又进行拓展，设计出了直线二级倒立摆、环型倒立摆、平面倒立摆、柔性连接倒立摆、多级倒立摆等实验设备。在控制理论的发展过程中，为验证某一理论在实际应用中的可行性需要按其理论设计的控制器去控制一个典型对象来验证。倒立摆系统作为一个实验装置，形象直观，结构简单，成本低廉；作为一个控制对象，他又相当复杂，同时就其本身而言，是一个高阶次、不稳定、多
4、变量、非线性、强耦合系统，只有采取行之有效的控制方法才能使之稳定，因此倒立摆装置被公认为是自动控制理论中的典型实验设备。综合文献资料，倒立摆控制的方法主要有：PID 控制，状态反馈，利用云模型，神经网络控制，遗传算法，自适应控制，模糊控制，变论域自适应模糊控制理论，智能控制等多种算法来实现倒立摆的控制。本文主要构建二级倒立摆的数学模型的建立与分析，对倒立摆系统进行控制方法的研究。本文就以下几个问题进行了论述。1.二级倒立摆的数学模型的建立与分析。在建模部分，首先采用拉格朗日方程推导数学模型，并对系统的可控性可观性进行分析，并分析倒立摆系统控制的难易程度。2.二级倒立摆的控制原理及方法的研究。本
5、文主要采用状态反馈极点配置的方法对二级倒立摆进行研究。3.采用 Matlab 语言进行数字仿真，分析仿真结果。2 数学模型的建立和分析2.1 数学建模的方法所谓系统的数学模型就是利用数学结构来反映系统内部之间、内部与外部某些因素之间的精确的定量的表示。它是分析、设计、预报和控制一个系统的2基础，所以要对一个系统进行研究，首先要建立它的数学模型。建立倒立摆系统的模型时，一般采用牛顿运动规律，结果要解算大量的微分方程组，而且考虑到质点组受到的约束条件，建模问题将更加复杂，为此本文采用分析力学方法中的 Lagrange 方程推导倒立摆的系统模型。Lagrange 方程有如下特点：1.它是以广义坐标表
6、达的任意完整系统的运动方程式，方程式的数目和系统的自由度是一致的。2.理想约束反力不出现在方程组中，因此在建立运动方程式时，只需分析已知的主动力，而不必分析未知的约束反力。3.Lagrange 方程是以能量观点建立起来的运动方程，为了列出系统的运动方程，只需要从两个方面去分析，一个是表征系统运动的动力学量系统的动能，另一个是表征主动力作用的动力学量广义力。因此用 Lagrange 方程来求解系统的动力学方程可以大大简化建模过程。2.2 二级倒立摆的结构和工作原理如图 2.1，系统包括计算机、运动控制卡、伺服机构、倒立摆本体（小车，上摆，下摆，皮带轮等）和光电码盘几大部分，组成了一个闭环系统。光
7、电码盘 1 将小车的位移、速度信号反馈给伺服驱动器和运动控制卡，下面一节摆杆（和小车相连）的角度、角速度信号由光电码盘 2 反馈回控制卡和伺服驱动器，上面一节摆杆的角度和角速度信号则由光电码盘 3 反馈。计算机从运动控制卡中读取实时数据，确定控制决策（小车向哪个方向移动、移动速度、加速度等） ，并由运动控制卡来实现该控制决策，产生相应的控制量，使电机转动，带动小车运动，保持两节摆杆的平衡。3图 2.1 系统结构和工作原理图2.3 拉格朗日运动方程拉格朗日提出了用能量的方法推导物理系统的数学模型，首先我们引入广义坐标，拉格朗日方程。广义坐标：系统的广义坐标是描述系统运动必需的一组独立坐标，广义坐
8、标数等同于系统自由度数。如果系统的运动用 n 维广义坐标 q1,q2,qn来表示，我们可以把这 n 维广义坐标看成是 n 维空间的 n 位坐标系中的坐标。对于任一系统可由 n 维空间中的一点来表征。系统在 n 维空间中运动形成的若干系统点连成一条曲线，此曲线表示系统点的轨迹。拉格朗日方程：(2.1)(,)=(,)(,)式中， 拉格朗日算子，L 系统的广义坐标，q 系统的动能，T 系统的势能。V拉格朗日方程由广义坐标 和 表示为:iqL=(2.2)4式中， ， 系统沿该广义坐标方向上的外力，在本系统中，设ni3,21if系统的三个广义坐标分别是 。 21,x2.4 推导建立数学模型在推导数学模型
9、之前，我们需要几点必要的假设：1.上摆、下摆及小车均是刚体；2.皮带轮与传动带之间无相对滑动；传动皮带无伸长现象；3.小车运动时所受的摩擦力正比于小车的速度；4.小车的驱动力与直流放大器的输入成正比，且无滞后，忽略电机电枢绕组中的电感；5.下摆转动时所受到的摩擦力矩正比于下摆的转动速度；6.上摆运动时所受到的摩擦力矩正比于上摆对下摆的相对角速度；二级倒立摆的运动分析示意图如图 2.2 1yxxFm1m322M图 2.2 二级倒立摆运动分析示意图倒立摆系统参数如下：小车系统的等效质量 M=1.32Kg摆杆 1 质量 =0.04Kg 摆杆 1 转动中心到杆质心距离 =0.09m1m 1l摆杆 2
10、质量 m2=0.132Kg 摆杆 2 转动中心到杆质心距离 l2=0.27m质量块质量 =0.208Kg 作用在系统上的外力 F35摆杆 1 与垂直向上方向的夹角 摆杆 2 与垂直向上方向的夹角12首先，计算系统的动能：(2.3)321mmMTT小车动能：MT(2.4)=122摆杆 1 动能：m(2.5)11mmT式中， -摆杆 1 质心平东动能1-摆杆 1 绕质心转动动能122 111(sin)(cos)2mdxldlTtt 2 21111cosxlml(2.6)(2.7)2121211 63lmlmJTpm 则(2.8)2111211 3coslxlmm 摆杆 2 动能：T(2.9)22m
11、mT式中， -摆杆 1 质心平东动能2-摆杆 1 绕质心转动动能2 2 2 122(2sini(cos)mdxlldllTt t(2.10)2 221212cosinsillmll(2.11)2222 613llmJTm22121cossxll(2.12) 1212212co434lll6质量块动能：3mT22113(sin)(cos)12mdxldltt (2.13)2331131coslml因此，可以得到系统总动能： 123MmTT222111cosxlxl2212ll 1212212 cos434lllm(2.14)1311slmxl系统的势能为： 123mV(2.15)11312cos
12、2coscosmglglgll至此得到拉格朗日算子 ：LTV22 21111cos3Mxmlxl2212ll 1212212cos434lll 11131123 scos1 glmlxlm(2.16)22coslgg由于因为在广义坐标 上均无外力作用，有以下等式成立：1,(2.17)01Ldt7(2.18)02Ldt展开(2.17)、(2.18)式，分别得到(2.19)、(2.20)式 )cos(2(3)(34)sin(6 121321212 lmlmlm(2.19)0cossin)xg(2.20)211212123sisi(6()csgll x将(2.19)、(2.20)式对 求解代数方程，
13、得到以下两式, 2122131211 sin)co(sin4sin4sin2( gmgm 2)()()co6 xll /cscscoss 211312xxx(2.21)(94( 2221 l )cos3)sin6si()9 22111322 xlglm /i(2)sin6)(cos3 1132211 gmllm (2.22)cos439( 21211322 ll表示成以下形式：(2.23),(21211 xxf(2.24)2取平衡位置时各变量的初值为零，(2.25)1212(,)(0,)0Axx将(2.23)式在平衡位置进行泰勒级数展开，并线性化，令(2.26)10AfKx(2.27)1231
14、20 13(4)2gmgf l(2.28)123021319()Af l8(2.29)140AfKx(2.30)150f(2.31)1602Af(2.32)123170 13(4)mfKxl得到线性化之后的公式(2.33)xK172312将 在平衡位置进行泰勒级数展开，并线性化，令),(21212xxf(2.34)210Af(2.35)1232012 2()64(9AgmfKl l(2.36)1232302 2()3(Afl l(2.37)40AfKx(2.38)2501f(2.39)260Af(2.40)1231232704()()49AmmfKxl l得到(2.41)xK27312即: (
15、2.42)1723129(2.43)xK27312现在得到了两个线性微分方程，由于我们采用加速度作为输入，因此还需加上一个方程:(2.44)xu取状态变量如下：(2.45)26154231xx则状态空间方程如下：(2.46)uKxxKxx 271654321231654321 00000将以下参数代入 27.0981.4132lgmM求出各个 值：K12317.64-95.02327-8.5160.K得到状态方程各个参数矩阵：1000107.6421.9703858A 0728.15B1C3 二级倒立摆系统性能分析3.1 稳定性分析二级倒立摆的特征方程为: (3.1)det()0IAMatla
16、b 中，用函数 eig(A)来计算系统矩阵的特征值，经过计算，系统的特征值为：(3.2) 9.5724.9.5724.50开环系统有两个开环极点位于 平面右半平面上，所以系统是不稳定的。S同时，根据前面的状态空间表达式，在 matlab 中，用 step(A,B,C,D)函数对系统的阶跃响应进行分析：110102030To:Out(1)024x 1027To:Out(2)0 1 2 3 4 5 6 7-4-20x 1027To:Out(3)Step ResponseTime (seconds)Amplitude图 1 开环系统单位阶跃响应从上图可以看出，在阶跃响应的作用下，系统是发散的。3.2
17、 能控性能观性分析对于线形状态方程(3.3)XABUYC其能控性矩阵为：(3.4)23450,T求 的秩0T(3.5)0()6rankT所以系统是完全能控的。其能观性矩阵为：(3.6)0=,2,3,4,512求 的秩0C(3.7)0rank()=6C所以系统是完全能观的。 （代码见附录）由上述计算结果可知，二级倒立摆系统是开环不稳定系统，但它的状态是完全能控且完全能观测的。因此，可以对其实现闭环最优控制。4 状态反馈极点配置4.1 二级倒立摆的最优极点配置 1在式 3.3 中，A 为 6*6 阵；B 为 6*1 阵；C 为 3*6 阵。是一个单输入系统，且完全能控、能观测。因此，可按照最优控制
18、系统的极点配置方法进行设计。对于一般控制系统，闭环主导极点的选取应使 。但二级倒立摆0.40.8是一个特殊的高阶系统，稳定性是主要矛盾，因此可适当增加 ，即适当降低响应速度，来弥补系统稳定性要求。相应在选择性能指标时，应适当减小系统的超调量。对于二阶倒立摆系统，主要针对如下两个主要的性能指标进行设计：超调量： 0.005调节时间： 2.5(4.1)=12(4.2)=412这里，误差范围取为 2%,将上述性能指标代入式 4.1 和式 4.2 得到二级倒立摆系统的 2 个性能指标满足 ， ，取 ，0.8262.17=0.826=2.17将得到的阻尼比与自然角频率代入下式：(4.3)1,2=12得到
19、二级倒立摆系统的 2 个主导极点为：, (4.4)1=1.87+1.11 2=1.871.11对于其他四个非主导极点，不妨设为四重极点，且距主导极点 10 倍以上，即满足下式：(4.5)|3|=|4|=|5|=|6|102.17=21.713所以，另外四个非主导极点取为： 3=4=5=6=22到此，二级倒立摆的 6 个极点都已确定。P=-1.87+1.11j -1.87-1.11j -22 -22 -22 -22 （4.6）在 matlab 中输入 K=acker(A,B,P)可求得:K =1.0e+03 *0.5281 0.4618 -2.6379 0.5136 -0.0797 -0.447
20、6至此，完成了二级倒立摆控制器的设计。接下来在 matlab 中仿真得到：-1012 x 10-3To:Out(1)-202 x 10-3To:Out(2)0 0.5 1 1.5 2 2.5 3 3.5 4-505 x 10-4To:Out(3)Step ResponseTime (seconds)Amplitude图 2 极点配置后单位阶跃响应 14.2 二级倒立摆最优极点配置 2在上述基础上，继续调整超调量和调整时间，使二级倒立摆达到稳定。第二次取：14超调量： 0.05调节时间： 2.5这里，误差范围仍取为 2%,代入式 4.1 和式 4.2 得到二级倒立摆系统的 2 个性能指标满足 ，
21、 ，取 ，0.692.51=0.69=2.51将得到的阻尼比与自然角频率式 4.3 得到第二组主导极点：, (4.4)1=1.73+1.81 2=1.731.81对于其他四个非主导极点，不妨设为四重极点，且距主导极点 10 倍以上，即满足下式：(4.5)|3|=|4|=|5|=|6|122.5=30所以，另外四个非主导极点取为： 3=4=5=6=30因此，第二组极点 P2=-1.73+1.81j -1.73-1.81j -30 -30 -30 -30在 matlab 中输入 K2=acker(A,B,P2)可求得:K2 =1.0e+03 *2.4205 0.5209 -7.4977 1.658
22、7 -0.2846 -1.2008接下来绘制极点配置后系统的单位阶跃响应图：15-505 x 10-4To:Out(1)-101 x 10-3To:Out(2)0 0.5 1 1.5 2 2.5 3 3.5 4 4.5-202x 10-4To:Out(3)Step ResponseTime (seconds)Amplitude图 3 极点配置后单位阶跃响应 2165. 二级倒立摆 matlab 仿真5.1 Simulink 搭建开环系统图 4 开环系统仿真图5.2 开环系统 Simulink 仿真结果17图 5 开环系统 matlab 仿真结果图由上图可知，在 Simulink 中搭建的开环系
23、统是发散的，与理论计算的结果吻合。5.3 Simulink 搭建极点配置后的闭环系统图 6 极点配置优化后的系统结构图185.4 极点配置 Simulink 仿真结果5.4.1 第一组极点配置仿真结果图 7 极点配置优化后的结果图图 8 小车位移曲线19图 9 一级倒立摆角度曲线图 10 二级倒立摆角度曲线从以上的图片可以看出，系统在给定输入的情况下，1 秒左右恢复到平衡点的位置附近，系统较好的快速性、稳定性和精确性都非常理想，且无超调量，符合要求。205.4.2 第二组极点配置仿真结果图 11 极点配置优化后的结果图图 12 小车位移曲线21图 13 一级倒立摆角度曲线图 14 二级倒立摆角
24、度曲线与第一组极点相比，超调量略有增加，但调整时间有所下降，且都达到稳定状态符合要求。6.结论倒立摆系统就其本身而言，是一个多变量、快速、严重非线性和绝对不稳定系统，必需采用有效的控制法使之稳定，对倒立摆系统的研究在理论上和方22法论上均有着深远的意义。本文借助拉格朗日方程，建立了二级倒立摆的数学模型，并通过线性化，得到了二级倒立摆系统的状态空间模型。应用现代控制理论，分析了倒立摆的稳定性、能控性、能观性。随后采用二次型最优控制理论研究了倒立摆控制问题,并且运用状态反馈极点配置的方法得到较好的控制效果。最后进行了 Matlab仿真，通过优化前后优化后的响应曲线可以看出经过极点配置算法优化后的系
25、统响应的速度加快，超调量明显减少，稳定时间和上升时间有所减少，系统的动态性能和静态性能要比没有优化的控制效果好了很多。7.参考文献1刘豹 唐万生 现代控制理论（第三版） 机械工业出版社2夏德钤 翁贻方 自动控制理论（第 4 版） 机械工业出版社3李国勇 程永强 计算机仿真技术与 CAD基于 matlab 的控制系统（第三版） 电子工业出版社4 基于 LQR 的二级倒立摆控制系统研究 本科毕业论文5汤唯 基于直线二级倒立摆控制系统的研究 硕士学位论文6基于极点配置的倒立摆控制器设计 硕士学位论文23附录一%-阶跃响应下系统的稳定性-A=0 0 0 1 0 0;0 0 0 0 1 0;0 0 0
26、0 0 1;0 0 0 0 0 0;0 77.0642 -21.1927 0 0 0;0 -38.5321 37.8186 0 0 0;B=0;0;0;1;5.7012;-0.0728;C=1 0 0 0 0 0;0 1 0 0 0 0;0 0 1 0 0 0;D=0;0;0;step(A,B,C,D) %绘制阶跃响应%-能控能观性判断-A=0 0 0 1 0 0;0 0 0 0 1 0;0 0 0 0 0 1;0 0 0 0 0 0;0 77.0642 -21.1927 0 0 0;0 -38.5321 37.8186 0 0 0;B=0;0;0;1;5.7012;-0.0728;C=1 0
27、 0 0 0 0;0 1 0 0 0 0;0 0 1 0 0 0;D=0;0;0;Uc=ctrb(A,B) %求能控矩阵rank(Uc) %求能控阵的秩Vo=obsv(A,C) %求能观矩阵rank(Vo) %求能观矩阵的秩%-极点配置 1-A=0 0 0 1 0 0;0 0 0 0 1 0;0 0 0 0 0 1;0 0 0 0 0 0;0 77.0642 -21.1927 0 0 0;0 -38.5321 37.8186 0 0 0;B=0;0;0;1;5.7012;-0.0728;C=1 0 0 0 0 0;0 1 0 0 0 0;0 0 1 0 0 0;24P=-1.87+1.11i
28、-1.87-1.11i -22 -22 -22 -22; %K=acker(A,B,P); %就反馈矩阵A1= A1=A-B*K;step(A1,B,C,D)%-极点配置 2-A=0 0 0 1 0 0;0 0 0 0 1 0;0 0 0 0 0 1;0 0 0 0 0 0;0 77.0642 -21.1927 0 0 0;0 -38.5321 37.8186 0 0 0;B=0;0;0;1;5.7012;-0.0728;C=1 0 0 0 0 0;0 1 0 0 0 0;0 0 1 0 0 0;D=0;P2=-1.73+1.81i -1.73-1.81i -30 -30 -30 -30; %K2=acker(A,B,P2) %求反馈矩阵A2=A-B*K2;step(A2,B,C,D)
