控制系统课程设计__哈工大_倒立摆

哈尔滨工业大学课程设计说明书（论文）HHaarrbbiinnIInnssttiittuutteeooffTTeecchhnnoollooggyy课课程程设设计计说说明明书书（（论论文文））课程名称：控制系统设计课程设计设计题目：直线一级倒立摆控制器设计院系：航天学院自动化专业班级：设计者：学号：指导教师：设计时间：09.08.31——09.09.18哈尔滨工业大学哈尔滨工业大学课程设计说明书（论文）目录1.任务书-----------------------------------------------------------22.理论模型建立和分析-----------------------------------------43.PID控制器设计与调节--------------------------------------94.状态空间极点配置控制器设计----------------------------155.问题的进一步讨论-------------------------------------------246.设计结论与心得体会----------------------------------------25哈尔滨工业大学课程设计说明书（论文）*注：此任务书由课程设计指导教师填写。第一章理论模型的建立及分析1.1直线一阶倒立摆数学模型的推导系统建模可以分为两种：机理建模和实验建模。实验建模就是通过在研究对象上加上一系列的研究者事先确定的输入信号，激励研究对象并通过传感器检测其可观测的输出，应用数学手段建立起系统的输入－输出关系。这里面包括输入信号的设计选取，输出信号的精确检测，数学算法的研究等等内容。机理建模就是在了解研究对象的运动规律基础上，通过物理、化学的知识和数学手段建立起系统内部的输入－状态关系。对于倒立摆系统，由于其本身是自不稳定的系统，实验建模存在一定的困难。但是经过小心的假设忽略掉一些次要的因素后，倒立摆系统就是一个典型的运动的刚体系统，可以在惯性坐标系内应用经典力学理论建立系统的动力学方程。下面我们采用其中的牛顿－欧拉方法建立直线型一级倒立摆系统的数学模型。在忽略了空气阻力，各种摩擦之后，可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统.下图是系统中小车和摆杆的受力分析图。其中，N和P为小车与摆杆水平和垂直方向的分量。MPNFbpmgNθIx图1-1（a）小车隔离受力图（b）摆杆隔离受力图本系统相关参数定义如下：M:小车质量m：摆杆质量b：小车摩擦系数l：摆杆转动轴心到杆质心的长度I：摆杆惯量F：加在小车上的力x：小车位置φ：摆杆与垂直向上方向的夹角θ：摆杆与垂直向下方向的夹角（考虑到摆杆初始位置为竖直向下）注意：在实际倒立摆系统中检测和执行装置的正负方向已经完全确定,因而矢量方向定义如图所示，图示方向为矢量正方向。应用牛顿方法来建立系统的动力学方程过程如下：分析小车水平方向受到的合力，可以得到下面等式：MxFbxN（1-1）由摆杆水平方向的受力进行分析可以得到下面等式：22sindNmxldt（1-2）哈尔滨工业大学课程设计说明书（论文）2cossinNmxmlml（1-3）把这个等式代入上式中，就得到系统的第一个运动方程：2cossinMmxbxmlmlF（1-4）为了推出系统的第二个运动方程，我们对摆杆垂直方向上的合力进行分析，可以得到下面方程：22cosdPmgmldt（1-5）2sincosPmgmlml（1-6）力矩平衡方程如下：sincosPlNlI（1-7）注意：此方程中力矩的方向，由于错误!未找到引用源。,coscos,sinsin错误!未找到引用源。，故等式前面有负号。合并这两个方程，约去P和N，得到第二个运动方程：22sincosImlmglmlx（1-8）1.1.1微分方程模型设错误!未找到引用源。（是摆杆与垂直向上方向之间的夹角），假设与1（单位是弧度）相比很小,即1，则可以进行近似处理：错误!未找到引用源。2cos1,sin,()0ddt错误!未找到引用源。。用u来代表被控对象的输入力F，线性化后两个运动方程如下：哈尔滨工业大学课程设计说明书（论文）2MmxbxmluImlmglmlx（1-9）1.1.2传递函数对以上微分方程组进行拉普拉斯变换，得到22222()()()()()()()MmXssbXsmlssUsImlssmglsmlXss（1-10）注意：推导传递函数时假设初始条件为0。由于输出为角度为，求解方程组上述方程组的第一个方程，可以得到22()()ImlgXssmls（1-11）或者222()()smlsXsImlsmgl（1-12）如果令x，则有222()0.06()0.0240.588smlVssImlsmgl（1-13）把上式代入10式，则有：222222()()()()ImlImlggMmssbssmlssUsmlsmls（1-14）整理得到以输入力为输入量，摆杆角度为输出量的传递函数：212432()()()mlssqGsUsbImlMmmglbmglssssqqq（1-15）哈尔滨工业大学课程设计说明书（论文）其中22qMmImlml1.1.3状态空间数学模型由现代控制原理可知，控制系统的状态方程可写成如下形式：XAXBuYCXDu（1-16）可得代数方程，得到如下解：2222222222xxImlbImlmglxxuIMmMmlIMmMmlIMmMmlmglMmmlbmlxuIMmMmlIMmMmlIMmMml（1-17）整理后得到系统状态空间方程：22222222220100000000100010000010xxImlbImlmglxxIMmMmlIMmMmlIMmMmlumlbmglMmmlIMmMmlIMmMmlIMmMmlxy00xxu（1-18）由(1-9)的第二个方程为:2Imlmglmlx对于质量均匀分布的摆杆有:哈尔滨工业大学课程设计说明书（论文）21=3Iml于是可以得到:2213mlmlmglmlx化简得到:3344gxll（1-19）设TXxx，'ux，则有：'01000000010001000010000001003344xxxxxxxyuugll（1-20）实际系统参数如下：M:小车质量0.5kgm：摆杆质量0.2kgb：小车摩擦系数0.1N/m/secl：摆杆转动轴心到杆质心的长度0.3mI：摆杆惯量0.006kg*m*m把上述参数带入，可以得到系统的实际模型。摆杆角度和小车位移的传递函数：22()0.06()0.0240.588ssXss（1-21）摆杆角度和小车加速度之间的传递函数：2()0.06()0.0240.588sVss（1-22）摆杆角度和小车所受外界作用力的传递函数2432()50()11237349ssUsssss（1-23）以外界作用力作为输入的系统状态方程：哈尔滨工业大学课程设计说明书（论文）01000147200-0551100001503430-011111000000100211511xxxxuxxxyu（1-24）以小车加速度作为输入系统的系统状态方程：'010000000100010000100000010024.52.5xxxxxxxyuu（1-25）1.2系统阶跃响应分析在matlab中键入以下命令：得到如下结果：哈尔滨工业大学课程设计说明书（论文）图1-2直线一阶校正前倒立摆单位阶跃响应仿真可以看出，在单位阶跃响应作用下，小车位置和摆杆角度都是发散的。第二章直线一级倒立摆PID控制器设计本章主要利用PID控制算法对直线一级倒立摆系统进行控制器设计。在设计的过程中，要求熟悉控制参数PK、IK、DK对系统性能的影响，然后按照所要求的控制指标并综合实际响应结果恰当地调整参数。运用MATLAB仿真软件可以快捷地进行系统仿真和参数调整，本章第2节的内容即是运用MATLAB软件对PID控制系统的设计和仿真。第3节中，将对控制系统进行实际的运行和参数调试，以获得一组最佳的PID控制参数。设计目的：学习PID控制器的设计方法，了解控制器各个参数对系统性能的影响，学会根据控制指标要求和实际响应调整PID控制器的参数。设计要求：设计PID控制器，使得当在小车上施加0.1N的阶跃信号时，闭环系统的响应指标为：（1）稳定时间小于5秒；（2）稳态时摆杆与垂直方向的夹角变化小于0.1弧度。设计报告要求：（1）给出系统摆杆角度和小车位置的仿真图形及控制器参数，并对各个参数对系统控制效果的影响进行说明；（2）给出实际控制曲线和控制器参数，对响应的动态和静态指标进行分析。D控制系统原理框图如下所示，系统由模拟PID控制器KD（S）和被控对象G（S）组成。PID控制器是一种线性控制器，它根据给定值r(t)与实际输出值y(t)构成控制偏差e(t)()()()etrtyt将偏差的比例（P），积分（I）和微分（D）通过线性组个构成控制量，对被控对象进行控制，谷称为PID控制器。其控制规律为：哈尔滨工业大学课程设计说明书（论文）01()()[()()]tpDIdetutKetetdtTTdt或写成传递函数的形式：()1()[1]()pDIUsGsKTsEsTs在控制系统设计和仿真中，也将传递函数写成：()()()IpDKUsGsKKsEss简单来说,PID控制器各个校正环节的作用如下:（1）比例环节：成比例的反应控制系统的偏差信号e(t)，偏差一旦产生，控制器立即产生控制作用，以减少偏差。（2）积分环节：主要用于消除稳态误差，提高系统的型别。积分作用的强弱取决于积分时间常数T1，T1越大，积分作用越弱，反之则越强。（3）微分环节：反映偏差信号的变化趋势（变化速率），并能在偏差信号值变得太大之前，在系统中引入一个有效的早期修正信号，从而加快系统的动作速度，减小调节时间。这个控制问题，输出量为摆杆的位置，它的初始位置为垂直向上，我们给系统一个扰动，观察摆杆的响应，系统框图如下：图2-1直线一级倒立摆PID控制系统框图中KD(s)是控制器传递函数，G(s)是被控对象传递函数。考虑到输入r(s)=0，结构图可以很容易的变换成图2