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

摘要倒立摆系统是一个复杂的、高度非线性的、不稳定的高阶系统，是学习和研究现代控制理论最适宜的实验装置倒立摆的控制是控制理论应用的一个典型X例，一个稳定的倒立摆系统对于证实状态空间理论的实用性是非常有用的本文主要研究的是二级倒立摆的极点配置方法，首先用Lagrange方程建立了二级倒立摆的数学模型，然后对二级倒立摆系统的稳定性进展了分析和研究，并给出了系统能控能观性的判别基于现代控制理论中的极点配置理论，根据超调量和调整时间来配置极点，求出反应矩阵并利用Simulink对其进展仿真，得到二级倒立摆的变化曲线，实现了对闭环系统的稳定控制关键词：二级倒立摆；极点配置；Simulink目录 12 数学模型的建立和分析 12.1 数学建模的方法 12.2 二级倒立摆的结构和工作原理 22.3 拉格朗日运动方程 3 43 二级倒立摆系统性能分析 103.1 稳定性分析 103.2 能控性能观性分析 114 状态反应极点配置 124.1 二级倒立摆的最优极点配置1 124.2 二级倒立摆最优极点配置2 135. 二级倒立摆matlab仿真 155.1 Simulink搭建开环系统 155.2 开环系统Simulink仿真结果 155.3 Simulink搭建极点配置后的闭环系统 16 175.4.1 第一组极点配置仿真结果 175.4.2 第二组极点配置仿真结果 19 20 21附录一 221. 绪论倒立摆最初诞生于麻省理工学院，仅有一级摆杆，另一端铰接于可以在直线导轨上自由滑动的小车上。

后来在此根底上，人们又进展拓展，设计出了直线二级倒立摆、环型倒立摆、平面倒立摆、柔性连接倒立摆、多级倒立摆等实验设备在控制理论的开展过程中，为验证某一理论在实际应用中的可行性需要按其理论设计的控制器去控制一个典型对象来验证倒立摆系统作为一个实验装置，形象直观，结构简单，本钱低廉；作为一个控制对象，他又相当复杂，同时就其本身而言，是一个高阶次、不稳定、多变量、非线性、强耦合系统，只有采取行之有效的控制方法才能使之稳定，因此倒立摆装置被公认为是自动控制理论中的典型实验设备综合文献资料，倒立摆控制的方法主要有：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 拉格朗日运动方程拉格朗日提出了用能量的方法推导物理系统的数学模型，首先我们引入广义坐标，拉格朗日方程广义坐标：系统的广义坐标是描述系统运动必需的一组独立坐标，广义坐标数等同于系统自由度数如果系统的运动用n维广义坐标q1,q2,…qn来表示，我们可以把这n维广义坐标看成是n维空间的n位坐标系中的坐标对于任一系统可由n维空间中的一点来表征系统在n维空间中运动形成的假如干系统点连成一条曲线，此曲线表示系统点的轨迹拉格朗日方程：(2.1)式中，——拉格朗日算子，——系统的广义坐标，——系统的动能，——系统的势能拉格朗日方程由广义坐标和表示为:(2.2)式中，，——系统沿该广义坐标方向上的外力，在本系统中，设系统的三个广义坐标分别是。

在推导数学模型之前，我们需要几点必要的假设：1.上摆、下摆与小车均是刚体；2.皮带轮与传动带之间无相对滑动；传动皮带无伸长现象；3.小车运动时所受的摩擦力正比于小车的速度；4.小车的驱动力与直流放大器的输入成正比，且无滞后，忽略电机电枢绕组中的电感；5.下摆转动时所受到的摩擦力矩正比于下摆的转动速度；6.上摆运动时所受到的摩擦力矩正比于上摆对下摆的相对角速度；yxxFm1m3M图2.2 二级倒立摆运动分析示意图倒立摆系统参数如下：小车系统的等效质量M摆杆1 质量=0.04Kg 摆杆1 转动中心到杆质心距离摆杆2 质量m2=0.132Kg 摆杆2 转动中心到杆质心距离l2质量块质量F摆杆1 与垂直向上方向的夹角摆杆2 与垂直向上方向的夹角首先，计算系统的动能：(2.3)小车动能：(2.4)摆杆1动能：(2.5)式中，--摆杆1质心平东动能--摆杆1绕质心转动动能(2.6)(2.7)如此(2.8)摆杆2动能：(2.9)式中，--摆杆1质心平东动能--摆杆1绕质心转动动能(2.10)(2.11)(2.12)质量块动能：(2.13)因此，可以得到系统总动能： (2.14)系统的势能为：(2.15)至此得到拉格朗日算子：(2.16)由于因为在广义坐标上均无外力作用，有以下等式成立：(2.17)(2.18)展开(2.17)、(2.18)式，分别得到(2.19)、(2.20)式(2.19)(2.20)将(2.19)、(2.20)式对求解代数方程，得到以下两式 (2.21)(2.22)表示成以下形式：(2.23)(2.24)取平衡位置时各变量的初值为零，(2.25)将(2.23)式在平衡位置进展泰勒级数展开，并线性化，令(2.26)(2.27) (2.28)(2.29)(2.30)(2.31) (2.32)得到线性化之后的公式(2.33)将在平衡位置进展泰勒级数展开，并线性化，令(2.34)(2.35)(2.36)(2.37)(2.38)(2.39)(2.40)得到(2.41)即: (2.42)(2.43)现在得到了两个线性微分方程，由于我们采用加速度作为输入，因此还需加上一个方程:(2.44)取状态变量如下：(2.45)如此状态空间方程如下：(2.46)将以下参数代入 求出各个值：得到状态方程各个参数矩阵：3 二级倒立摆系统性能分析3.1 稳定性分析二级倒立摆的特征方程为: (3.1)Matlab中，用函数eig(A)来计算系统矩阵的特征值，经过计算，系统的特征值为： (3.2)开环系统有两个开环极点位于平面右半平面上，所以系统是不稳定的。

同时，根据前面的状态空间表达式，在matlab中，用step(A,B,C,D)函数对系统的阶跃响应进展分析：图1 开环系统单位阶跃响应从上图可以看出，在阶跃响应的作用下，系统是发散的3.2 能控性能观性分析对于线形状态方程 (3.3)其能控性矩阵为：(3.4)求的秩(3.5)所以系统是完全能控的其能观性矩阵为：(3.6)求的秩(3.7)所以系统是完全能观的〔代码见附录〕由上述计算结果可知，二级倒立摆系统是开环不稳定系统，但它的状态是完全能控且完全能观测的因此，可以对其实现闭环最优控制4 状态反应极点配置4.1 二级倒立摆的最优极点配置1在式3.3中，A为6*6阵；B为6*1阵；C为3*6阵是一个单输入系统，且完全能控、能观测因此，可按照最优控制系统的极点配置方法进展设计对于一般控制系统，闭环主导极点的选取应使但二级倒立摆是一个特殊的高阶系统，稳定性是主要矛盾，因此可适当增加，即适当降低响应速度，来弥补系统稳定性要求相应在选择性能指标时，应适当减小系统的超调量对于二阶倒立摆系统，主要针对如下两个主要的性能指标进展设计：超调量：调节时间：(4.1) (4.2)这里，误差X围取为2%,将上述性能指标得到二级倒立摆系统的2个性能指标满足，，取，将得到的阻尼比与自然角频率代入下式：(4.3)得到二级倒立摆系统的2个主导极点为：,(4.4)对于其他四个非主导极点，不妨设为四重极点，且距主导极点10倍以上，即满足下式：(4.5)所以，另外四个非主导极点取为：到此，二级倒立摆的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 *至此，完成了二级倒立摆控制器的设计接下来在matlab中仿真得到：图2 极点配置后单位阶跃响应14.2 二级倒立摆最优极点配置2在上述根底上，继续调整超调量和调整时间，使二级倒立摆达到稳定第二次取：超调量：调节时间：，，取，将得到的阻尼比与自然角频率式4.3得到第二组主导极点：,(4.4)对于其他四个非主导极点，不妨设为四重极点，且距主导极点10倍以上，即满足下式：(4.5)所以，另外四个非主导极点取为：因此，第二组极点P2=[-1.73+1.81j -1.73-1.81j -30 -30 -30 -30]在matlab中输入K2=acker(A,B,P2)可求得:K2 = 1.0e+03 *接下来绘制极点配置后系统的单位阶跃响应图：图3极点配置后单位。