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

《现代控制理论-大作业-倒立摆.docx》由会员分享，可在线阅读，更多相关《现代控制理论-大作业-倒立摆.docx（27页珍藏版）》请在第一文库网上搜索。

1、摘要倒立摆系统是一个复杂的、高度非线性的、不稳定的高阶系统，是学习和研究现代控制理论最合适的实验装置。倒立摆的控制是控制理论应用的一个典型范例，一个稳定的倒立摆系统对于证实状态空间理论的实用性是非常有用的。本文主要研究的是二级倒立摆的极点配置方法，首先用1agrange方程建立了二级倒立摆的数学模型，然后对二级倒立摆系统的稳定性进行了分析和研究，并给出了系统能控能观性的判别。基于现代控制理论中的极点配置理论，根据超调量和调整时间来配置极点，求出反馈矩阵并利用SimUIink对其进行仿真，得到二级倒立摆的变化曲线，实现了对闭环系统的稳定控制。关键词：二级倒立摆；极点配置；Simu1ink目录1,

2、绪论32数学模型的建立和分析31.1 数学建模的方法31.2 2二级倒立摆的结构和工作原理41.3 拉格朗日运动方程41.4 推导建立数学模型53二级倒立摆系统性能分析111.5 稳定性分析113. 2能控性能观性分析124状态反馈极点配置133.1 二级倒立摆的最优极点配置1134. 2二级倒立摆最优极点配置2145. 二级彳到立摆matIab仿真165.1SimU1ink搭建开环系统165.2开环系统SimUIink仿真结果165.3SimUIink搭建极点配置后的闭环系统175.4极点配置Simu1ink仿真结果185.4.1第一组极点配置仿真结果185.4.2第二组极点配置仿真结果20

3、6 .结论217 .参考文献22附录一231.绪论倒立摆最初诞生于麻省理工学院，仅有一级摆杆，另一端钱接于可以在直线导轨上自由滑动的小车上。后来在此基础上，人们又进行拓展，设计出了直线二级倒立摆、环型倒立摆、平面倒立摆、柔性连接倒立摆、多级倒立摆等实验设备。在控制理论的发展过程中，为验证某一理论在实际应用中的可行性需要按其理论设计的控制器去控制一个典型对象来验证。倒立摆系统作为一个实验装置，形象直观，结构简单，成本低廉;作为一个控制对象，他又相当复杂，同时就其本身而言，是一个高阶次、不稳定、多变量、非线性、强耦合系统，只有采取行之有效的控制方法才能使之稳定，因此倒立摆装置被公认为是自动控制理论

4、中的典型实验设备。综合文献资料，倒立摆控制的方法主要有：PID控制，状态反馈，利用云模型，神经网络控制，遗传算法，自适应控制，模糊控制，变论域自适应模糊控制理论，智能控制等多种算法来实现倒立摆的控制。本文主要构建二级倒立摆的数学模型的建立与分析，对倒立摆系统进行控制方法的研究。本文就以下几个问题进行了论述。1 .二级倒立摆的数学模型的建立与分析。在建模部分，首先采用拉格朗日方程推导数学模型，并对系统的可控性可观性进行分析，并分析倒立摆系统控制的难易程度。2 .二级倒立摆的控制原理及方法的研究。本文主要采用状态反馈极点配置的方法对二级倒立摆进行研究。3 .采用Mat1ab语言进行数字仿真，分析仿

5、真结果。2数学模型的建立和分析2.1数学建模的方法所谓系统的数学模型就是利用数学结构来反映系统内部之间、内部与外部某些因素之间的精确的定量的表示。它是分析、设计、预报和控制一个系统的基础，所以要对一个系统进行研究，首先要建立它的数学模型。建立倒立摆系统的模型时，一般采用牛顿运动规律，结果要解算大量的微分方程组，而且考虑到质点组受到的约束条件，建模问题将更加复杂，为此本文采用分析力学方法中的1agrange方程推导倒立摆的系统模型。1agrange方程有如下特点：-完整版学习资料分享-1 .它是以广义坐标表达的任意完整系统的运动方程式，方程式的数目和系统的自由度是一致的。2 .理想约束反力不出现

6、在方程组中，因此在建立运动方程式时，只需分析已知的主动力，而不必分析未知的约束反力。3 .1agrange方程是以能量观点建立起来的运动方程，为了列出系统的运动方程，只需要从两个方面去分析，一个是表征系统运动的动力学量一系统的动能，另一个是表征主动力作用的动力学量一广义力。因此用1agrange方程来求解系统的动力学方程可以大大简化建模过程。2.2 二级倒立摆的结构和工作原理如图2.1,系统包括计算机、运动控制卡、伺服机构、倒立摆本体（小车，上摆，下摆，皮带轮等）和光电码盘几大部分，组成了一个闭环系统。光电码盘1将小车的位移、速度信号反馈给伺服驱动器和运动控制卡，下面一节摆杆（和小车相连）的角

7、度、角速度信号由光电码盘2反馈回控制卡和伺服驱动器，上面一节摆杆的角度和角速度信号则由光电码盘3反馈。计算机从运动控制卡中读取实时数据，确定控制决策（小车向哪个方向移动、移动速度、加速度等），并由运动控制卡来实现该控制决策，产生相应的控制量，使电机转动，带动小车运动，保持两节摆杆的平衡。图2.1系统结构和工作原理图2.3 拉格朗日运动方程拉格朗日提出了用能量的方法推导物理系统的数学模型，首先我们引入广义坐-完整版学习资料分享-标，拉格朗日方程。广义坐标：系统的广义坐标是描述系统运动必需的一组独立坐标，广义坐标数等同于系统自由度数。如果系统的运动用力维广义坐标3,在4来表示，我们可以把这刀维广义

8、坐标看成是力维空间的刀位坐标系中的坐标。对于任一系统可由力维空间中的一点来表征。系统在力维空间中运动形成的若干系统点连成一条曲线，此曲线表示系统点的轨迹。拉格朗日方程：(2.1)式中，1拉格朗日算子，q系统的广义坐标，T系统的动能，V系统的势能。拉格朗日方程由广义坐标qi和1表示为：(2.2)式中，i=1,2,3%fi系统沿该广义坐标方向上的外力，在本系统中，设系统的三个广义坐标分别是凡可，4。2.4推导建立数学模型在推导数学模型之前，我们需要几点必要的假设：1上摆、下摆及小车均是刚体；2 .皮带轮与传动带之间无相对滑动；传动皮带无伸长现象；3 .小车运动时所受的摩擦力正比于小车的速度；4 .

9、小车的驱动力与直流放大器的输入成正比，且无滞后，忽略电机电枢绕组中的电感；5 .下摆转动时所受到的摩擦力矩正比于下摆的转动速度；6 .上摆运动时所受到的摩擦力矩正比于上摆对下摆的相对角速度；二级倒立摆的运动分析示意图如图2.2式中，J一摆杆1质心平东动能7二一摆杆1绕质心转动动能&=Jp=JiA2G=(/衿；(2.7)Tm2摆杆2动能:Tm1=m1m1=g/_叫COS+gm汨：8)式中，匚，一摆杆1质心平东动能匚，一摆杆1绕质心转动动能d(x-211sini-12sin?dtd(211cos1+Z2cos)dt=m2x2乙，s-122cos2)+g恤W1s1sin1+122sin1心=94=4

10、刎；卜小MTm2=Tm2+2=m2(2-2x2Z11cos+122cos，4.、4m?4/：4/；g+4Z1Z2i2COs(%-4)213)Tn13质量块动能:T1Tm3=m37d(x-21isin1)dtd(211cos1)dt2、=gmix12mi1ixicosi+2mi1因此，可以得到系统总动能：(2.9)(2.10)(2.)(2.12)(2.13)系统的势能为:2=Mx2+m1x2-m111x1cos+m1122+m2(-2-2x(2i11CoSa+2COSe2)1、+-m241212+-ZX+4Z1Z2cos-01)+m3X22%/RaCOSa+2mi1yyv=+vm2+vm3=mi

11、g1icos3、+2m3g1icosi+m1g(2Z1cosi+Z2cos2)-完整版学习资料分享-(2.14)(2.15)至此得到拉格朗日算子1：1=T-VI12二Mx2+m1x2-mi11x1CoSq+m11262+m2(-2-2x1(2i11COSa+h2COSe2)4.、H+4Z1Z2Cos(%-4)3)+m3X22m31xcos1+2m312m1g11cos1(2.16)(2.17)(2.18)(2.19)-2m3g1cos4一m2g(21cosi+12cos)由于因为在广义坐标1,%上均无外力作用，有以下等式成立：4-0dt2)2展开17)、(2.18)式，分别得到(2.19)、(

12、2.20)式r6m2122sin-%)+4(吗+3(m2+m3)11-3(-2m2122cos(2-4)+(m1+2(m2+m3)(gsin+xcos1)=03gsin2-6112sin9O2)+4,2。2+61191cos(2-1)-3xcos2=0(2.20)将(2.19)、(2.20)式对4,庆求解代数方程，得到以下两式i-(3(-2gm1sini-4gm2sin1-4m3gsin1+3m2gcos(2-1)sin2+6加2，iCos(4-%)Sin-)：+4加2,2SinC-%)医-2m1fcos4-4m2xcos1-4m3xcos1+3m2xcos(1-2)cos2)/(21(-4m

13、1-X1m1-12m3+9m2cos2(1-2)21)区m2(m1+3(m2+m3)Z12Z2(-3gsin-611sin(1-2)-3xcos2)222(2.22)+m212cos(i912)(6m2122sin(9192)-3(m1+2(m2+m3)(gsin1+xcos91)/(-T2+3(7712+3)，：/；+4/72；/：/；COS2(4%)表示成以下形式:取平衡位置时各变量的初值为零,1&尢4&兄）二（。，0。，。o）二o将（2.23）式在平衡位置进行泰勒级数展开，并线性化，令3(-2g吗_4刎_48加3)2(-4m1-3m2-12m3)Z1I=9102(-4m1-3m2-12m

14、3)1&4噜1iV部。=。K161A=O=03(-2m1-m2-4m3)A=o2(-4m1-3m2-12m3)Z1得到线性化之后的公式将A=力（儿优,为,上篇由在平衡位置进行泰勒级数展开，并线性化，令2部=。=。2g(m1+2(m2+m3)164m22-(m1+3(m2+m3)24g(m1+3(m2+m3)3(4m22-(m1+3(m2+m3)2)(2.23)(2.24)(2.25)(2.26)(2.27)(2.28)(2.29)(2.30)(2.31)(2.32)33)(2.34)(2.35)(2.36)(2.37)(2.38)得至U即：现在得到了两个线性微分方取状态变量如下：则状态空间方程如下：X1兑2此.兑5将以下参数代入(6=粤IA=O=O(2.39)oU242(m1+2(m2+m3)(m1+3(m2+m3)_3(240)4=。