二级倒立摆模糊控制设计.doc
《二级倒立摆模糊控制设计.doc》由会员分享,可在线阅读,更多相关《二级倒立摆模糊控制设计.doc(32页珍藏版)》请在沃文网上搜索。
1、I目 录绪 论11 倒立摆系统的建模21.1 倒立摆系统的特性分析21.2 二级倒立摆系统的数学建模21.2.1 基于牛顿力学的二级倒立摆系统数学模型建立41.3 二级倒立摆系统数学模型的线性化处理42 线性二次型最优控制(LQR)的方案设计62.1 二级倒立摆性能分析62.1.1 稳定性分析62.1.2 能控性能观性分析62.2 线性二次型最优调节器原理72.3 加权阵Q和R的选择83 模糊控制的基本原理103.1 模糊理论的基本知识103.1.1 模糊控制概述103.1.2 模糊集合103.1.3 模糊规则和模糊推理113.1.4 反模糊化123.2 模糊控制系统的设计123.2.1 模糊
2、控制系统的组成及原理123.2.2 模糊控制器设计的基本方法与步骤143.3 二级倒立摆模糊控制器的设计154 二级倒立摆模糊控制系统的MATLAB仿真184.1 基于最优调节器的二级倒立摆控制系统的MATLAB仿真184.2 基于模糊控制器的二级倒立摆控制系统的MATLAB仿真214.2.1 二级倒立摆模糊控制系统的仿真波形214.2.2 量化因子和比例因子对模糊控制器性能的影响224.3 两种控制系统的MATLAB仿真对比研究23结束语24致 谢25参考文献26附 录27摘 要本文以二级倒立摆模型为控制对象,首先阐述了倒立摆系统控制算法的研究发展过程和现状,介绍了倒立摆系统的结构和数学模型
3、,并详细推导了二级倒立摆的数学模型。其次,本文主要研究倒立摆系统的现代控制方法以及智能控制方法,用LQR最优控制方法、模糊控制理论设计了控制器,通过MATLAB及SIMULINK仿真两个控制器,分析指出两方法的优缺点,结果表明:智能控制策略不仅能满足非线性系统的控制要求,而且能明显改善控制指标,整个系统具有更好的动态特性。最后完成了二级倒立摆系统控制程序的设计和调试,实验取得较好的仿真控效果,并对实验结果进行了详细的分析。结论部分对本课题的意义、目的和工作内容进行总结。关键词:二级倒立摆,最优控制,模糊控制 ABSTRACT The paper is focused on the double
4、 inverted pendulum. After discussing the historical development process and the current tendency of the researchbased on the inverted pendulum, the paper firstly introduced the structure and deduced the mathematical model of the double inverted pendulum. Then focuses mainly on the research of the in
5、verted pendulum systems control using the dynamical control methods as well as the intelligent control methods, I developed the system controllers based on the LQR optimal control methods and the fuzzy control methods ,I also simulated the whole system by using the MATLAB and the SIMULINK, after tha
6、t the advantages and disadvantages of the two control methods has been analysed .So the conclusion indicates that the intelligent control strategies can not only achieve the controlling demand of the non-linear system, but also meliorate significantly the control index of the system, as a result , t
7、he whole systems dynamic characteristic has been improved greatly. Lastly, I designed and debugged the code for modeling as well as controlling the double inverted pendulum using the MATLAB. The desired result of the simulation has been realized and discussed in detail. The meaning, the purpose and
8、the main content of the paper has been summarized in the end of the paper.Key words: double inverted pendulum,optimal control,fuzzy controller IV绪 论倒立摆控制系统是一个复杂的、不稳定的、非线性系统,是进行控制理论设计及测试的理想实验平台。倒立摆系统控制涉及到机器人技术、控制理论、计算机控制等多个领域。其被控系统本身是一个绝对不稳定、高阶次、多变量、强耦合的非线性系统,可以作为一个典型的控制对象对其进行研究1。同时,由于实际机械系统中存在的各种摩擦力
9、,实际倒立摆系统亦具有一定的不确定性。倒立摆系统的控制涉及到许多典型的控制问题:非线性问题、随动及跟踪问题、鲁棒性问题、非最小相位系统的镇定问题等等。正是由于倒立摆系统的特殊性,许多不同领域的专家学者在检验新提出理论的正确性和实际可行性时,都将倒立摆系统作为实验测试平台。再将经过测试后的控制理论和控制方法应用到更为广泛的领域中去1。如:把一级倒立摆的研究成果应用到对航空航天领域中的火箭发射推进器和卫星飞行状态控制的研究;把二级倒立摆的研究成果应道到双足机器人行走控制中2。所以说,对倒立摆系统控制理论的研究不仅具有理论研究价值,也具有相当的实际工程应用价值。倒立摆系统的传统控制方法主要是使用经典
10、控制理论和现代控制理论。它们都以精确的系统数学模型为控制对象。经典控制理论在线性定常、输入输出量较少的系统中能很好的完成控制设计指标,经典控制理论的数学基础是拉普拉斯变换,占主导地位的分析和综合方法是频率域方法。而现代控制理论是建立在状态空间分析法上的,基本分析方法是时域分析法。这种方法能够克服经典控制理论的缺陷:能够解决系统的输入输出变量过多、系统的非线性等问题。现代控制理论已经在工业生产过程、军事科学、航空航天等许多方面都取得了成功的应用。例如极小值原理可以用来解决某些最优控制问题;利用卡尔曼滤波器可以对具有有色噪声的系统进行状态估计;预测控制理论可以对大滞后过程进行有效的控制。但是它们都
11、有一个基本的要求:需要建立被控对象的精确数学模型3。随着科学技术的迅猛发展,各个领域对自动控制控制精度、响应速度、系统稳定性与适应能力的要求越来越高,所研究的系统也日益复杂多变。然而由于一系列的原因,诸如被控对象或过程的非线性、时变性、多参数间的强烈耦合、较大的随机干扰、过程机理错综复杂、各种不确定性以及现场测量手段不完善等,难以建立被控对象的精确模型4。虽然常规自适应控制技术可以解决一些问题,但范围是有限的。对于像二级倒立摆这样的非线性、多参数、强耦合的被控对象,使用传统控制理论难以达到良好的控制性能。而模糊控制理论能够克服这些困难,达到实际设计要求。1 倒立摆系统的建模1.1 倒立摆系统的
12、特性分析 直线型二级倒立摆系统是典型的机械电子系统。这种倒立摆系统具有如下特性:(1).开环不稳定系统。倒立摆系统有两个平衡状态:竖直向下和竖直向上。竖直向下的状态是系统稳定的平衡点,而竖直向上的状态是系统不稳定的平衡点,开环时微小的扰动都会使系统离开竖直向上的状态而进入到竖直向下的状态中。(2).不确定性。主要是指建立系统数学模型时的参数误差、测量噪声以及机械传动过程中的非线性因素所导致的难以量化的部分。(3).耦合特性。倒立摆摆杆和小车之间,以及多级倒立摆系统的上下摆杆之间都是强耦合的。这既是可以采用单电机驱动倒立摆控制系统的原因,也是使得控制系统的设计、控制器参数调节变得复杂的原因。(4
13、).仿射非线性系统。倒立摆控制系统是一种典型的仿射非线性系统,可以应用微分几何方法进行分析。(5).欠冗余性。一般地,倒立摆控制系统采用单电机驱动,因而它与冗余结构,比如说冗余机器人有较大不同。之所以采用欠冗余是要在不失系统可靠性的前提下节约经济成本或者有效的空间。由于以上倒立摆的特性,在建模时,为了简单起见,忽略系统中一些次要的难以建模的因素,如空气阻力、伺服电机的静摩擦力、系统连接处的松弛程度、摆杆连接处质量分布不均匀、传动皮带的弹性以及传动齿轮的间隙等等。将小车抽象为质点,摆杆抽象为匀质刚体,摆杆绕转轴转动,这样不仅可以简化分析,而且可以建立系统较为精确的数学模型。1.2 二级倒立摆系统
14、的数学建模二级倒立摆系统如图2.1所示。二级倒立摆装置由沿导轨运动的小车和通过转轴固定在小车上的摆体组成。在导轨一端装有用来测量小车位置的光电编码器。摆体与小车之间、摆体与摆体之间有转轴连接,并在连接处有两个光电编码器分别用来测量下摆和上摆的角度。下摆和上摆可以绕各自的转轴在水平导轨上左右运动,从而使倒立摆稳定在竖直位置并且可以沿着导轨倒立行走。图2.1二级倒立摆系统建立系统的运动方程时,为了简化二级倒立摆系统的数学模型,忽略空气流动作用在摆杆上的力矩干扰,并做以下假设:(1)小车、下摆摆杆和上摆摆杆都是刚体;(2)皮带轮与皮带间无相对滑动,皮带不能拉伸变长;(3)小车与导轨之问的摩擦力与小车
15、速度成正比;(4)各摆杆与转轴间的转动摩擦力矩与摆杆的角度成正比;在建立模型时,定义二级倒立摆物理参数符号:, 小车质量,取0.595kg m1,下摆刚性摆杆质量,取0.161kgm2,上摆刚性摆杆质量,取0.142kgl1, 下摆质心G1到转轴O1的距离,取0.124ml2, 上摆质心G2到转轴O2的距离,取0.227mL1, 下摆摆杆长度,取0.151mL2, 上摆摆杆长度,取0.151m1, 下摆摆杆与垂直向上方向所夹角度2, 上摆摆杆与垂直向上方向所夹角度F, 倒立摆系统的控制力x, 小车的水平位移量X1 下摆重心的水平位移量X2 上摆重心的水平位移量Y1 下摆重心的垂直位移量Y2 上
16、摆重心的垂直位移量f0, 小车与平台间的动摩擦系数,取11(NS/m) f1, 下摆与转轴O1间的摩擦阻力矩系数,取0.00324(NS/m)f2, 上摆与转轴O2间的摩擦阻力矩系数,取0.000774(NS/m)J1, 下摆到下摆质心G1的转动惯量,取0.00284(kgm2)J2, 上摆到上摆质心G2的转动惯量,取0.002433(kgm2)1.2.1 基于牛顿力学的二级倒立摆系统数学模型建立(1).对上摆进行受力分析:对上摆列转矩平衡方程,可得m2gl2sin2-f22-1-m2X2l2cos2+m2Y2l2sin2=J22 (2-1)对上摆列水平方向受力方程,可得F2x=m2X2=m2
17、(l2cos2+L1cos1+X) (2-2)对上摆列垂直方向受力方程,可得F2y=m2Y2=m2(l2sin2+L1sin1+Y) (2-3)(2).对下摆进行受力分析:对下摆列转矩方程,m1gl1sin1+f22-1-f11-m1X1l1cos1+m1Y1l1sin1 =J11 (2-4) (3).对整个倒立摆系统进行受力分析:F-F0X=MX+m12X1gt2+m22X2gt2 (2-5)联立上面所有方程,并消去F2x,F2y可得二级倒立摆模型方程:M0+M1+M2X+M1l1+M2Lcos11+M2l2cos22+F0X-M1l1+M2Lsin112 -M2l2sin222=G0u (
18、2-6)M1l1+M2Lcos1X+J1+M1l12+M2L21+M2Ll2cos2-12+(F1+F2)1 -F22-M2Ll2sin2-122=M1l1+M2Lgsin1 (2-7)M2l2cos2X+M2Ll2cos2-11+J2+M2l222+M2Ll2sin2-112-F21+F22=M2gl2sin2 (2-8) 1.3 二级倒立摆系统数学模型的线性化处理为了简化分析过程,必须对二级倒立摆系统数学模型进行一定的简化。对于上面分析的二级倒立摆系统,选取平衡点位置为:x=1=2=0, x=1=2=0, 对于系统在平衡点附近线性化并忽略高次项后,可将上式(2-8)改写为:M0,0x12=
19、-N0,0,0,0x12+F0,0x12+G0,0u (2-9)其中,M0,0= M0+M1+M2M1l1+M2LM2l2M1l1+M2LJ1+M1l12+M2L2M2Ll2M2l2M2Ll2J2+M2l22G0,0= G000N0,0,0,0= F1000F1+F2-F20-F2F2F0,0= 0000(M1l1+M2L)g000M2gl2式(2-9)两端同乘以,可得:x12=-M-1(0,0)N0,0,0,0x12+M-1(0,0)F0,0x12+M-1(0,0)G0,0u (2-10)令Z=x,1,2; 则式(2-10)为:Z=-MZ+NZ+Gu, 其中,M=M-10,0N0,0,0,0
20、,N= M-10,0F(0,0)G= M-1(0,0)G000且在实际系统中,测量上摆角度信号的电位器是安装在下摆顶端的轴承上,所以实际上摆电位器测得的上摆角信号是1-2,为了与实际角度采集系统相符合,同时也为了简化计算,做出如下变换:Z=TZ,Z=x,1,2-1, T=1000100-11于是有,Z=TMT-1Z+TNT-1Z+TGu (2-11)取状态变量:X=x,1,2-1,x,1,2-1TY=x,1,2-1T于是线性化后的六阶状态方程如下:X=AX+BuY=CX+Du (2-12)其中,A=I3*303*3A21A226*6,B=03*3B26*6,C=k1000k2000k3 000
21、000000A21=TNT-1=TM-10,0F(0,0)T-1A22=-TMT-1=-TM-10,0N(0,0,0,0)T-1B2=TG=TM-10,0G0002 线性二次型最优控制(LQR)的方案设计最优控制是现代控制理论的核心。最优控制研究的主要问题是:根据已经建立的被控对象的数学模型,选择一个容许的控制律,使得被控对象按预定要求运行,并使给定的某一性能指标达到最小值(最大值)。对于线性系统,若取状态变量的二次型函数的积分做为系统的性能指标,这种系统最优化问题称为线性系统二次型性能指标的最优控制问题,简称线性二次型(LQR)问题5。线性二次型控制理论已成为反馈系统设计的一种重要工具。2.
22、1 二级倒立摆性能分析2.1.1 稳定性分析在得到系统的数学模型之后,为了进一步的了解系统性质,需要对系统的特性进行分析,最主要的是系统的稳定性、能控性以及能观性。系统的稳定性分析一般可以应用李亚普诺夫稳定性理论。对于系统在平衡点邻域的稳定性可以根据前面得到的系统线性模型分析。一般摆杆竖直向上是系统的不稳定平衡点,需要设计控制器来镇定系统。既然需要设计控制器镇定系统,那么就要考虑系统是否能控。我们所关心的是系统在平衡点附近的性质,因而可以采用线性模型来分析。二级倒立摆的特征方程为: detI-A=0 (3-1)Matlab中,用函数eig(A)来计算系统矩阵的特征值,经过计算,系统的特征值为:
- 1.请仔细阅读文档,确保文档完整性,对于不预览、不比对内容而直接下载带来的问题本站不予受理。
- 2.下载的文档,不会出现我们的网址水印。
- 3、该文档所得收入(下载+内容+预览)归上传者、原创作者;如果您是本文档原作者,请点此认领!既往收益都归您。
下载文档到电脑,查找使用更方便
10 积分
下载 | 加入VIP,下载更划算! |
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 二级 倒立 模糊 控制 设计