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

摘要倒立摆系统是一个复杂的、高度非线性的、不稳定的高阶系统，是学习和研究现代控制理论最合适的实验装置。

倒立摆的控制是控制理论应用的一个典型范例，一个稳定的倒立摆系统对于证实状态空间理论的实用性是非常有用的。

本文主要研究的是二级倒立摆的极点配置方法，首先用Lagrange方程建立了二级倒立摆的数学模型，然后对二级倒立摆系统的稳定性进行了分析和研究，并给出了系统能控能观性的判别。

基于现代控制理论中的极点配置理论，根据超调量和调整时间来配置极点，求出反馈矩阵并利用Simulink对其进行仿真，得到二级倒立摆的变化曲线，实现了对闭环系统的稳定控制。

关键词：二级倒立摆；极点配置；Simulink目录1.绪论..............................................................2 数学模型的建立和分析..............................................2.1 数学建模的方法..................................................2.2 二级倒立摆的结构和工作原理......................................2.3 拉格朗日运动方程................................................2.4推导建立数学模型.................................................3 二级倒立摆系统性能分析............................................3.1 稳定性分析....................................................3.2 能控性能观性分析..............................................4 状态反馈极点配置..................................................4.1 二级倒立摆的最优极点配置1.....................................4.2 二级倒立摆最优极点配置2.........................................5. 二级倒立摆matlab仿真............................................5.1 Simulink搭建开环系统............................................5.2 开环系统Simulink仿真结果.......................................5.3 Simulink搭建极点配置后的闭环系统................................5.4极点配置Simulink仿真结果........................................5.4.1 第一组极点配置仿真结果........................................5.4.2 第二组极点配置仿真结果........................................6.结论..............................................................7.参考文献..........................................................附录一..............................................................1.绪论倒立摆最初诞生于麻省理工学院，仅有一级摆杆，另一端铰接于可以在直线导轨上自由滑动的小车上。

后来在此基础上，人们又进行拓展，设计出了直线二级倒立摆、环型倒立摆、平面倒立摆、柔性连接倒立摆、多级倒立摆等实验设备。

在控制理论的发展过程中，为验证某一理论在实际应用中的可行性需要按其理论设计的控制器去控制一个典型对象来验证。

倒立摆系统作为一个实验装置，形象直观，结构简单，成本低廉；作为一个控制对象，他又相当复杂，同时就其本身而言，是一个高阶次、不稳定、多变量、非线性、强耦合系统，只有采取行之有效的控制方法才能使之稳定，因此倒立摆装置被公认为是自动控制理论中的典型实验设备。

综合文献资料，倒立摆控制的方法主要有：PID控制，状态反馈，利用云模型，神经网络控制，遗传算法，自适应控制，模糊控制，变论域自适应模糊控制理论，智能控制等多种算法来实现倒立摆的控制。

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

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

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

在建模部分，首先采用拉格朗日方程推导数学模型，并对系统的可控性可观性进行分析，并分析倒立摆系统控制的难易程度。

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

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

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

2 数学模型的建立和分析2.1 数学建模的方法所谓系统的数学模型就是利用数学结构来反映系统内部之间、内部与外部某些因素之间的精确的定量的表示。

它是分析、设计、预报和控制一个系统的基础，所以要对一个系统进行研究，首先要建立它的数学模型。

建立倒立摆系统的模型时，一般采用牛顿运动规律，结果要解算大量的微分方程组，而且考虑到质点组受到的约束条件，建模问题将更加复杂，为此本文采用分析力学方法中的Lagrange方程推导倒立摆的系统模型。

Lagrange方程有如下特点：1.它是以广义坐标表达的任意完整系统的运动方程式，方程式的数目和系统的自由度是一致的。

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

grange方程是以能量观点建立起来的运动方程，为了列出系统的运动方程，只需要从两个方面去分析，一个是表征系统运动的动力学量－系统的动能，另一个是表征主动力作用的动力学量－广义力。

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

2.2 二级倒立摆的结构和工作原理如图2.1，系统包括计算机、运动控制卡、伺服机构、倒立摆本体（小车，上摆，下摆，皮带轮等）和光电码盘几大部分，组成了一个闭环系统。

光电码盘1将小车的位移、速度信号反馈给伺服驱动器和运动控制卡，下面一节摆杆（和小车相连）的角度、角速度信号由光电码盘2反馈回控制卡和伺服驱动器，上面一节摆杆的角度和角速度信号则由光电码盘3反馈。

计算机从运动控制卡中读取实时数据，确定控制决策（小车向哪个方向移动、移动速度、加速度等），并由运动控制卡来实现该控制决策，产生相应的控制量，使电机转动，带动小车运动，保持两节摆杆的平衡。

图2.1 系统结构和工作原理图2.3 拉格朗日运动方程拉格朗日提出了用能量的方法推导物理系统的数学模型，首先我们引入广义坐标，拉格朗日方程。

广义坐标：系统的广义坐标是描述系统运动必需的一组独立坐标，广义坐标数等同于系统自由度数。

如果系统的运动用n维广义坐标q1,q2,…q n来表示，我们可以把这n维广义坐标看成是n维空间的n位坐标系中的坐标。

对于任一系统可由n维空间中的一点来表征。

系统在n维空间中运动形成的若干系统点连成一条曲线，此曲线表示系统点的轨迹。

拉格朗日方程：L(q,q̇)=T(q,q̇)−V(q,q̇)(2.1) 式中，L——拉格朗日算子，q——系统的广义坐标，T——系统的动能，V——系统的势能。

拉格朗日方程由广义坐标i q和L表示为:d dt ?L ?q i −?L?q i=f i (2.2)式中，n i 3,2,1=，i f ——系统沿该广义坐标方向上的外力，在本系统中，设系统的三个广义坐标分别是21,,θθx 。

2.4推导建立数学模型在推导数学模型之前，我们需要几点必要的假设： 1.上摆、下摆及小车均是刚体；2.皮带轮与传动带之间无相对滑动；传动皮带无伸长现象；3.小车运动时所受的摩擦力正比于小车的速度；4.小车的驱动力与直流放大器的输入成正比，且无滞后，忽略电机电枢绕组中的电感；5.下摆转动时所受到的摩擦力矩正比于下摆的转动速度；6.上摆运动时所受到的摩擦力矩正比于上摆对下摆的相对角速度； 二级倒立摆的运动分析示意图如图2.2图2.2 二级倒立摆运动分析示意图倒立摆系统参数如下： 小车系统的等效质量M =1.32Kg 摆杆1 质量1m =0.04Kg 摆杆1 转动中心到杆质心距离1l =0.09m 摆杆2 质量m 2=0.132Kg摆杆2 转动中心到杆质心距离l 2=0.27m质量块质量3m =0.208Kg 作用在系统上的外力F摆杆1 与垂直向上方向的夹角1θ 摆杆2 与垂直向上方向的夹角2θ首先，计算系统的动能：321m m m M T T T T T +++=(2.3)M T 小车动能：T M =12Mẋ2(2.4)1m T 摆杆1动能：111m m m T T T ''+'=(2.5)式中，T m1′--摆杆1质心平东动能T m1′′--摆杆1绕质心转动动能22'111111(sin )(cos )12m d x l d l T m dt dt θθ⎛⎫-⎛⎫⎛⎫=+= ⎪ ⎪ ⎪ ⎪⎝⎭⎝⎭⎝⎭2221111111111cos 22m x m l x m l θθθ-+(2.6) 212112121121''161312121θθω l m l m J T p m =⎪⎪⎭⎫ ⎝⎛==(2.7)则21211111121''1'1132cos 21θθθ l m x l m x m T T T m m m +-=+= (2.8)2m T 摆杆2动能：222m mm T T T ''+'= (2.9)式中，T m2′--摆杆1质心平东动能T m2′′--摆杆1绕质心转动动能()()22211122*********12cos cos 2sin sin 22m x l l m l l θθθθθθθθ=--++(2.10) 2222222222222''261312121θωω l m l m J T m =⎪⎭⎫ ⎝⎛==(2.11)()⎪⎭⎫ ⎝⎛-+++122121222221212cos 434421θθθθθθ l l l l m(2.12)3m T 质量块动能：2223311131112cos 22m x m l x m l θθθ=-+ (2.13) 因此，可以得到系统总动能：212131113232cos 221θθθ l m x l m x m +-+ (2.14)系统的势能为：()11131121122cos 2cos 2cos cos m gl m gl m g l l θθθθ=+++(2.15)至此得到拉格朗日算子L ：()22112113cos cos 2cos 2θθθl l g m gl m +--(2.16)由于因为在广义坐标21,θθ上均无外力作用，有以下等式成立：011=∂∂-⎪⎪⎭⎫ ⎝⎛∂∂θθL L dt d (2.17)022=∂∂-⎪⎪⎭⎫ ⎝⎛∂∂θθL L dt d (2.18)展开(2.17)、(2.18)式，分别得到(2.19)、(2.20)式 0))cos sin ))((2(11321=++++θθxg m m m (2.19)22111222112123sin 6sin()46cos()3cos 0g l l l x θθθθθθθθθ---++--= (2.20)将(2.19)、(2.20)式对21,θθ 求解代数方程，得到以下两式 )))(cos 912124(2(21223211θθ-+---m m m m l(2.21)))(cos 4))(3(916(21222212222213212θθ-+++-l l m l l m m m m (2.22) 表示成以下形式： ),,,,,,(212111x x x f θθθθθ= (2.23)),,,,,,(212122x x x f θθθθθ=(2.24)取平衡位置时各变量的初值为零，1212(,,,,,,)(0,0,0,0,0,0,0)0A x x x θθθθ===(2.25)将(2.23)式在平衡位置进行泰勒级数展开，并线性化，令11100A f K x=∂==∂(2.26)1231120112313(244)2(4312)A gm gm gm f K m m m l θ=---∂==∂---(2.27)121302123192(4312)A f m gK m m m l θ=∂==∂---(2.28) 11400A f K x=∂==∂(2.29)115010A f K θ=∂==∂ (2.30)116020A f K θ=∂==∂(2.31)123117012313(24)2(4312)A m m m f K xm m m l =---∂==∂---(2.32)得到线性化之后的公式x K K K 172131121++=θθθ(2.33)将),,,,,,(212122x x x f θθθθθ=在平衡位置进行泰勒级数展开，并线性化，令22100A f K x=∂==∂(2.34)123222012212322(2())164(3())9A g m m m f K m l m m m l θ=++∂==∂-++ (2.35)123223022212324(3())163(4(3()))9A g m m m f K m l m m m l θ=++∂==-∂-++ (2.36) 22400A f K x=∂==∂(2.37)225010A f K θ=∂==∂ (2.38)226020A f K θ=∂==∂(2.39)123123227022123242(2())(3()3164(3())9A m m m m m m f K xm l m m m l =++-++∂==∂-++ (2.40)得到x K K K 272231222++=θθθ(2.41)即:x K K K 172131121++=θθθ (2.42)x K K K 272231222++=θθθ(2.43)现在得到了两个线性微分方程，由于我们采用加速度作为输入，因此还需加上一个方程:xu = (2.44)取状态变量如下：⎪⎪⎪⎪⎩⎪⎪⎪⎪⎨⎧======2615423121θθθθ x x x x x x x x (2.45)则状态空间方程如下：u K K x x x x x x K K K K x x x x x x⎥⎥⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎢⎢⎣⎡+⎥⎥⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎢⎢⎣⎡⎥⎥⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎢⎢⎣⎡=⎥⎥⎥⎥⎥⎥⎥⎥⎦⎤⎢⎢⎢⎢⎢⎢⎢⎢⎣⎡271765432123221312654321100000000000000000100000010000001000(2.46)将以下参数代入 ⎪⎪⎪⎪⎩⎪⎪⎪⎪⎨⎧=======27.009.08.9208.0132.004.032.121321l l g m m m M 求出各个K 值：得到状态方程各个参数矩阵： 3 二级倒立摆系统性能分析 3.1 稳定性分析二级倒立摆的特征方程为:det()0I A λ-= (3.1)Matlab 中，用函数eig(A )来计算系统矩阵的特征值，经过计算，系统的特征值为：[]9.5972 4.77259.5972 4.772500λ=-- (3.2) 开环系统有两个开环极点位于S 平面右半平面上，所以系统是不稳定的。