直线二级倒立摆的控制问题的研究和matlab仿真毕业设计说明书

1、直线二级倒立摆的控制问题的研究和matlab仿真摘 要倒立摆系统是一个典型的多变量、非线性、强耦合和快速运动的高阶不稳定系统，它是检验各种新型控制理论和方法有效性的典型装置。近年来，许多学者对倒立摆系统进行广泛地研究。 本文研究了直线二级倒立摆的控制问题。首先阐述了倒立摆系统控制的研究发展过程和现状，接着介绍了倒立摆系统的结构并详细推导了二级倒立摆的数学模型。本文分别用极点配置、lqr最优控制设计了不同的控制器，通过比较和matlab仿真，验证了所设计的控制器的有效性、稳定性和抗干扰性。关键词: 倒立摆； 极点配置； 最优控制； matlab； 仿真abstractinverted pendu

2、lum is a typical multi-variable, non-linear, strong coupling and rapid movement of high-end system instability, it is testing various new control theory and methods of the effectiveness of the typical devices. in recent years, many scholars of the inverted pendulum extensive study.in this paper, a s

3、traight two inverted pendulum control problem.first on the inverted pendulum control of the development process and the status quo, then introduced the inverted pendulum system and the detailed structure of the two inverted pendulum is derived a mathematical model. in this paper, with pole placement

4、, lqr optimal control design a different controller, by comparing and matlab simulation, verified the effectiveness ,stability and anti-jamming of the controller. key words：inverted pendulum；pole assignment； optimal control；matlab； simulation目 录摘 要1abstract2第一章 绪论51.1 控制理论的发展51.2 倒立摆系统简介及其研究意义51.3 倒

5、立摆研究的发展现状及其主要控制方法61.4 本人所做工作8第二章 直线二级倒立摆数学模型的建立102.1 倒立摆系统的物理结构及特性分析102.2 系统的数学建模112.2.1 两种数学建模方法的比较112.2.2 系统数学建模参数的设定122.2.3 直线二级倒立摆的拉格朗日方程建模132.2.4 二级倒立摆系统数学模型的线性化172.3 系统参数的设定192.4 倒立摆系统的初步运动分析20第三章 直线二级倒立摆控制方案的设计223.1极点配置控制方案的设计223.1.1 极点配置理论223.1.2 极点配置算法233.2 线性二次型最优控制(lqr)方案的设计243.2.1 线性二次型最

6、优控制原理243.2.2 q, r阵的选择26第四章 控制系统的matlab仿真274.1 仿真软件的介绍274.1.1 matlab简介274.1.2 matlab7.0简介284.1.3 simulink 6.0仿真工具箱简介294.2 无干扰控制系统的仿真304.2.1 极点配置控制方案的仿真324.2.2 线性二次型最优控制(lqr)方案的仿真364.3 干扰条件下控制系统的仿真404.3.1 极点配置控制方案的仿真424.3.2 线性二次型最优控制(lqr)方案的仿真45结 论50致 谢52参考文献53第一章 绪论1.1 控制理论的发展控制理论发展至今已有100多年的历史，随着现代科

7、学技术的发展，它的应用也越来越广泛。特别是近几十年，航天航空航海和其它工业过程等领域的研究发展，不断地向控制理论提出一系列挑战性问题，对这些问题的研究和探索，有力地推动控制理论和控制方法取得长足发展，其发展通常可以分为三个阶段。第一阶段是经典控制理论阶段，上世纪50年代前后的控制理论主要是研究单输入-单输出线性定常系统的分析和设计问题，其理论基础是描述系统输入-输出关系的传递函数，基本分析和结合的方法是基于频率法、根轨迹法和相平面法等，描述系统的数学模型是微分方程或传递函数。经典控制理论对于非线性时变系统很难奏效。第二阶段是现代控制理论阶段。50年代末以来，应宇航技术发展的需要，现代控制理论应

8、运而生。它以描述系统状态这一内部特征向量的状态方程为基础，主要研究有高性能、高精度的多输入-多输出、变参数系统的分析和设计问题，最优控制、最优滤波、系统辨识和自适应控制等理论都是这一领域研究的主要课题。它能够解决经典控制理论难以解决的一些问题。第三阶段是大系统理论和智能控制理论阶段。随着被控系统的高度复杂性、高度不确定性以及人们对控制性能要求的提高，经典和现代控制理论面临空前的挑战。70年代末开始的智能控制理论和大系统理论的研究和应用，是现代控制理论在深度上和广度上的开拓。它用来解决多层次分散结构的复杂系统的分析和综合问题，因此受到各国著名学者的极大关注。目前，在专家系统、神经网络、模糊系统、

9、遗传算法等方面己经取得了可喜的进展。1.2 倒立摆系统简介及其研究意义倒立摆控制系统是应用于自动控制理论实验室的经典实验装置。倒立摆，顾名思义，是处于倒置不稳定状态，人为控制使其处于动态平衡的一种摆。它一般由沿导轨运动的小车和通过转轴固定在小车上的摆体组成，小车可以在限定的轨道上移动，小车上的倒立摆一端被绞链在小车顶部，另一端可以在小车轨道所在的垂直平面上转动。倒立摆系统大概可以归纳为如下几类：悬挂式倒立摆、平行式倒立摆和球平衡式倒立摆系统；倒立摆的级数可以是一级、二级、三级乃至多级；其运动轨道可以是水平的，还可以是倾斜的；控制电机可以是单电机，也可以是多级电机控制。倒立摆系统的最初研究开始于

10、二十世纪50年代，麻省理工学院设计出一级倒立摆实验设备，而后世界各国都将一级倒立摆控制作为验证某种控制理论或方法的典型方案。后来人们研究的倒立摆的种类也由简单的单级倒立摆迅速发展为多种形式的倒立摆系统。倒立摆系统是一个复杂的多变量、高度非线性、强耦合和快速运动的绝对不稳定系统，对于倒立摆系统的稳定控制，不仅具有重要的理论意义，而且还具有很重要的工程实践意义。一方面，由于倒立摆系统具有成本低廉，结构简单，物理参数和结构易于调整的优点，在实验室条件下易于实现；此外对于倒立摆的稳定控制，会涉及到控制中的许多关键问题，比如镇定问题、跟踪问题、随动问题、非线性问题以及鲁棒性问题等，人们试图通过倒立摆这样

11、一个复杂多变的控制对象，检验新的控制方法是否有较强的处理多变量、非线性和绝对不稳定系统的能力，充分验证新的控制方法的有效性及可靠性。另一方面，任何重心在上，支点在下的控制问题，都可近似地化为一种倒立摆模型。例如：机器人行走过程中的平衡控制、火箭发射中的垂直度控制和卫星飞行中的姿态控制等等，因此倒立摆的稳定控制方法在军工、航天、机器人领域和一般工业工程中有着很广泛的用途，相关的科研成果己经应用到航天科技和机器人学等诸多领域。正是由于对倒立摆系统稳定控制研究有着重要的理论和实际意义，因而倒立摆的稳定控制成为了控制理论中历久不衰的研究课题。1.3 倒立摆研究的发展现状及其主要控制方法鉴于倒立摆的稳定

12、控制研究的重要意义，国内外学者对此给予了广泛关注。国外在60年代就开始了对一级倒立摆系统的研究，在60年代后期，作为一个典型的不稳定、严重非线性例证提出了倒立摆的概念，并用其检验控制方法对不稳定、非线性和快速性系统的控制能力。1966年schaefer和cannon应用bang-bang控制理论，将一个曲轴稳定于倒置位置；s.mori等人于1975年采用最优控制和状态重构的方法完成对一级倒立摆的稳定控制。国外对二级以上倒立摆的研究从70年代开始，1972年sturgen等人采用线性控制模拟电路实现了二级倒立摆的控制，其线性状态反馈采用极点配置的方法获得，并采用全维状态观测器来重构了状态；197

13、8年，k.furuta等人采用微机处理实现了二级倒立摆的控制，1980年他们又完成了二级摆在倾斜轨道上的稳定控制；1983年，k.furuta等人又实现了双电机三级倒立摆的稳定控制。国内从80年代开始对倒立摆进行了研究，1982年，西安交通大学完成了二级倒立摆系统的研制和控制，采用了最优控制和降维观测器，以模拟电路实现；1983年，国防科技大学完成了一级倒立摆系统的研制和控制；1987年，上海机械学院完成了一、二级倒立摆系统的研制，并且完成了二级倒立摆在倾斜轨道上的控制。近年来，随着智能控制方法的研究逐渐受到人们的重视，模糊控制、神经网络、拟人智能控制、遗传算法和专家系统等越来越多的智能控制算

14、法应用到倒立摆动系统的控制上。charies w.andorson在1988年应用自学习模糊神经网络成功控制一级摆；周建波等用基于bp网络的规则控制也解决了单摆的稳定性控制问题；徐红兵等提出了基于变结构的模糊神经网络控制算法，实现了二级倒立摆系统的稳定性控制；1995年，张明廉等人应用拟人智能控制理论成功的解决了三级倒立摆这一控制界的世界性难题；2001年9月19日，北京师范大学李洪兴教授领导的复杂系统实时智能控制实验室采用变论域自适应模糊控制成功地实现了三级倒立摆实物系统控制，又于2002年8月11日在国际上首次成功实现了四级倒立摆实物控制系统。倒立摆作为一个典型的被控对象，适合用多种理论和

15、方法进行控制。当前，常见的倒立摆的控制规律有以下几种：(1)pid控制；(2)状态反馈控制；(3)模糊控制；(4)自适应控制；(5)神经网络控制；(6)遗传算法控制；(7)利用云模型实现对倒立摆的控制；(8)拟人智能控制；(9)几种控制算法相结合的控制方式，充分利用各控制算法的优越性，来实现一种组合式的控制方法，如遗传算法与神经网络结合的方法，神经网络与模糊理论结合的方法，模糊控制与pid结合的方法等等。1.4 本人所做工作本文主要是以倒立摆的仿真控制装置为平台，分析研究了极点配置、最优控制方案，用matlab和simulink对控制方案进行了仿真，并实现了直线二级倒立摆仿真系统的控制。本文总

16、共分四个部分，下面介绍一下本文各部分的主要内容。第一章 绪论。简要回顾控制理论的发展，对倒立摆系统做了简要介绍，并详细分析了倒立摆控制的研究发展状况和主要控制方法。第二章 直线二级倒立摆系统模型的建立和初步分析。介绍了直线二级倒立摆的物理结构，在一定假设条件下，用拉格朗日方程，建立起二级倒立摆系统的标称数学模型，并对其进行了线性化，初步分析了其运动特性。第三章 直线二级倒立摆控制方案的设计。根据第二章模型的建立与初步分析考虑控制器的设计。本章介绍了极点配置控制方案和线性二次型最优控制（lqr）方案，并介绍了极点配置理论、极点配置算法、线性二次型最优控制原理和q,r阵的选择。第四章 控制系统的m

17、atlab仿真。本章为控制系统的仿真章节，在本章首先介绍了仿真软件matlab，然后介绍了本次设计所用的仿真软件matlab版本：matlab7.0，其次介绍了仿真软件matlab7.0中的simulink 6.0仿真工具箱，最后根据已经建立的系统数学模型和控制器，设定选取了一些参数，求得k值，然后用仿真软件对极点配置控制方案和线性二次型最优控制（lqr）方案，一一进行了控制系统的仿真，得出了仿真结果即各个输出量的波形。最后是结论。对全文进行的一次总结，指出了此次设计的总体理论概述。第二章 直线二级倒立摆数学模型的建立现代控制理论是基于状态空间法进行分析的，因此首先要建立系统的状态空间方程。本

18、章从二级倒立摆的物理结构出发，通过对其进行受力分析和运动描述，对比两种建立数学模型的方法：牛顿力学分析方法、欧拉-拉格朗日原理(拉格朗日方程)的优缺点，并选定欧拉-拉格朗日原理(拉格朗日方程)对系统进行详细的数学建模，并进行必要的线性化处理和初步的系统原理分析。2.1 倒立摆系统的物理结构及特性分析本次仿真设计的二级倒立摆模型系统由机械部分和电路部分组成。机械部分包括底座，框架，滑轨，直流永磁式力矩电机，测速电机，电位器，齿型传动皮带，小车，摆杆，触发开关以及一些连接轴等。主要机械结构部分如图2-1所示。上摆杆下摆杆测角电位器测角电位器小 车滑 轨框 架电 机水平调节栓伪形传送带底 座测位电位

19、器 2-1 直线二级倒立摆的物理结构图对直线二级倒立摆控制系统而言，将功率放大器、力矩电机、小车、摆、皮带及皮带轮等的组合体视为控制对象，其输入是功率放大器的输入信号，输出是小车的位移和摆杆的角度。对直线二级倒立摆这个典型的机电控制系统来说，它具有以下特性：(1) 仿射非线性系统：倒立摆控制系统是一种典型的仿射非线性系统，可以应用微分几何方法进行分析。(2) 不确定性：主要是指建立系统数学模型时的参数误差、量测噪声以及机械传动过程中的非线性因素所导致的难以量化的部分。(3) 耦合特性：倒立摆的摆杆和小车之间，以及多级倒立摆系统的上下摆杆之间都是强耦合的。这既是可采用单电机驱动倒立摆控制系统的原

20、因，也是使得控制系统的设计、控制器参数调节变得复杂的原因。(4) 开环不稳定系统：倒立摆系统有两个平衡状态：竖直向下和竖直向上。竖直向下的状态是系统稳定的平衡点(考虑摩擦力的影响)，而竖直向上的状态是系统不稳定的平衡点，开环时微小的扰动都会使系统离开竖直向上的状态而进入到竖直向下的状态中。针对以上倒立摆系统的特性，在数学上完全准确地描述它几乎是不可能，为了解决实际系统中的控制问题，在实际设计控制系统建模时，通常忽略掉系统中一些次要的因素，例如空气阻力、伺服电机由于安装而产生的静摩擦力、系统连接处的松弛程度、摆杆连接处质量分布不均匀、传动皮带的弹性、传动齿轮的间隙等等，并将小车抽象为质点，摆杆抽

21、象为匀质刚体，从而建立一个比较精确的倒立摆系统的线性模型。2.2 系统的数学建模2.2.1 两种数学建模方法的比较倒立摆系统适合用数学工具进行理论推导，目前，人们对倒立摆系统建模一般采用两种方法：牛顿力学分析方法、欧拉-拉格朗日原理(拉格朗日方程)。牛顿力学分析方法的注意力集中在与系统的各部分相联系的力和运动以及各部分之间的相互作用。欧拉-拉格朗日原理(拉格朗日方程)则更多的把系统看作一个整体并利用如动能、势能之类的纯量来描述函数，它具有以下特点: 拉格朗日方程是广义坐标表达的任意完整系统的运动方程，方程的数目等于系统的自由度数，因而可以获得数目更少的运动方程。 建立运动方程时只需分析已知的主

22、动力而不必分析未知的约束力，因而，对于倒立摆这样的复杂系统更能体现其优越性。 拉格朗日方程具有很好的对称性，即对于同一位形空间中的每个坐标而言各方程都具有相同的形式。 拉格朗日方程是以能量观点建立起来的运动方程，在建立系统的运动 方程时，只需分析系统的动能和广义力。用拉格朗日方程可大大简化建模过程。直线二级倒立摆系统的数学模型采用经典力学进行建模分析，需要考虑各部分受力情况，虽然简单易懂，但需要罗列和解算大量微分方程，同时还需考虑质点组受到的约束条件，计算量大且复杂，对于此次设计，所涉及到的是基于直线二级倒立摆控制系统的matlab仿真，如果用牛顿经典力学建立数学模型必须考虑系统各部分干扰因素

23、，对整个设计及其仿真过程影响工作较大；而采用分析力学中的拉格朗日方程建模只需考虑系统的动能和广义力两个方面，计算简单、工作量小，大大简化建模过程，因此此次设计建立数学模型选择拉格朗日方程建模。2.2.2 系统数学建模参数的设定在推导直线二级摆系统的数学模型前，为了明确物理意义和推导的方便，忽略了一些次要的因素，做出以下假设:1.除皮带外整个对象系统看作刚体。2.齿型带轮和齿型带之间无相对滑动，齿型带无拉长现象，且传递作用的延迟忽略不计。3.整个电路系统的传递延迟忽略不计，放大器和电位器是线性的。4.小车在运动过程中所受的摩擦阻力正比于小车速度，上下摆杆转动时作用于摆杆的阻力矩正比于摆杆的角速度

24、。5.在控制过程中，摆杆没有在与滑轨成垂直方向上的运动。另外，为了推导方程时的方便，定义一些常用的符号如下:小车的位移，单位米，当小车在滑轨中心时为零，向右为正；:下摆的角位移，单位弧度，当摆杆竖直向上时为零，顺时针偏转为正；:上摆的角位移，单位弧度，当摆杆竖直向上时为零，顺时针偏转为正；:小车等效系统的等效质量，单位千克； :下摆的质量，单位千克；:上摆的质量，单位千克；l:下摆转动轴心到上摆转动轴心的距离，单位米；:下摆转动轴心到其重心的距离，单位米；:上摆转动轴心到其重心的距离，单位米；:小车系统的等效摩擦阻力系数，这时把小车与导轨间的摩擦力、电机机械摩擦转矩以及皮带轮摩擦转矩都归算到小

25、车运动上的等效摩擦系数，由下式定义:，单位牛秒/米；:下摆杆与小车之间的的等效转动摩擦阻力系数，其定义如下:等效摩擦力矩，单位牛秒/弧度；:上摆杆与下摆杆之间的的等效转动摩擦阻力系数，其定义如下:等效磨擦力矩，单位牛秒/弧度；:下摆对其重心的转动惯量，单位千克米；:上摆对其重心的转动惯量，单位千克米；:控制器向功放电路的输出的控制电压，单位伏；:功放电路和电机的等效放大系数，即转动力矩折合到小车上的控制力u与功放输入电压之比，单位牛/伏；u:电机所提供的作用于小车的控制力，其定义如下，单位牛，其方向向右为正；:摆杆转角测量电位器的放大倍数，单位伏/弧度；:小车位移测量电位器的放大倍数，单位伏/

26、米；2.2.3 直线二级倒立摆的拉格朗日方程建模通过上述设定与分析用拉格朗日方程建立直线二级倒立摆的数学模型。拉格朗日方程为： ， （2-1）对于直线二级倒立摆系统，广义坐标为位移和摆杆角度,；为作用在系统上的广义力，当，,当,时，。 t为小车和各级倒立摆的总动能，v为小车和各级倒立摆的总势能，d为小车和各级倒立摆的总耗散能。 规定下摆杆重心坐标为, 上摆杆重心坐标为， 则有：(1) 系统总动能，其中：小车动能： 下摆杆动能： 上摆杆动能： 则： （2-2）(2)系统总势能 ，其中:小车的势能 下摆杆的势能 上摆杆的势能 则: （2-3）(3)系统总耗散能，其中:小车的耗散能 下摆杆的耗散能

27、上摆杆的耗散能 则： （2-4） (4)当时，由式(2-1)可得： （2-5）当时，由式(2-1)可得： （2-6）当时，由式(2-1)可得： （2-7）其中：； 将上述各式代入(2-5), (2-6), (2-7)中整理化简得： （2-8） （2-9） （2-10）2.2.4 二级倒立摆系统数学模型的线性化将式 ( 2-8),( 2-9),(2-10)写成矩阵形式： （2-11）其中：对于直线二级倒立摆系统，选取平衡点位置为：，对系统在平衡点附近线性化并忽略高次项后，式(2-11)可改写为： （2-12）其中：式(2-12)两端同乘以，可得: （2-13）令；则式(2-13)为：，其中： 在

28、实际系统中,测量上摆角度信号的电位器是装在下摆顶端的轴承上，所以实际上摆电位器测得的上摆角的信号是。此次设计作为仿真，为了与实际采集系统相符合，也为了使计算方便，做如下变换: 于是有：取状态变量： 于是线性化后的六阶状态方程如下： （2-14）其中： 即,是对二级倒立摆系统进行状态空间分析的数学模型基础。2.3 系统参数的设定倒立摆系统实际上是一个定常系统，其系统参数是可以得到的。有些参数可以直接测得，如上下摆的质量、长度、摆杆的重心到转轴的距离、小车的质量等。而有些参数需要采用间接的方法得到，如摆杆的转动惯量、小车的等效摩擦系数、转轴的等效摩擦系数等。本次设计由于是对直线二级倒立摆的控制系统

29、的系统仿真，因此对其设计模型的参数的测定不做具体累述，通过直接或间接的方法设定系统的具体参数为：:0.595 :0.161 :0.142:0.151 :0.124 :0.227:11 :0.00324 :0.000774:0.00284 :0.002433 :2.582:9.34 :24.17 :9.806将上述设定的具体系统参数带入式（2-14）可得系统状态方程中的各矩阵： 2.4 倒立摆系统的初步运动分析在研究控制方案之前，首先应该对被控对象的特性及本质有充分的了解。因此，在建立了系统的数学模型之后，利用一些仿真手段对被控对象的特性加以分析，是很有必要的。一般摆杆竖直向上是系统的不稳定平衡

30、点，需要设计控制器来镇定系统。既然需要设计控制器镇定系统，那么首先就要考虑系统是否能控。由于我们所关心的是系统在平衡点附近的性质，因而可以根据前面得到的系统线性模型分析。在进行倒立摆的定性分析之前，先介绍线性控制理论中关于能控性、能观性的判定定理。定理1(能控性判据) 阶线性定常连续系统状态完全能控，当且仅当系统的能控性矩阵：满秩，即。特别的，当输入控制量为标量时，能控性矩阵为方阵，即等价于行列式值。定理2(能观性判据) 阶线性定常连续系统 完全能观，当且仅当系统的能观性矩阵：满秩，即特别的当输入量为标量时，能观性矩阵为方阵，即等价于的行列式值。对于由式(2-14)所确定的二级倒立摆系统，其特

31、征方程为：，经计算的系统的开环特征根为：，系统有两个极点在复平面右半平面，有一个极点在原点，因此系统是不稳定的。还可以计算得出，根据定理1和定理2可知：系统是完全可控和完全可观的。对于倒立摆这一自然不稳定系统，在研究使其能够稳定的控制方案之前，首先要搞清楚倒立摆系统在自然条件下的运动特性是怎样的？对于这个问题的解有助于我们更加深入了解倒立摆系统的本质，进而设计出比较适合的控制方案。第三章 直线二级倒立摆控制方案的设计前一章己经对二级倒立摆模型做了详尽的分析和推导，获得了它的状态方程形式的线性数学模型，从分析中可以看出，二级倒立摆系统是完全可控、完全可观测的。对二级倒立摆进行控制的主要目的是：二

32、级倒立摆系统在控制作用下能够稳定；系统的瞬态及稳态特性和动态特性良好；控制系统具有很强的鲁棒性；较容易完成稳定控制的任务。所设计的控制系统应该尽可能简单，容易实现，并有一定的抗干扰能力。随着控制理论的不断发展，在倒立摆这一经典实验装置上，已经有多种控制方法得到了应用。基于现代控制理论的极点配置控制方案、最优控制方案等。3.1 极点配置控制方案的设计3.1.1 极点配置理论闭环系统的稳定性和响应品质同闭环极点密切相关，控制系统的各种特性及其各种品质指标很大程度上由其闭环系统的零点和极点的位置决定。经典控制理论中通常用调整开环增益及引入串、并联校正装置来配置闭环极点。在现代控制理论中，广泛采用状态

33、变量反馈来配置极点。就是通过对状态反馈矩阵的选择，使闭环系统的极点配置在所希望的位置上，从而达到期望的性能指标要求。对于完全能控和完全能观的系统，设其状态方程为: (3-1)其中，。控制规律选择为线性状态反馈，即: (3-2)式中，。将式(3-2)代入式(3-1)，可得闭环系统的状态方程为： (3-3)显然，闭环系统的特征多项式应为: (3-4) c k ab因此通过改变k阵使闭环系统有所需要的极点配置，达到期望的性能指标要求。图3-1 加入状态反馈后系统结构图3.1.2 极点配置算法所给定的期望闭环极点可以是实数，也可以是按共扼对出现的复数，它的选择是一个工程实践与理论相结合的问题，要从实际

34、出发来确定极点和零点在复数平面上的分布。单输入单输出系统确定满足极点配置要求的状态反馈矩阵k的算法主要有系统匹配法、ackermann配置法、gura-bass算法等几种方法，假定期望的闭环极点为：，则原系统(3-1)的开环特征方程为： (3-5)闭环系统的特征方程为: (3-6)(1) 系统匹配法是计算反馈阵的一个最直接的方法，它主要通过比较系统特征方程的系数来求解，即:(3-4)式与(3-6)式的对应系数相等。此方法较为简单，但只适合于低阶系统。(2) ackennann配置算法是先把系统的描述转化为某种可控规范型，然后利用规范型的性质求解。这里只给出具体结果，所求反馈增益矩阵： 其中：,

35、a、b阵就是系统状态方程描述的参数矩阵，是期望的极点向量。(3)较为常用的方法是gura-bass算法，其具体步骤为:1)判断系统的可控性。确定能否完成预定的闭环极点配置综合目标；2)计算a的特征多项式，即开环系统的特征多项式(3-5)的个系数；3)由给定的动态指标或闭环极点要求确定闭环特征多项式(3-6)的个系数；4)计算矩阵；5)计算变换阵t: 6、计算所求的增益阵gura-bass算法不仅适用于单输入-单输出系统，也同样适用于单输入-多输出系统。多输入-多输出系统可以化为等价的单输入系统，进而采用单输入系统的极点配置算法。3.2 线性二次型最优控制(lqr)方案的设计最优控制就是在一定条

36、件下，在完成所要求的控制任务时，使系统规定的性能指标具有最优值的一种控制。对于线性系统，若取状态变量的二次型函数的积分做为系统的性能指标，这种系统最优化问题称为线性系统二次型性能指标的最优控制问题，简称线性二次型(lqr)问题。线性二次型控制理论已成为反馈系统设计的一种重要工具。3.2.1 线性二次型最优控制原理线性二次型问题就是：对于线性系统(3-1)，确定一个最优反馈控制律,使得如下性能指标最小化： （3-7）其中和为半正定阵，是正定矩阵。和分别是对状态变量和控制量的加权阵，表示的是最终误差，从理论上讲积分项中的第一项已经包含了终端误差的成分，但是如果要特别强调终值误差，则可以加上这一项，

37、反之就可以不用加了。由此可知二次型性能指标的最优控制问题实质上就是：要求用较小的控制能量来获得较小的误差的最优控制。一般情况下加权阵取为定常矩阵即和，首先构造一个哈密尔顿函数： （3-8）当输入信号不受约束时，则可对哈密尔顿函数求导并令其值为0，求出最小值,从而得到最优控制信号为: (3-9)其中可由下式求出:,即为黎卡提微分方程的解: (3-10)当，趋近于一个常值矩阵，且，故： (3-11)此式称为黎卡提矩阵代数方程。因此可得状态反馈量:。由此可见最优控制器的设计的关键是选择合适的加权阵q和r，并据此计算出黎卡提矩阵代数方程中的p，就可以求出反馈增益k。3.2.2 q, r阵的选择在利用l

38、qr方法设计控制器时，一个最关键的问题是二次型性能指标的选取。二次型性能指标与实际工程意义的品质指标间的联系至今未完全建立。因此，确定加权阵q, r是一项重要且困难的工作。一般来说，加权矩阵q和r的选取是在立足提高控制性能与降低控制能量消耗的折中上考虑的。为了使问题简单，且使加权阵q和r的各元素有明显的物理意义，通常将加权阵q和r选为对角阵。这样可以看出是对状态平方的加权，相对增大就意味着对的要求较严；是对控制量平方的加权，当r相对较大，意味着控制费用增高，使得控制能量较小，反馈减弱，当r相对很小时，控制费用较低，反馈增强，系统动态响应迅速。对于二级倒立摆系统，二次型性能指标应能使其在调节过程

39、中不偏离倒立摆的控制区域且尽可能在系统的线性范围内，根据前面对二级倒立摆运动分析，在考虑倒立摆系统的各个状态时，上摆偏角应比下摆的偏角重要，下摆的偏角应比小车的位移重要，因此要在选择加权矩阵q和r时反映这些要求。第四章 控制系统的matlab仿真4.1 仿真软件的介绍4.1.1 matlab简介matlab是在20世纪80年代初期，由美国的mathworks软件开发公司正式推出的一种数学工具软件，它以矩阵运算为基础，把计算、可视化、程序设计有机地融合到一个简单易学的交互式工作环境中。matlab拥有功能强大、丰富的函数工具箱，可以实现科学计算、符号运算、算法研究、数学建模和仿真、数据分析和可视

40、化、科学工程绘图以及图形用户界面设计等强大功能。经过这些年的不断更新，它的交互性越来越好，功能也越来越强大，目前，matlab软件已成为了国际上公认的、应用最广泛的优秀数学应用软件之一，matlab为用户提供了丰富而实用的资源，它涵盖了许多门类的科学研究，如数学、控制、通信、数字信号处理、数字图像处理和经济等。matlab语言具有如下特点：（1）编程效率高它是一种面向科学与工程计算的高级语言，允许用数学形式的语言编写程序，且比basic、fortean和c等语言更加接近我们书写计算公式的思维方式，用matlab编写程序犹如在演算纸上排列出公式与求解问题。因此，matlab语言也可以通俗地称为演

41、算纸式科学算法语言。由于它编写简单，所以编程效率高，易学易懂。（2）语句简单，用户使用方便matlab语言是一种解释执行的语言（在没被专门的工具编译之前），它灵活、方便，其调试程序手段丰富，调试速度快，需要学习时间少。人们用任何一种语言编写程序和调试程序一般都要经过4个步骤：编辑、编译、连接以及执行和调试。各个步骤之间是顺序关系，编程的过程就是在它们之间做瀑布型的循环。matlab语言与其他语言相比，较好地解决了上述问题，把编辑、编译、连接和执行融为一体。它能在同一画面上进行灵活操作,快速排除程序中的书写错误、语法错误乃至语义错误，从而加快了用户编写、修改和调试程序的速度，可以说在编程和调试过

42、程中它是一种比vb还要简单的语言。（3）扩展能力强matlab语言有丰富的库函数，在进行复杂的数学运算时可以直接调用，而且matlab的库函数同用户文件在形式上一样，所以用户文件也可以作为matlab的库函数来调用。因而，用户可以根据自己的需要方便地建立和扩充新的库函数，以便提高matlab的使用效率和扩充其他功能。（4）方便的绘图功能matlab的绘图功能十分方便，它有一系列绘图函数（命令），例如线性坐标、对数坐标、半对数坐标以及极坐标，均只需调用不同的绘图函数（命令），在图上标出图题、xy轴标注，格（栅）绘制也只需调用相应的命令，简单易行。正是由于这些特点，是matlab语言得到了广泛的应

43、用。4.1.2 matlab7.0简介虽然经过math works公司的不但改进升级，现在已经推出了matlab r2008a，但由于使用习惯、计算机硬件资源的限制及新功能学习的滞后等原因，目前matlab7.0仍被广泛使用。本文即以matlab7.0及其附带的simulink 6.0仿真软件作为仿真软件。matlab7.0是一个由matlab工作环境、matlab数学函数库、matlab语言、matlab图形处理系统和matlab应用程序接口五大部分组成的功能强大的系统。matlab7.0分为主包和数十个可选的工具箱(tool boxs)组成。主包有功能丰富和完备的数学函数库，大量繁杂的数学

44、运算和分析可直接调用matlab函数求解。matlab的每一个工具箱都为特定的学科和研究领域提供了丰富的分析处理工具，如控制系统工具箱(control systems toolbox)、信号处理工具箱(signal processing toolbox)、通信工具箱(communication toolbox)、神经网络工具箱(neural networks toolbox)、小波分析工具箱(wavelets toolbox)和仿真工具箱(simulation toolbox)等。对于我们自动化专业的仿真而言，我们主要用到的是simulink工具箱。当然也有可能涉及到simpowersyste

45、m工具箱、simextra工具箱。但主要是使用simulink工具箱来进行电力电子和电机等方面的仿真。4.1.3 simulink 6.0仿真工具箱简介在matlab7.0中附带有simulink 6.0仿真工具箱。simulink是一个用来对动态系统进行建模、仿真和分析的软件包，它支持连续、离散及两者混合的线性和非线性系统，也支持具有多种采样频率的系统。在simulink环境中，利用鼠标就可以在模型窗口中直观地做出系统模型，然后直接进行仿真。它为用户提供了方框图进行建模的图形接口，采用这种结构画模型就像你用手和纸来画一样容易。它与传统的仿真软件包微分方程和差分方程建模相比，具有更直观、方便、

46、灵活的优点。simulink包含有sinks（输入方式）、source（输入源）、linear（线性环节）、nonlinear（非线性环节）、connections（连接与接口）和extra（其他环节）子模型库。1.信号源库包括阶跃信号、正弦波、白噪声、时钟、常值、文件、信号发生器等各种信号源，其中信号发生器可产生正弦波、方波、锯齿波、随机信号等波形。2.输出库包括示波器仿真窗口、matlab工作区、文件等形式的输出。3.离散系统库包括五种标准模式：延迟，零-极点，滤波器，离散传递函数，离散状态空间。4.线性系统库提供七种标准模式：加法器、比例环节、积分环节、微分环节、传递函数、零-极点、状态

47、空间。5.非线性系统库提供十三种常用标准模式：绝对值、乘法、函数、回环特性、死区特性、斜率、继电器特性、饱和特性、开关特性等。6.系统连接库包括输入、输出、多路转换等模块，用于连接其他模块。7.系统扩展库考虑到系统的复杂性，simulink另提供十二种类型的扩展系统库，每一种又有多种模型供选择。 另外，matlab/simulink具有开放的编程环境，它允许用户开发自己所需的模型，通过成组封装扩充现有的模型库。要建立自己的模型，主要有如下三种方法:1、用现有模型组合成新的自定义功能模型。2、使用matlab function模型调用matlab函数，构造形如y=f(x)的函数，其功能十分有限。

48、3、通过s-function模板构造新功能模块，即通过matlab或c语言程序，设计出可实现所需功能的新功能模块。这些给快速建模提供了很大的便利。使用时只要建立好自己的模块或从各子库中取出模型，定义好模型参数，将各模型连接起来，然后设置系统参数，如仿真时间、仿真步长、计算方法等，就可以进行使用。4.2 无干扰控制系统的仿真此次仿真为无干扰条件下的控制系统仿真，仿真的目的是对整个控制系统在理想化无干扰条件下的控制进行讨论与研究。无干扰条件下控制系统simulink仿真图如下图所示：图4-1 无干扰控制系统simulink仿真框图对于上图4-1中设置的subsystem模块其内部结构图为如下图所示

49、：图4-2 subsystem模块其内部结构图4.2.1 极点配置控制方案的仿真为了使系统有较好的稳态响应和瞬态响应特性，通过反复仿真最终选取闭环极点为：得反馈增益阵为：其simulink仿真框图如图4-1所示，仿真时选取初始状态为：， ，仿真结果如下图所示：图4-3 小车位移图4-4 小车速度图4-5 上摆杆角位移图4-6 上摆杆角速度图4-7 下摆杆角位移图4-8 下摆杆角速度图4-9 总体仿真曲线经过多次仿真可知，极点配置法可以对倒立摆这样的不稳定系统进行有效的控制，稳态性能较好。当选择的主导极点离虚轴较远时，系统的过渡时间短，但所需的控制力较大，反之，离虚轴较近时，系统的过渡时间长，所

50、需的控制力较小；当主导极点确定后，其余极点应远离主导极点，也就是其余极点实部最小的也要大于主导极点实部的2-3倍以上，其距离主导极点远，系统的过渡时间短，超调量变大，所需的控制力也较大。4.2.2 线性二次型最优控制(lqr)方案的仿真由于系统的非线性是固有的，片面追求系统的线性行为是不合理的，重要的是使采用线性模型设计的控制器能够克服系统非线性来适应对应参数的变化，并具有一定的鲁棒性。最终综合考虑了各项因素，选择：，,计算得： 其simulink仿真框图同图4-1，系统初始化状态为：，仿真结果如下图所示：图4-10 小车位移图4-11 小车速度图4-12 上摆杆角位移图4-13 上摆杆角速度

51、图4-14 下摆杆角位移图4-15 下摆杆角速度图4-16 总体仿真曲线与极点配置一样，lqr控制器同样可以对倒立摆进行有效的控制，达到期望的目的。通过多次仿真，还可得出：q不变而r减小时，系统的调节时间与超调量减小，但稳态误差增大；当r不变而q变大时，调节时间与超调量减小，摆杆的角度变化也同时减小，但稳态误差同时增大；当q和r的变化与上述两种情况相反时，结论也相反。当q和r阵太大时，系统会丧失稳定性。在控制系统设计中，q和r的选取应根据上述规律并结合实际情况协调进行。4.3 干扰条件下控制系统的仿真此次对控制系统进行的仿真为考虑一些干扰后的仿真，在实际生产和生活中比理想化无干扰条件下的仿真设

52、计更为贴近，应用更为广泛。为了便于表达和说明，在原有的simulink仿真框图加入一个相当于外部干扰信号的band-limited white noise模块，其参数设置为10，其他参数如无干扰仿真设置一样，simulink仿真框图如下图所示：图4-17 干扰条件下控制系统simulink仿真框图4.3.1 极点配置控制方案的仿真图4-18 小车位移图4-19 小车速度图4-20 上摆杆角位移图4-21 上摆杆角速度图4-22 下摆杆角位移图4-23 下摆杆角速度图4-24 总体仿真曲线4.3.2 线性二次型最优控制(lqr)方案的仿真图4-25 小车位移图4-26 小车速度图4-27 上摆杆

53、角位移图4-28 上摆杆角速度图4-29 下摆杆角位移图4-30 下摆杆角速度图4-31 总体仿真曲线通过考虑干扰条件下的仿真图与无干扰条件下的仿真图进行对比，可以看出，极点控制和lqr最优控制的优点，在设定了干扰量以后，控制系统更接近于实际，由仿真后得出的各个量的仿真曲线，可以看出，对于本次设计直线二级倒立摆控制系统所选用的控制器抗干扰能力较强：选择的band-limited white noise模块参数一般设置为0.01，对于上述在考虑干扰后的仿真其band-limited white noise模块参数选取了10，在干扰参数设置在10的前提下各个输出量的仿真曲线并没有收到明显的影响。本人通过多次设置干扰量的大小，以至于选取了干扰量为50、100、200、最终各个输出量的仿真曲线并没有失真，对于整个控制系统来说影响并不是