直线二级倒立摆系统控制策略研究设计.pdf-淘文阁

资源描述

《直线二级倒立摆系统控制策略研究设计.pdf》由会员分享，可在线阅读，更多相关《直线二级倒立摆系统控制策略研究设计.pdf（47页珍藏版）》请在taowenge.com淘文阁网|工程机械CAD图纸|机械工程制图|CAD装配图下载|SolidWorks_CaTia_CAD_UG_PROE_设计图分享下载上搜索。

1、可编辑修改精品文档毕业设计（论文）题目直线二级倒立摆控制策略研究可编辑修改精品文档毕业论文（设计）原创性声明本人所呈交的毕业论文（设计）是我在导师的指导下进行的研究工作及取得的研究成果。据我所知，除文中已经注明引用的内容外，本论文（设计）不包含其他个人已经发表或撰写过的研究成果。对本论文（设计）的研究做出重要贡献的个人和集体，均已在文中作了明确说明并表示谢意。作者签名：日期：毕业论文（设计）授权使用说明本论文（设计）作者完全了解*学院有关保留、使用毕业论文（设计）的规定，学校有权保留论文（设计）并向相关部门送交论文（设计）的电子版和纸质版。有权将论文（设计）用于非赢利目

2、的的少量复制并允许论文（设计）进入学校图书馆被查阅。学校可以公布论文（设计）的全部或部分内容。保密的论文（设计）在解密后适用本规定。作者签名：指导教师签名：日期：日期：可编辑修改精品文档注意事项 1.设计（论文）的内容包括：1）封面（按教务处制定的标准封面格式制作）2）原创性声明 3）中文摘要（300 字左右）、关键词 4）外文摘要、关键词 5）目次页（附件不统一编入）6）论文主体部分：引言（或绪论）、正文、结论 7）参考文献 8）致谢 9）附录（对论文支持必要时）2.论文字数要求：理工类设计（论文）正文字数不少于 1 万字（不包括图纸、程序清单等），文科类论文正文字数不少于 1.2

3、万字。3.附件包括：任务书、开题报告、外文译文、译文原文（复印件）。4.文字、图表要求：1）文字通顺，语言流畅，书写字迹工整，打印字体及大小符合要求，无错别字，不准请他人代写 2）工程设计类题目的图纸，要求部分用尺规绘制，部分用计算机绘制，所有图纸应符合国家技术标准规范。图表整洁，布局合理，文字注释必须使用工程字书写，不准用徒手画 3）毕业论文须用 A4 单面打印，论文 50 页以上的双面打印 4）图表应绘制于无格子的页面上 5）软件工程类课题应有程序清单，并提供电子文档 5.装订顺序 1）设计（论文）2）附件：按照任务书、开题报告、外文译文、译文原文（复印件）次序装订 3）其它可编辑修改

4、精品文档摘要倒立摆是一个复杂的多变量强耦合不稳定非线性的系统，借助于这样一个系统可以有效的检测各种控制理论的好坏。本论文研究了倒立摆系统的建模方法，采用Lagrange方程对二级倒立摆系统进行建模。针对倒立摆的状态空间方程，采用MatLab软件对倒立摆的稳定性，能控性，能观性和可控度做了分析;采用最优控制理论对倒立摆系统进行稳摆控制并进行仿真，并利用该理论将倒立摆的数学模型加以改进，并对改进后的倒立。经过仿真分析确认改进后的倒立摆系统控制效果得到了明显的改善。本文分别用PID和LQR控制设计了控制器，通过MATLAB仿真，验证了所设计的控制器的有效性、稳定性和抗干扰性。关键词:倒立摆,

5、PID,LQR,MATLAB,仿真可编辑修改精品文档 ABSTRACT Inverted pendulum is a complex nonlinear multivariable strong coupling system instability by means of such a system can effectively detect the quality of various control theory.This paper studies the inverted pendulum system modeling method using Lagrange equati

6、on for double inverted pendulum system modeling.For inverted pendulum state space equation,using MatLab software inverted pendulum stability,controllability,observability and controllability were analyzed;using optimal control theory pendulum swing stability control system and simulation,and using t

7、he theoretical mathematical model of the inverted pendulum will be improved,and the inverted improved.The simulation analysis confirmed the improved inverted pendulum control effect has been significantly improved In this paper,the design of the controller with PID control and LQR control,through MA

8、TLAB simulation to verify the validity of the designed controller,stability and anti-jamming.KEY WORDS：Inverted pendulum,PID,LQR,MATLAB,Simulation 可编辑修改精品文档目录摘要.I ABSTRACT.II 第 1 章绪论.1 1.1 倒立摆系统的研究意义.1 1.2 倒立摆系统的研究现状.1 1.2.1 国外研究现状.2 1.2.2 国内研究现状.2 1.3 倒立摆系统的控制方法.3 1.4 本文的主要内容.4 第 2 章倒立摆系统简介.

9、5 2.1 倒立摆分类.5 2.2 倒立摆的特性.6 2.3 直线二级倒立摆的结构和工作原理.6 2.4 本章小结.7 第 3 章二级倒立摆系统模型的建立.9 3.1 倒立摆系统的物理结构及特性分析.9 3.2 直线二级倒立摆的数学模型.9 3.2.1 数学建模的方法.9 3.2.2 拉格朗日运动方程.10 3.2.3 推导建立数学模型.11 3.3 本章小结.17 第 4 章二级倒立摆系统控制策略的研究.18 4.1 稳定性分析.18 4.2 能控性能观性分析.18 4.3 本章小结.20 第 5 章倒立摆系统控制系统的设计与仿真.21 5.1 倒立摆 PID 控制方法设计.21 5.

10、2 PID 参数整定.23 5.3 PID 控制算法的 matlab 仿真.23 5.4 二级倒立摆 LQR 控制设计及仿真.26 5.4.1 二级倒立摆控制系统框图.26 5.4.2 任选加权阵的 LQR 最优控制仿真.27 结论和展望.30 致谢.31 参考文献.32 附录 A.33 附录 B.35 可编辑修改精品文档第 1 章绪论 1.1 倒立摆系统的研究意义倒立摆系统是一个多变量、非线性并且强耦合的自然不稳定系统，可以映射出控制领域诸如系统镇定、随动、跟踪以及鲁棒性许多关键特性。倒立摆系统广泛应用于检验新生控制理论或方法的正确性、实用性以及测试各种现有控制方法之间的性能优劣，同

11、时该装置成本低廉、结构简单又便于实验室操作，受到了世界各国学者和专家的青睐，被广泛应用于研究非线性、变结构、智能控制以及目标定位等多种控制方法中，成为理想的实验平台，被誉为“控制领域的一颗明珠”。倒立摆系统的控制方法在军事防御、机器人研发和一般工业生产过程中都有重要的工程意义，例如，双足机器人的站立行走与二级倒立摆极为相似，火箭等飞行器的助推器可类比一级倒立摆，而多级火箭飞行姿态的控制与多级倒立摆的控制原理相似，这就使得倒立摆的稳定控制和自起摆控制的研究成果广泛深入到各个领域。随着倒立摆系统研究的不断深入，倒立摆系统的种类也由简单的单级倒立摆发展为多种形式的倒立摆。如直线式倒立摆、环形倒立摆、

12、平面倒立摆；倒立摆的级数可以是一级、二级、三级、四级乃至多级。常见的倒立摆系统一般由小车和摆杆两部分构成(另有旋转式倒立摆等形式)。控制的目标一般都是通过给小车施加一个水平方向的力，使小车在期望位置上稳定，而摆杆达到竖直向上的动态平衡状态。由于新的控制方法不断出现，人们试图通过倒立摆这样一个严格的控制对象，检验新的控制方法是否有较强的处理多变量、非线性和绝对不稳定性的能力。也就是说，倒立摆统作为控制理论研究中的一种较为理想的实验手段通常有着用来检验控制策略有效性的功能。1.2 倒立摆系统的研究现状鉴于倒立摆的稳定控制研究的重要意义，国内外学者对此给予了广泛关注。国外在60年代就开始了对一级倒

13、立摆系统的研究，在60年代后期，作为一个典型的不稳定、严重非线性例证提出了倒立摆的概念，并用其检验控制方法对不稳定、非线性和快速性系统的控制能力。可编辑修改精品文档 1.2.1 国外研究现状国外对倒立摆系统的研究可以追朔到六十年代，1966年Schaefer和Cannon应用 Bang-Bang控制理论,将一个曲轴稳定于倒置位置。自从倒立摆系统1成为自动控制领域控制实验室的实验和教学工具以来，人们对倒立摆控制的研究既有理论研究又有实验研究。通过计算机仿真的方法对控制理论和控制方法的进行可行性研究；实验研究主要是解决仿真结果和实时控制之间性能差异的物理不确定性。早在1970年，Bryon和l

14、uenberger首次指出应用观测器重构系统状态，能实现倒立摆系统的稳定控制。1985年,K.furutat 等人又实现了三级倒立摆的稳定控制2。1986年，Chung等人对一级倒立摆系统进行了系统辨识,并设计了 PD 反馈控制器和自适应自整定反馈控制器实现了对倒立摆的稳定控制。1989年,Anderson等人运用函数最小化和LyaPunov 稳定方法成功产生了一个优化反馈控制器。1994年，sinha等人，利用LyapunovFloquet变换得到了三级倒立摆系统的计算机仿真模型3。1.2.2 国内研究现状国内对倒立摆的研究起步比较晚，大约在上世纪后期，但是成果显著。1989年，哈尔滨工业

15、大学研究生胡正涛完成了二级倒立摆控制装置，采用二次型最优调节器，用降维观测器对系统状态进行重构，同时也用线性函数观测器进行了实验。国内进入90年代后，倒立摆方面的主要研究成果有：1992年，北京理工大学自控系研究生李来湘完成了基于简化模型的二级倒立摆控制，以及在线参数系统辨识。1995年，程福雁等人，对二级倒立摆，采用模糊控制，实现了稳定的倒立摆控制4。1996年，张乃尧，发表了文章“倒立摆的双闭环模糊控制”5，该文章被很多文献引用，对应用智能方法控制倒立摆作出相当大的贡献。1997年王晓凯，将倒立摆的数学模型简化，实现倒立摆的控制实验研究。1998年蒋国飞，基于Q学习算法和BP 神经网络进行

16、倒立摆控制，实现了神经网络在控制上的应用。王卫华在1999年，运用专家模糊控制6，实现了单级倒立摆的动态控制。在 2005 年日本爱知世界博览会上，世界各地的专家们对李祖枢教授关于在运动状态下实现精确控制的仿人智能控制理论研究中所取得成果给与了充分肯定，以直线二级摆为基础，之后又成功研究出世界上首例双摆杂技机器人。2005 年国防科学技术大学的罗成、胡德文等人利用基于 LQR 的模糊插值实现了五级倒立摆的控制。2010 年，重庆大学自动化学院的肖琳采用仿人智能控制理论，完成了环形倒立摆 UP-UP 和 UP-DOWN 的大回环运动控制。同年燕山大学的安志银完成了基于神经网络旋转二级倒立摆系统的

17、预测控制研究。目前，许多学者正致力于引用模糊可编辑修改精品文档控制、神经网络、预测控制与变结构控制等各种方法实现对倒立摆系统的稳定控制。2011 年中南大学的聂炜和肖伟分别完成了基于 RBF-ARX 模型的 LQR 控制方法和遗传算法在倒立摆系统的应用。2011 大连理工大学的张宁引入了扩展的卡尔曼滤波（EKF），并用 EKF 算法来优化变论域自适应模糊控制器，实现了直线倒立摆起摆与稳摆控制的优化与改进，并且控制效果良好。2011 年南京航空航天大学的杜明洲实现了基于 C/S 模式的倒立摆远程控制，通过 LQR、神经网络等方法对倒立摆稳摆控制器，结合起摆和稳摆，讨论了决策的切换问题，实现了

18、理想的控制效果。可编辑修改精品文档 1.3 倒立摆系统的控制方法对倒立摆这样的一个典型被控对象进行研究，无论在理论上和方法上都具有重要意义，不仅由于其级数增加而产生的控制难度是对人类控制能力的有力挑战，更重要的是实现其控制稳定的过程中不断发现新的控制方法、探索新的控制理论，并进而将新的控制方法应用到更广泛的受控对象中。各种控制理论和方法都可以在这里得以充分实践.并且可以促成相互间的有机结合,当前倒立摆的控制方法可分为以下几类：（1）状态反馈控制7。基于倒立摆的动力学模型，使用状态空间理论推导出状态方程和输出方程，应用状态反馈，实现对倒立摆的控制。常见的利用状态反馈的方法有：1)线性二次型最

19、优控制；2)极点配置8；3)状态反馈H 控制9；4)鲁棒控制。（2）PID 控制。基于倒立摆的动力学模型，使用状态空间理论推导出其非线性模型，再在平衡点处进行线性化得到倒立摆系统的状态方程和输出方程，根据倒立摆系统的状态方程和输出方程设计出 PID 控制器，实现对倒立摆的控制。（3）云模型控制10。云模型是一种拟人控制，用云模型构成语言值，用语言值构成规则，形成一种定性的推理机制。这种控制不需要系统数学模型，而是根据人的经验、逻辑判断和感受，通过语言原子和云模型转换到语言控制规则器中，解决非线性问题和不确定性问题。（4）自适应控制。许多控制系统多为静态控制，自适应控制随着环境的变化而变化，属于

20、一种动态控制系统，从而提高控制精度。（5）非线性控制11。实际系统多被进行线性化处理，非线性系统更能准确反映实际系统，对提高系统控制精度具有更大意义。（6）神经网络控制12。神经网络能够学习与适应严重不确定性系统的动态特性，任意充分地逼近复杂的非线性关系，所有定量或定性的信息都等势分布贮存于网络内的各种神经元，故有很强的鲁棒性和容错性；也可将 Q 学习算法和 BP 神经网络有效结合，实现状态未离散化的倒立摆的无模型学习控制。可编辑修改精品文档（7）采用遗传算法与神经网络相结合的方法13。基于倒立摆数学模型设计出神经网络控制器，再利用改进的遗传算法训练神经网络的权值，从而实现对倒立摆的控制。（

21、8）模糊控制14。主要是确定模糊规则设计出模糊控制器，实现对倒立摆的控制。1.4 本文的主要内容本文主要是以倒立摆的仿真控制装置为平台，分析研究了极点配置、最优控制方案，用MATLAB和SIMULINK对控制方案进行了仿真，并实现了直线二级倒立摆仿真系统的控制。本文总共分四个部分，下面介绍一下本文各部分的主要内容。第1章绪论。介绍了倒立摆的研究背景和研究意义，倒立摆控制的研究发展状况和主要控制方法。第2章二级倒立摆系统简介。对倒立摆分类,倒立摆特性,倒立摆实验装置进行介绍，以及对倒立摆计算机控制系统结构和工作原理进行简述。第3章二级倒立摆系统模型的建立。介绍了直线二级倒立摆的物理结构，

22、在一定假设条件下，用拉格朗日方程，建立起二级倒立摆系统的标称数学模型，并对其进行了线性化，初步分析了其运动特性。第4章二级倒立摆控制策略的研究。根据第二章模型的建立与初步分析考虑控制器的设计。本章对二级倒立摆系统的稳定性，系统的能控性和能观性进行了初步分析，并用Matlab计算进行验证，确定二级倒立摆系统的控制策略。第5章控制系统的MATLAB仿真。本章为控制系统的仿真章节，根据已经建立的系统数学模型和控制器，设定选取了一些参数，求得K值，然后用仿真软件对PID控制方案，一一进行了控制系统的仿真，得出了仿真结果即各个输出量的波形。最后是结论。对全文进行的一次总结，指出了此次设计的总体理论概

23、述。可编辑修改精品文档第 2 章倒立摆系统简介本章简要介绍了倒立摆的分类、倒立摆系统的特性；简要分析了倒立摆系统建模的方法；利用Lagrange方程详细的推导了直线二级倒立摆的数学模型；根据倒立摆系统的特点，在平衡点附近得到系统的状态空间方程；并根据相关理论对倒立摆系统的特性进行了分析。2.1 倒立摆分类倒立摆已经由原来的直线一级倒立摆扩展出很多种类，典型的有直线倒立摆，环形倒立摆，平面倒立摆和复合倒立摆等，倒立摆系统是在运动模块上装有倒立摆装置，由于在相同的运动模块上可以装载不同的倒立摆装置，倒立摆的种类由此而丰富很多，按倒立摆的结构来分，有以下类型的倒立摆：1)直线倒立摆系列直

24、线倒立摆是在直线运动模块上装有摆体组件，直线运动模块有一个自由度，小车可以沿导轨水平运动，在小车上装载不同的摆体组件，可以组成很多类别的倒立摆，直线柔性倒立摆和一般直线倒立摆的不同之处在于，柔性倒立摆有两个可以沿导轨滑动的小车，并且在主动小车和从动小车之间增加了一个弹簧，作为柔性关节。2)环形倒立摆系列环形倒立摆是在圆周运动模块上装有摆体组件，圆周运动模块有一个自由度，可以围绕齿轮中心做圆周运动，在运动手臂末端装有摆体组件，根据摆体组件的级数和串连或并联的方式，可以组成很多形式的倒立摆。3)平面倒立摆系列平面倒立摆是在可以做平面运动的运动模块上装有摆杆组件，平面运动模块主要有两类：一类是X

25、Y 运动平台，另一类是两自由度SCARA 机械臂；摆体组件也有一级、二级、三级和四级很多种。4)复合倒立摆系列复合倒立摆为一类新型倒立摆，由运动本体和摆杆组件组成，其运动本体可以很方便的调整成三种模式，一是2)中所述的环形倒立摆，还可以把本体翻转90 度，连杆竖直向下和竖直向上组成托摆和顶摆两种形式的倒立摆。按倒立摆的级数来分：有一级倒立摆、两级倒立摆、三级倒立摆和四级倒立摆，一级倒立摆常用于控制理论的基础实验，多级倒立摆常用于控制算法的研究，倒立摆的级数越高，其控制难度更大，目前，可以实现的倒立摆控制最高为四级倒立摆。可编辑修改精品文档 2.2 倒立摆的特性虽然倒立摆的形式和结构各异，

26、但所有的倒立摆都具有以下的特性:1)耦合性倒立摆的各级摆杆之间，以及和运动模块之间都有很强的耦合关系，在倒立摆的控制中一般都在平衡点附近进行解耦计算，忽略一些次要的耦合量。2)非线性倒立摆是一个典型的非线性复杂系统，实际中可以通过线性化得到系统的近似模型，线性化处理后再进行控制。也可以利用非线性控制理论对其进行控制。倒立摆的非线性控制正成为一个研究的热点。3)开环不稳定性倒立摆的平衡状态只有两个，即在垂直向上的状态和垂直向下的状态，其中垂直向上为绝对不稳定的平衡点，垂直向下为稳定的平衡点。4)不确定性主要是模型误差以及机械传动间隙，各种阻力等，实际控制中一般通过减少各种误差来降低不确定

27、性，如通过施加预紧力减少皮带或齿轮的传动误差，利用滚珠轴承减少摩擦阻力等不确定因素。2.3 直线二级倒立摆的结构和工作原理可编辑修改精品文档图2.1 二级倒立摆系统直线二级倒立摆系统主要由以下几部分组成，如图2.1所示。其机械本体主要包括底座（导轨）、小车、驱动小车的交流伺服电机、同步皮带、一级摆杆、二级摆杆、限位开关及光电码盘等。通过控制交流伺服电机，带动皮带转动，在皮带的带动下小车可以在导轨上运动从而控制两级摆杆的运动状态。交流伺服电机带有光电式脉冲编码盘，根据脉冲数目可得出工作轴的回转角度，由传动比换算出小车直线位移。在小车的运动导轨上有用于检测小车位置的传感器，小车位置的信号被传

28、送给控制系统，通过控制算法计算出控制量控制电机，从而控制小车的位置，使两级摆杆垂直于水平面。我们的目的是设计一个控制器，通过控制电机的转动，使两级摆杆稳定在垂直于水平面的位置。二级倒立摆计算机控制示意图如图 2-1；计算机运动控制卡伺服驱动器伺服电机光电码盘 1 光电码盘 2 光电码盘 3 摆杆 1 摆杆 2 可编辑修改精品文档图 2.2 计算机控制结构示意图图 2.2 中的光电码盘 1 由伺服电机自带,可以通过该码盘的反馈换算出小车的位移、速度信号,并反馈给伺服驱动器和运动控制卡;通过光电码盘 2 和光电码盘 3 的反馈,可以分别换算出摆杆 1 和摆杆 2 的角度、角速

29、度信号,并反馈给运动控制卡;计算机从运动控制卡中读取实时数据,确定控制决策(小车向哪个方向移动、移动的速度、加速度等),并由运动控制卡来实现该控制决策,产生相应的控制量,使电机转动,带动小车运动,保持摆杆 1 和摆杆 2的平衡.2.4 本章小结倒立摆是一个验证理论的正确性及实际应用中的可行性的典型对象。各种控制方案在倒立摆上都有实现如：PID 控制、状态反馈控制、LQ 控制算法、预测控制、变结构控制以及模糊控制等。在三回路 PD 控制中主要对控制器的参数整定，通过极点配置来整定参数解决了人工整定的难点，对 PID 参数的整定有了简单有效的方法，对以后的研究起到了引导作用。可编辑修改精品文档

30、第3章二级倒立摆系统模型的建立 3.1 倒立摆系统的物理结构及特性分析本次仿真设计的二级倒立摆模型系统由机械部分和电路部分组成。机械部分包括底座，框架，滑轨，直流永磁式力矩电机，测速电机，电位器，齿型传动皮带，小车，摆杆，触发开关以及一些连接轴等。主要机械结构部分如图3.1所示。上摆杆下摆杆测角电位器测角电位器小车滑轨框架电机水平调节栓伪形传送带底座测位电位器可编辑修改精品文档图3.1 直线二级倒立摆的物理结构图对直线二级倒立摆控制系统而言，将功率放大器、力矩电机、小车、摆、皮带及皮带轮等的组合体视为控制对象，其输入是功率放大器的输入信号，输

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

32、.理想约束反力不出现在方程组中，因此在建立运动方程式时，只需分析已知的主动力，而不必分析未知的约束反力。3.Lagrange 方程是以能量观点建立起来的运动方程，为了列出系统的运动方程，只需要从两个方面去分析，一个是表征系统运动的动力学量系统的动能，另一个是表征主动力作用的动力学量广义力。因此用 Lagrange 方程来求解系统的动力学方程可以大大简化建模过程。3.2.2 拉格朗日运动方程拉格朗日提出了用能量的方法推导物理系统的数学模型，首先我们引入广义坐标，拉格朗日方程。广义坐标：系统的广义坐标是描述系统运动必需的一组独立坐标，广义坐标数等同于系统自由度数。如果系统的运动用n维广义坐标q1

33、,q2,qn来表示，我们可以把这n维广义坐标看成是n维空间的n位坐标系中的坐标。对于任一系可编辑修改精品文档统可由可编辑修改精品文档 n维空间中的一点来表征。系统在n维空间中运动形成的若干系统点连成一条曲线，此曲线表示系统点的轨迹。拉格朗日方程：),(),(,LqqVqqTqq）（(3.1)式中，L 拉格朗日算子，q 系统的广义坐标，T 系统的动能，V 系统的势能。拉格朗日方程由广义坐标iq和L表示为：iiifqLqLdtd (3.2)式中，ni3,2,1，if系统沿该广义坐标方向上的外力，在本系统中，设系统的三个广义坐标分别是21,x。3.2.3 推导建立数学模型在推导数学模型之前，

34、我们需要几点必要的假设：1.摆杆1、摆杆2 及小车均是刚体；2.传动带与皮带轮之间无相对滑动；传动皮带无伸长现象；3.小车的速度与小车运动时所受的摩擦力成正比；4.小直流放大器的输入成正比于车的驱动力，且无滞后，不计电机电枢绕组中的电感；5.下下摆的转动速度与摆转动时所受到的摩擦力矩成正比；6.上摆对下摆的相对角速度与上摆运动时所受到的摩擦力矩成正比；二级倒立摆的运动分析示意图如图 3.2所示可编辑修改精品文档图 3.2 二级倒立摆运动分析示意图倒立摆系统参数如下：M 小车质量 1.32kg 1m 摆杆 1 质量 0.05kg 2m 摆杆 2 质量 0.13kg 3m 质量块质量 0.2

35、36kg 1 摆杆 1 与垂直向上方向的夹角 2 摆杆 2 与垂直向上方向的夹角 1l 摆杆 1 到转动中心质心的距离 0.0775m 2l 摆杆 1 到转动中心质心的距离 0.25m F 作用在系统上的外力首先，计算系统的动能：321mmmMTTTTT (3.3)MT小车动能：221xMTM (3.4)1mT摆杆 1 动能：111mmmTTT (3.5)1 y x x F m1 m3 2 m2 M 可编辑修改精品文档式中，1mT摆杆 1 质心平动动能 1mT 摆杆 1 绕质心转动动能 21211111121211211121cos21)cos()sin(211lmxlmxmdtlddt

36、lxdmTm (3.6)212112121121 613121211lmlmJTpm (3.7)则 21211111121 32cos21111lmxlmxmTTTmmm (3.8)2mT摆杆 2 动能：222mmmTTT (3.9)式中，2mT摆杆 2 质心平动动能 2mT 摆杆 2 绕质心转动动能 222211122222111222211222112)sinsin2(21coscos2-21)coscos2()sinsin2(212llmllxmdtllddtllxdmTm）（(3.10)2222222222222 261312121lmlmJTm (3.11)）（12212122222

37、121222211122 222cos(434421)coscos2(221l lllmllxxmTTTmmm （3.12）3mT质量块动能：2121311132321121132cos221)cos2()sin2(213lmxlmxmdtlddtlxdmTm (3.13)可编辑修改精品文档因此，可以得到系统动能：321mmmMTTTTT 21211111121232cos2121lmxlmxmxM 22211122coscos2221llxxm 122121222221212cos434421l lllm 212131113232cos221lmxlmxm (3.14)系统的势能为：)c

38、oscos2(cos2cos22112113111321llgmglmglmVVVVmmm (3.15)至此得到拉格朗日算子L：VTL 21211111121232cos2121lmxlmxmxM 22211122coscos2221llxxm 122121222221212cos434421l lllm 212131113232cos221lmxlmxm )coscos2(cos2cos22112113111llgmglmglm (3.16)由于因为在广义坐标21,上均无外力作用，有以下等式成立：011LLdtd (3.17)022LLdtd (3.18)展开(2.17)、(2.18)式，分

39、别得到(2.19)、(2.20)式)cos(2(3)(3(4)sin(61222211321212222 lmlmmmlm 0)cossin)(2(11321xgmmm (3.19)0cos3)cos(64)sin(6sin3-2121122212112xlllg (3.20)可编辑修改精品文档将(2.19)、(2.20)式对21,求解代数方程，得到以下两式 21221312111sin)cos(3sin4sin4sin2(3(gmgmgmgm 1122212221212112cos2)sin(4)sin()cos(6xmlmlm /)cos)cos(3cos4cos422121312xm

40、xmxm )(cos912124(2(21223211mmmml (3.21)cos3)sin(6sin3()(3(94(221211222132122xlgllmmmm /)cossin)(2(3)sin(6)(cos(3211321212222212212xgmmmlmllm )(cos4)(3(916(21222212222213212llmllmmmm (3.22)表示成以下形式：),(212111xxxf (3.23),(212122xxxf (3.24)取平衡位置时各变量的初值为零，1212(,)(0,0,0,0,0,0,0)0Axxx (3.25)将(2.23)式在平衡位置进行泰

42、34)2321223210A1222)(3(9164)(2(2|lmmmlmmmmgfK (3.35)(3(9164(3)(3(4|2321223210A2223lmmmlmmmmgfK (3.36)0|0A224xfK (3.37)0|0A1225fK (3.38)0|0A2225fK (3.39)2321223213210A227)(3(9164)(3(34)(2(2|lmmmlmmmmmmmxfK (3.40)得到 xKKK 272231222 (3.41)即:xKKK 172131121 (3.42)xKKK 272231222 (3.43)现在得到了两个线性微分方程，由于我们采用加速

43、度作为输入，因此还需加上一个方程:xu (3.44)取状态变量如下：2615423121xxxxxxxx (3.45)则状态空间方程如下：可编辑修改精品文档 uKKxxxxxxKKKKxxxxxx271765432123221312654321100000000000000000100000010000001000 (3.46)将以下参数代入 25.00775.08.9236.013.005.032.121321llgmmmM 求出各个K值：088.0-45.3931.40-64.662.21-K 86.69K272322171312KKKK 得到状态方程各个参数矩阵：00045.3931.

44、40-000062.21-69.860000000100000010000001000A 0728.0-7012.51000B 000100000010000001C可编辑修改精品文档 000D 3.3 本章小结本章主要运用拉格朗日方法对直线二级倒立摆进行数学建模,并对数学模型线性化，推导出它的状态空间方程表达式，为后面的二级倒立摆控制策略的研究做好准备。第 4 章二级倒立摆系统控制策略的研究在研究控制方案之前，首先应该对被控对象的特性及本质有充分的了解。因此，在建立了系统的数学模型之后，利用一些仿真手段对被控对象的特性加以分析，是很有必要的。可编辑修改精品文档 4.1 稳定性分析

45、二级倒立摆的特征方程为:0)det(AI (4.1)MATLAB中，用函数 eig(A)来计算系统矩阵的特征值，经过计算，系统的特征值为：0 0 5.0262-10.0438-5.0262 10.0438 (4.2)开环系统有两个开环极点位于S平面右半平面上，所以系统是不稳定的。4.2 能控性能观性分析对于线形状态方程 CXYBUAXX (4.3)其能控性矩阵为：,54320BABABABAABBT (4.4)求0T的秩 6)(0Trank (4.5)所以系统是完全能控的。其能观性矩阵为：TACACACACCACC,54320 (4.6)求0C的秩 6)(0Crank (4.7)所以系统是完

46、全能观的。可控性矩阵0T的条件数决定系统控制的难控程度，条件数越大，系统越难控制。可控性矩阵0T的条件数为：40106356.4)(Tcond (4.8)前面能控性和能观性的判断毕竟是针对线性化后的数学模型。实际的倒立摆的非线性很重，同时一些参数（如转动惯量等）的数值并不一定准确，另外一些参数（如摩擦力矩系数）也不准确，对象的条件数较大，这些因素都使得二级倒立摆的实际控制比较难以实现。对于倒立摆这一自然不稳定系统，在研究使其能够稳定的控制方案之前，首可编辑修改精品文档先要搞清楚倒立摆系统在自然条件下的运动特性是怎样的？对于这个问题的解有助于我们更加深入了解倒立摆系统的本质，进而设计出比较适

47、合的控制方案。可编辑修改精品文档系统的状态矩阵 A,B,C,D 如下:00039.450040.3112-000021.6172-6907.8600000000000.10000000000.10000000000.1000A 0.0877-6402.60000.1000B 000100000010000001C 000D 利用 MATLAB 计算系统状态可控性矩阵和输出可控性矩阵的秩：clear;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 86.69-21.62 0 0 0;0-40.31 39.45 0 0 0;B=0 0 0

48、 1 6.64-0.088;C=1 0 0 0 0 0;0 1 0 0 0 0;0 0 1 0 0 0;D=0 0 0;cona=B A*B A2*B A3*B A4*B A5*B;cona2=C C*A C*A2 C*A3 C*A4 C*A5;rank(cona)rank(cona2)得到的结果如下:ans=可编辑修改精品文档 6 ans=3 或是通过 MATLAB 命令 ctrb 和 obsv 直接得到系统的可控性和可观测性。Uc=ctrb(A,B);Vo=obsv(A,C);rank(Uc)rank(Vo)运行得到结果:ans=6 ans=6 可以得到，系统状态和输出都可控，且系统具有

49、可观测性。4.3 本章小结本章主要在状态空间模型基础上对倒立摆系统的能控性和能观性以及稳定性进行定性分析，并用matlab 计算进行验证，证明分析正确性，为后面的仿真和实验控制打下理论基础。第5章倒立摆系统控制系统的设计与仿真可编辑修改精品文档 5.1 倒立摆 PID 控制方法设计 PID 控制算法是控制领域中发展最早，生命力最强，应用最广泛的控制算法，它简单明了，易于掌握，时至今日，仍然在很多工业场合仍是首选的控制方法之一在PID控制算法中将输出量与输入量的差值通过比例（P）、积分（I）和微分（D）线性组合构成系统的输出量，输出量能修正与控制被控对象的作用，故称 PID 控制器，其原理

50、图如图：最优控制就是在一定条件下，在完成所要求的控制任务时，使系统规定的性能指标具有最优值的一种控制。对于线性系统，若取状态变量的二次型函数的积分做为系统的性能指标，这种系统最优化问题称为线性系统二次型性能指标的最优控制问题，简称线性二次型(LQR)问题。线性二次型控制理论已成为反馈系统设计的一种重要工具。图5.1 PID控制原理图由图 5.1 我们可以知道，整个系统可以简要概括为三要素：测量、比较、执行。测量关注的是输出量，与输入量比较，用这个偏差调节系统的响应。我们大家都知道经典控制理论对被控对象有着许多约束条件，而且在设计控制器时一般需要有关被控对象的较精确模型。PID 控制器的关键在

展开阅读全文