倒立摆PID控制及MATLAB仿真

1、精选优质文档-倾情为你奉上专心-专注-专业摘摘 要要倒立摆系统是一个典型的快速、多变量、非线性、不稳定系统，对倒立摆的控制研究无论在理论上和方法上都有深远的意义。本论文以实验室原有的直线一级倒立摆实验装置为平台，重点研究其PID控制方法，设计出相应的PID控制器，并将控制过程在MATLAB上加以仿真。本文主要研究内容是：首先概述自动控制的发展和倒立摆系统研究的现状；介绍倒立摆系统硬件组成，对单级倒立摆模型进行建模，并分析其稳定性；研究倒立摆系统的几种控制策略，分别设计了相应的控制器，以MATLAB为基础，做了大量的仿真研究，比较了各种控制方法的效果；借助固高科技MATLAB实时控制软件实验平台

2、；利用设计的控制方法对单级倒立摆系统进行实时控制，通过在线调整参数和突加干扰等，研究其实时性和抗千扰等性能；对本论文进行总结，对下一步研究作一些展望。关键词：一级倒立摆，PID，MATLAB 仿真精选优质文档-倾情为你奉上专心-专注-专业目 录精选优质文档-倾情为你奉上专心-专注-专业精选优质文档-倾情为你奉上专心-专注-专业第 1 章 自动控制概述1.1 自动控制概念在现代科学技术的许多领域中，自动控制技术得到了广泛的应用，自动控制技术最显著的特征就是通过对各类机器，各种物理参量、工业生产过程等的控制直接造福于社会。所谓自动控制，就是指在无人直接参与的情况下，利用控制装置操纵受控对象，使受控

3、对象的被控量等于给定值或按给定信号变化规律去变化。为达到某一目的，由相互制约的各个部分，按一定的规律组织成的，具有一定功能的整体，称为系统，它一般由控制装置（控制器）和被控对象所组成。自动控制有两种最基本的形式，即开环控制和闭环控制1。1.1.1 开环控制控制装置与受控对象之间只有顺向作用而无反向联系时，称为开环控制。其特点是：系统结构和控制过程均很简单。开环控制的示意框图如图1.1所示图 1.1 开环控制系统开环控制是一种简单的无反馈控制方式，在开环控制系统中只存在控制器对被控量对象的单方向控制作用，不存在被控制量(输出量)对被控量的反向作用，系统的精度取决于组成系统的元器件的精度和特性调整

4、的精确度。开环系统对外扰及内部参量变化的影响缺乏抑制能力，但开环系统内构简单，比较容易设计和调整，可用于输出量与输入量关系为已知，内外扰动对系统影响不大，并且控制精度要求不高的场合。在开环控制系统中，对于每一个输入参考量，就有一个与之相对应的工作状态和输出量，系统的精度取决于元、器件的精度和特性调整的精度，当系统的内扰和外扰影响不大并且控制精度要求不高时，可采用开环控制方式。精选优质文档-倾情为你奉上专心-专注-专业1.1.2 闭环控制控制装置与受控对象之间，不但有顺向作用，而且还有反向联系，即有被控量对控制过程的影响。闭环控制的特点是：在控制器和被控对象之间，不仅存在着正向作用，而且存在反馈

5、作用，即系统的输出量对控制量有直接影响，将检测出来的输出量送回到系统的输入端，并与信号比较的过程称为反馈，若反馈信号与输入信号相减，则称负反馈。反之，若相加，则称正反馈，输入信号与反馈信号之差称为偏差信号，偏差信号作用于控制器上，控制器对偏差信号进行某种运算，产生一个控制作用，使系统的输出量趋向于给定数值，闭环的实质就是利用负反馈的作用来减小系统的误差，因此闭环控制又称为反馈控制,其示意图如图1.2所示。图 1.2 闭环控制系统反馈控制是一种基本的控制规律，它具有自动修正被控量偏离给定值的作用，使系统因而可以抑制内扰和外扰所引起的误差，达到自动控制的目的。闭环控制是一种反馈控制，在控制过程中对

6、被控量(输出量)不断测量，并将其反馈到输入端与给定值(参考输入量)比较。利用放大后的偏差信号产生控制作用。因此，有可能部分采用相对来说精度不高，成本较底的元器件组成控制精度较高的闭环控制系统，闭环控制系统精度在很大程度上由形成反馈的测量元器件的精度决定。在此，闭环系统具有开环系统无可比拟的优点，故应用极广，但与此同时，反馈的引入使本来稳定运行的开环系统可能出现强烈的振荡，甚至不稳定，这是采用反馈控制构成的闭环控制时需要注意解决的问题。1.2 自动控制系统的分类根据不同的分类方法，自动控制系统的类型可概括如下：1.2.1 恒值系统、随动系统和程序控制系统若系统的给定值是一定值，而控制任务就是克服

7、扰动，使被控量保持恒值。此类精选优质文档-倾情为你奉上专心-专注-专业系统称为恒值系统。若系统给定值按照事先不知道的时间函数变化，并要求被控量跟随给定值变化，则此类系统称为随动系统。若系统的给定值按照一定的时间函数变化，并要求被控量随之变化，则此类系统称为程序控制系统1.2.2 随机系统与自动调整系统随机系统又称伺服系统或跟踪系统。其特点是在输入量总是在频繁地或缓慢地变化，要求系统的输出量能够以一定的准确度跟随输入量而变化。自动调整系统又称恒值调节系统（或调节器系统）其特点是输入保持为常量，或整定后相对保持常量，而系统的任务是尽量排除扰动的影响，以一定准确度将输出量保持在希望的数值上。1.2.

8、3 线性系统和非线性系统组成系统的元、器件的特性均为线性（或基本线性）能够用线性常微分方程描述其输入与输出的关系称为线性系统，主要特点是具有齐次性和叠加性，系统时间响应的特征与初始状态无关。在组成系统的元、器件中只要有一个元、器件的特性不能用线性方程描述，即为非线性系统，描述非线性系统的常微分方程中，输出量及各阶导数不完全是一次的，或者有的输出量导数项的系数是输入量的函数，系统的时间响应特性与被初始状态有极大的关系。1.2.4 连续系统与离散系统连续系统各部分的输入和输出信号都是连续函数的模拟量。离散系统是指某一处或者数处的信号以脉冲或数码的形式传递的系统。一般说来，同样是反馈控制系统，但数字

9、控制精度（尤其是控制的稳态准确度）高于离散控制。因为数码形式的控制信号远比模拟控制信号的抗干扰能力强。描述连续控制系统用微分方程，而描述离散控制系统则用差分方程。1.2.5 单输入单输出系统和多输入多输出系统单输入单输出系统亦称单变量系统，其输入量和输出量各为一个，系统结构较为精选优质文档-倾情为你奉上专心-专注-专业简单。多输入多输出系统亦称为多变系统，其输入量和输出量为多个，系统结构较为复杂，回路也多，一个输入量对数个输出量都有控制作用。1.2.6 集中参数系统和分布参数系统能用常微分方程描述的系统称为集中参数系统，系统中的参量或是定常的或是时间的函数，可以用时间作为变量的的常微分方程描述

10、其运动规律。不能用常微分方程，而需用偏微分方程描述的系统描述的系统称为分布参数系统，系统的输出将不再单纯是时间变量的函数，而且还是系统内部状态变量的函数，所需偏微分方程描述系统。1.3 对控制系统的性能要求在控制过程中，一个理想的控制系统，始终应使其被控量（输出）等于给定值（输入）。但是由于机械部分质量、惯量的存在，电路中存储元件的存在以及能源功率的限制，使得运动部件的加速度受到限制，其速度和位置难以瞬时变化。所以当给定值变化时，被控量不可能立即等于给定值，而需要一个过度过程，即动态过程，所谓动态过程就是指系统受到外加信号（给定值或扰动）作用后，被控量随时间变化的全过程。因此对系统性能的基本要

11、求有三个方面。稳定性：稳定性是这样来表述的：系统受到外作用后，其动态过程的振荡倾向和系统恢复恢复平衡的能力。如果系统受外力作用后，经过一段时间，其被控量可以达到某一稳定状态，则称系统是稳定的，否则称为不稳定系统。快速性：快速性是通过动态过程时间长短来表征的，过渡过程时间越短，表明快速性越好，反之亦然。快速性表明了系统输出对输入响应的快慢程度。系统响应越快，说明系统的输出复现输入信号的能力越强。准确性：准确性是由输入给定值与输出响应的始终值之间的差值来表征的。它反映了系统的稳态精度。若系统的最终误差为零，则称为无差系统，否则称为有差系统。稳定性、快速性和准确性往往是互相制约的。在设计与调试过程中

12、，若过分强调系统的稳定性，则可能会造成系统响应迟缓和控制精度较低的后果：反之，若过分强调系统响应的快速性，则又会使系统的振荡加剧，甚至引起不稳定。精选优质文档-倾情为你奉上专心-专注-专业trdttdcT在分析和设计自动控制系统时，应该尽量使其对三方面的性能有所侧重，并兼顾其他，以全面满足要求23。1.4 典型环节一个物理系统是由许多元件组合而成的，虽然各种元件的具体结构和作用原理是多种多样的，但若抛开具体结构和物理特点，研究其运动规律和数学模型的共性，就可以划分为数不够的几种典型环节（典型环节只代表一种特定的运动规律，不一定是一种具体的元件）。1.4.1 比例环节比例环节的微分方程为 （1.

13、1）)()(tKrtc式中，K为放大倍数。比例环节的传递函数为 （1.2）图 1.3 比例环节方框图比例环节的特点是，其输出不失真，不延迟，成比例地复现输入信号的变化，即信号的传递没有惯性。1.4.2 积分环节积分环节的微分方程为： （1.3） 其中T为积分时间常数积分环节的传递函数为： （1.4） 其中积分环节的方框图如图1.4所示KsRsCsG)()()( TssRsCsG1精选优质文档-倾情为你奉上专心-专注-专业图 1.4 积分环节方框图积分环节的特点是，输出量与输入量对时间的积分成正比。若输入突变，输出值要等时间T之后才等于输入值，故有滞后作用。输出积累一段时间后，即使使输入为零，输

14、出也将保持原值不变，即具有记忆功能。只有当输入反向时，输出才反向积分而下降。常利用积分环节来改善系统的稳态性能。1.4.3 微分环节理想的微分环节的微分方程为 （1.5）其中T为微分时间常数。对微分方程取拉氏变换后，可求得传递函数 （1.6）理想的微分环节的方框图如图1.5所示图 1.5 微分环节方框图若输入为单位阶跃信号，即，则输出的单位阶跃响应为ttr1 （1.7）这是一个面积为的脉冲，脉冲宽为零，幅值为无穷大，理想微分环节的输入和输出如图1.6所示。图 1.6 理想微分环节的单位阶跃响应微分环节的特点是，其输出与输入信号对时间的微分成正比，即输出反映了输入信号的变化率，而不反映输入量本身

15、的大小。因此，可由微分环节的输出来反映输入信号的变化趋势，加速系统控制作用的实现。常利用微分环节来改善系统的动态性能。 dttdrTrc TssRsCsGtdttdrtC精选优质文档-倾情为你奉上专心-专注-专业1.4.4 惯性环节惯性环节的微分方程为 （1.8）)()()(tKrtcdttdcT式中T为时间常数，K为比例系数。惯性环节的传递函数为 （1.9）1)()()(TsKsRsCsG上式称为惯性环节的标准式。当时，ssR1)(sTsKtC11)(在单位阶跃信号作用下的相应为 （1.10）)1 ()(TteKtc图1.7为K=1时，惯性环节的方框图。图 1.7 惯性环节方框图惯性环节的特

16、点是，其输出量不能瞬时完成与输出量完全一致的变化。1.4.5 时滞环节时滞环节也称延迟环节，其数学表达式为 （1.11）)( 1)()(ttrtC式中为延迟时间。由此，可得传递函数 （1.12）sseesRsCsG1)()()(时滞环节的方框图如图1.8。图 1.8 时滞环节方框图时滞环节的特点是，其输出波形与输入波形相同，但延迟了时间。时滞环节的存精选优质文档-倾情为你奉上专心-专注-专业在对系统得稳定性不利。系统的典型环节是按数学模型的共性去建立的，与系统中采用的元件不是一一对应的分析或设计系统必先建立系统或被控对象的数学模型，将其与典型环节的数学模型对比后，即可知其由什么样的典型环节组成

17、。典型环节的概念只适用于能够用线性定常数学模型描述的系统，而且类型环节数学模型是在一系列理想条件限制下建立的45。精选优质文档-倾情为你奉上专心-专注-专业第 2 章 MATLAB 仿真软件的应用2.1 MATLAB 的基本介绍MTALAB系统由五个主要部分组成，下面分别加以介绍。 (1)MATALB语言体系：MATLAB是高层次的矩阵数组语言具有条件控制、函数调用、数据结构、输入输出、面向对象等程序语言特性。利用它既可以进行小规模编程，完成算法设计和算法实验的基本任务，也可以进行大规模编程，开发复杂的应用程序。 (2)MATLAB工作环境：这是对MATLAB提供给用户使用的管理功能的总称包括

18、管理工作空间中的变量据输入输出的方式和方法，以及开发、调试、管理M文件的各种工具。 (3)图形句相系统：这是MATLAB图形系统的基础，包括完成2D和3D数据图示、图像处理、动画生成、图形显示等功能的高层MATLAB命令，也包括用户对图形图像等对象进行特性控制的低层MATLAB命令，以及开发GUI应用程序的各种工具。 (4)MATLAB数学函数库：这是对MATLAB使用的各种数学算法的总称包括各种初等函数的算法，也包括矩阵运算、矩阵分析等高层次数学算法。 (5)MATLAB应用程序接口(API)：这是MATLAB为用户提供的一个函数库，使得用户能够在MATLAB环境中使用c程序或FORTRAN

19、程序，包括从MATLAB中调用于程序(动态链接)，读写MAT文件的功能。 可以看出MATLAB是一个功能十分强大的系统，是集数值计算、图形管理、程序开发为一体的环境。除此之外，MA丁LAB还具有根强的功能扩展能力，与它的主系统一起，可以配备各种各样的工具箱，以完成一些特定的任务。MATLAB有几种在不同电脑作业系统的版本，例如在视窗3.1上的MATLAB for Windows, SIMULINK，在麦金塔上的MATLAB for Macintch，另外还有在Unix上的各种工作站版本。基本上这些版本主要是提供方便的操作环境，采用图形介面6。2.2 MATLAB 的仿真工具SIMULINKMA

20、TLAB的SIMULINK子库是一个建模、分析各种物理和数学系统的软件。由于在WINDOWS界面下工作,所以对控制系统的方块图编辑、绘制很方便。MATLAB命令窗口启动SIMULINK程序后,出现的界面如下。精选优质文档-倾情为你奉上专心-专注-专业分别为信号源、输出、离散系统库、线性系统库、非线性系统库、系统连接及扩展系统。下面分别介绍: （1）信号源程序提供了八种信号源,分别为阶跃信号、正弦波信号、白噪声、时钟、常值信号、文件、信号发生器等可直接使用。而信号发生器(singal gein)可产生正弦波、方波、锯齿波、随机信号等。（2）信号输出程序提供了三种输出方式,可将仿真结果通过三种方式

21、之一如仿真窗口、文件等形式输出。 （3）离散系统程序提供了五种标准模式,延迟、零-极点、滤波器、传递函数、状态空间等。并且每种标准模式都可方便地改变参数以符合被仿真系统。 （4）线性系统程序提供了七种标准模式,加法器、比例、积分器、微分、传递函数、零-极点、状态空间等。同离散系统一样,每种标准模式都可方便地改变参数以符合被仿真系统。 （5）非线性系统非线性系统库提供了十三种常用标准模式,如绝对值、乘法、函数、回环特性、死区特性、斜率、继电器特性、饱和特性、开关特性等。 （6）系统连接系统连接库提供了四种模式,输入、输出、多路转换等。 （7）系统扩展考虑到各种复杂系统的要求,另外提供了十二种类型

22、的扩展系统库,每一种又有不同的选择模式。2.3 控制系统的动态仿真由于SIMULINK提供了丰富的数学模型,且兼容于WINDOWS,所以用WINDOWS提供的简单命令即形成各种复杂的系统模型。下面分别介绍。连续系统某一位置随动系统的方块图如下所示精选优质文档-倾情为你奉上专心-专注-专业图 2.1传递函数图根据SIMULINK提供的方框图,转换为符合仿真要求的图形:图 2.2传递函数方块图输入仿真时间、仿真步长,选择数值计算方法即得到系统的阶跃响应。图 2.3K4 系统阶跃响应图 2.4 校正系统阶跃响应如果系统的动态响应特性不好,可以调出扩展库中的各种调节器,以改善系统的动态响应。比如引入典

23、型的PID调节器,加入调节器后的系统响应如上图所示。（2）非线性系统某一带有死区的随动系统如下图所示。死区范围0.5,从系统的阶跃响应可以看出,由于系统的非线性,使得原来无差系统变为有差系统,同样可以引入各种调节器来校正系统,改善系统的动态响应。精选优质文档-倾情为你奉上专心-专注-专业图 2.5非线性系统方框图（3）离散系统从离散系统库调出离散模型,得到系统的方框图和系统的阶跃响应如图所示。图 2.6离散系统图图 2.7非线性系统阶跃响应图 2.8 离散系统阶跃响应精选优质文档-倾情为你奉上专心-专注-专业2.4 小结MATLAB的SIMULINK对控制系统可以方便地进行仿真计算,分析控制系

24、统的瞬态响应及稳态指标,同时仿真结果可以用图形和数据文件输出,数据文件可以在别的系统中应用。不仅对单变量,而且对多变量及状态空间均可仿真计算,确实是一种方便、有效的工具。限于篇幅,MATLAB的其它功能,如控制系统的频域、时域分析另文介绍。精选优质文档-倾情为你奉上专心-专注-专业第 3 章 直线一级倒立摆系统及其数学模型GIP 系列倒立摆系统是固高科技有限公司为全方位满足各类电机拖动和自动控制课程的教学需要而研制、开发的实验教学平台。GIP 系列的主导产品由直线运动型、旋转运动型和平面运动型三个子系列组成。直线运动倒立摆的基本模块为直线运动控制模块，该模块由交流/直流伺服电机驱动滑动小车沿直

25、线轴承滑动，完成定位控制和速度跟踪的任务。在滑动小车上加装一个单摆系统，构成经典的控制教学产品：单节倒立摆系统，可完成各类控制课程的教学实验，让学生具有一个可供实验验证的平台。该系统可用测试、研究和开发各类新的控制算法7。3.1 系统组成倒立摆系统包含倒立摆本体、电控箱及由运动控制卡和普通PC机组成的控制平台等三大部分。系统组成框图如图 3.1。图 3.1 倒立摆系统框图精选优质文档-倾情为你奉上专心-专注-专业 3.1.1 倒立摆的组成小车由电机通过同步带驱动在滑杆上来回运动，保持摆杆平衡。电机编码器和角编码器向运动卡反馈小车和摆杆位置（线位移和角位移），如图3.2 。3.1.2 电控箱电控

26、箱内安装有如下主要部件： 交流伺服驱动器I/O 接口板开关电源 开关、指示灯等电气元件 3.1.3 其它部件图 3.3 电气控制箱电机倒立摆使用的电机是由日本松下公司提供的小型小惯量电机（MSMA系列，200W）。电机配有专门的驱动器。编码器倒立摆系统使用的是光电编码器，其工作原理是：利用一块特制的光栅板作为位移检测元件，光栅板上方格之间的距离为0.5mm左右。编码器内部有一个发光元件和两个聚焦透镜，发射光经过透镜聚焦后从底部的小孔向下射出，照在编码器下面的光栅板上，再反射回编码器器内。当在光栅板上转动编码器时，由于光栅板上明暗相间的条纹反射光有强弱变化，编码器内部将强弱变化的反射光变成电脉冲

27、，对电脉冲进行计数即可测出移动的距离。控制卡倒立摆还使用了由固高提供的控制卡，型号是GT-400-SV卡。SV卡的特点是输出类型可以是模拟量或者是脉冲量，它还采用了PID滤波器，外加速度和加速度前馈。通过调节，设置合适的参数，可提高控制系统的速度和精度。图 3.2 一级倒立摆的模型示意图Fy小车MFxO摆杆(2L,m)un(t)x驱动电机角度传感器位置传感器导轨G(xG ,yG)精选优质文档-倾情为你奉上专心-专注-专业3.1.4 倒立摆特性虽然倒立摆的形式和结构各异，但所有的倒立摆都具有以下的特性:非线性 倒立摆是一个典型的非线性复杂系统，实际中可以通过线性化得到系统的近似模型，线性化处理后

28、再进行控制，也可以利用非线性控制理论对其进行控制，倒立摆的非线性控制正成为一个研究的热点。不确定性 主要是模型误差以及机械传动间隙，各种阻力等，实际控制中一般通过减少各种误差，如通过施加预紧力减少皮带或齿轮的传动误差，利用滚珠轴承减少摩擦阻力等不确定因素。耦合性 倒立摆的各级摆杆之间，以及和运动模块之间都有很强的耦合关系，倒立摆的控制中一般都在平衡点附近进行解耦计算，忽略一些次要的耦合量。 开环不稳定性 倒立摆的稳定状态只有两个，即在垂直向上的状态和垂直向下的状态，其中垂直向上为绝对不稳定的平衡点，垂直向下为稳定的平衡点。 约束限制由于机构的限制，如运动模块行程限制，电机力矩限制等。为制造方便

29、和降低成本，倒立摆的结构尺寸和电机功率都尽量要求最小，行程限制对于倒立摆的摆起尤为突出，容易出现小车的撞边现象。3.2 模型的建立系统建模可以分为两种：机理建模和实验建模。实验建模就是通过在研究对象上加上一系列的研究者事先确定的输入信号，激励研究对象并通过传感器检测其可观测的输出，应用数学手段建立起系统的输入输出关系。这里面包括输入信号的设计选取，输出信号的精确检测，数学算法的研究等等内容。机理建模就是在了解研究对象的运动规律基础上，通过物理、化学的知识和数学手段建立起系统内部的输入状态关系。 对于倒立摆系统，由于其本身是自不稳定的系统，实验建模存在一定的困难。但是经过小心的假设忽略掉一些次要

30、的因素后，倒立摆系统就是一个典型的运动的刚体系统，可以在惯性坐标系内应用经典力学理论建立系统的动力学方程。下面我们采用精选优质文档-倾情为你奉上专心-专注-专业其中的牛顿欧拉方法建立直线型一级倒立摆系统的数学模型。3.2.1 微分方程的推导在忽略了空气阻力，各种摩擦之后，可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统，如下图3.4所示 图3.4 直线一级倒立摆系统我们不妨做以下假设：M小车质量、m摆杆质量、b小车摩擦系数、l摆杆转动轴心到杆质心的长度、I 摆杆惯、F加在小车上的力、x 小车位置、摆杆与垂直向上方向的夹角、摆杆与垂直向下方向的夹角（考虑到摆杆初始位置为竖直向下）。图3.5是系

31、统中小车和摆杆的受力分析图。其中， N 和 P 为小车与摆杆相互作用力的水平和垂直方向的分量。注意：在实际倒立摆系统中检测和执行装置的正负方向已经完全确定，因而矢量方向定义如图所示，图示方向为矢量正方向： 图3.5 （a）小车隔离受力图 （b）摆杆隔离受力图 分析小车水平方向所受的合力，可以得到以下方程： NxbFxM （3.1）精选优质文档-倾情为你奉上专心-专注-专业由摆杆水平方向的受力进行分析可以得到下面等式： sin122lkdmN即 ： （3.2）sincos2 mlmlxmN把这个等式代入上式中，就得到系统的第一个运动方程： （3.3）FmlmxbxMmsincos2 为了推出系统

32、的第二个运动方程，我们对摆杆垂直方向上的合力进行分析，可以得到下面方程： 即： (3.4)cos22ldtdmmgPcossin2 mlmlmgP 力矩平衡方程如下： (3.5) INlPlcossin方程中力矩的方向，由于，故等式前面有负sinsin,coscos,号。合并这两个方程，约去P和N，得到第二个运动方程： (3.6)cossin2xmlmglmlI 设（ 是摆杆与垂直向上方向之间的夹角），假设 与1（单位是弧度）相比很小，即1，则可以进行近似处理： 。用 u 代表被控对象的输入力F ，线性化后两个运动方程如下： (3.7)umlxbxmMxmlmglmlI 23.2.2 传递函数

33、对方程组(3.7)进行拉普拉斯变换，得到 (3.8) sUssmlssbXssXmMssmlXsmglssmlI22222注意：推导传递函数时假设初始条件为0。由于输出为角度，求解方程组(3.8)的第一个方程，可以得到：0,sin, 1cos2dtd精选优质文档-倾情为你奉上专心-专注-专业 (3.9) ssgmlmlIsX22)(把上式代入方程组(3.8)的第二个方程，得到： sUssmlsssgmlmlIbsssgmlmlImM22222(3.10)整理后得到传递函数： (3.11) sqbmglsqmglmMsqmlIbssqmlsUs23242 其中： 22mlmlIMmq3.2.3

34、状态空间结构方程系统状态空间方程为 (3.12)DnCXyBuAXx方程组（3.12）对解代数方程，得到解如下： , xuMmlmMImlMmlmMImMmglxMmlmMImlbuMmlmMImlIMmlmMIglmxMmlmMIbmlIxxx2222222222)()()( (3.13)整理后得到系统状态空间方程： 精选优质文档-倾情为你奉上专心-专注-专业222222222201000000000100ImlbxxImlm glI MmMmlxxI MmMmlI Mm Mmlumlmgl MmmlbI MmMmlI MmMmlI MmMml （3.14） （3.15）uxxxy00000

35、00001由公式(3.7)的第一个方程为： (3.16)xmlmglmlI 2对于质量均匀分布的摆杆有： (3.17)231mlI 于是可以得到： (3.18)xmlmglmlml 2231化简得到： (3.19)xllg 4343设，则有：xuxxX , (3.20)uxxxyulxxlgxx 00010000014301004300100000000010实际的系统模型如下：M 小车质量 1.096 Kg 精选优质文档-倾情为你奉上专心-专注-专业m 摆杆质量 0.109 Kg b 小车摩擦系数 0 .1N/m/sec l 摆杆转动轴心到杆质心的长度 0.2 5m I 摆杆惯量 0.003

36、4 kg*m*m T 采样频率 0.005秒 注意：在进行实际系统的MATLAB仿真时，我们将采样频率改为实际系统的采样频率。我们的在实际操作中自行检查系统参数是否与实际系统相符，否则的改用实际参数进行实验。 3.2.4 实际系统模型把上述参数代入，可以得到系统的实际模型 摆杆角度和小车位移的传递函数： (3.21) 26705. 00102125. 00275. 022sssXs摆杆角度和小车加速度之间的传递函数为： (3.22) 26705. 00102125. 002725. 02ssVs摆杆角度和小车所受外界作用力的传递函数： (3.23) 30942. 29169.270883167

37、. 035655. 223sssssUs以外界作用力作为输入的系统状态方程： (3.24)uxxxyuxxxx 000100000135655. 20883167. 0008285.27225655. 0010000629317. 00883167. 000010以小车加速度作为输入的系统状态方程：精选优质文档-倾情为你奉上专心-专注-专业 uxxxx 301004 .2900100000000010 （3.25）uxxxy0001000001需要说明的是，在固高科技所有提供的控制器设计和程序中，采用的都是以小车的加速度作为系统的输入，如果、用户需要采用力矩控制的方法，可以参考以上把外界作用力

38、作为输入的各式。3.2.5 采用 MATLAB 语句形式进行仿真仿真程序如图3.6所示图 3.6 系统数学模型仿真程序精选优质文档-倾情为你奉上专心-专注-专业可得仿真曲线和结果如图3.7和3.8所示图 3.7 系统数学模型仿真曲线图 3.8 系统仿真系数精选优质文档-倾情为你奉上专心-专注-专业第 4 章 PID 控制理论4.1 PID 控制概述在工业自动化设备中，常采用由比例、积分、微分控制策略形成的校正装置作为系统的控制器。 自从计算机进入控制领域以来，用数字计算机代替模拟计算机调节器组成计算机控制系统，不仅可以用软件实现PID控制算法，而且可以利用计算机的逻辑功能，使PID控制更加灵活

39、。数字PID控制在生产过程中是一种最为普遍的控制方法，将偏差的比例、积分、和微分通过线性组合构成控制量，对被控对象进行控制，故称为PID控制器。当今的自动控制技术都是基于反馈的概念。反馈理论的要素包括三个部分：测量、比较和执行。测量关心的变量，与期望值相比较，用这个误差纠正调节控制系统的响应。这个理论和应用自动控制的关键是，做出正确的测量和比较后，如何才能更好地纠正系统。PID（比例-积分-微分）控制作为最早实用化的控制器已有70多年历史，现在仍然是应用最广泛的工业控制器。PID控制简单易懂，使用中不需精确的系统模型等先决条件，因而成为应用最为广泛的控制器。PID控制由比例单元（P）、积分单元

40、（I）和微分单元（D）组成。其输入e (t)与输出u (t)的关系为 (4.1)因此它的传递函数为： (4.2)它由于用途广泛、使用灵活，已有系列化产品，使用中只需设定三个参数（Kp， Ki和Kd）即可。在很多情况下，并不一定需要全部三个单元，可以取其中的一到两个单元，但比例控制单元是必不可少的。PID控制之所以广泛使用：首先，PID应用范围广。虽然很多工业过程是非线性或时变的，但通过简化可以变成基本线性和动态特性不随时间变化的系统，这样PID就可控制了。其次，PID参数较易整定。也就是，PID参数Kp，Ki和Kd可以根据过程的动态特性及时整定。如果过程的动态特性变化，例如可能由负载的变化引起

41、系统动态特性变化， dttdeKdeKteKtudtip0)( dipKsKKsEsUsG0精选优质文档-倾情为你奉上专心-专注-专业PID参数就可重新整定。第三，PID控制在实践中也不断的得到改进，下面两个改进的例子。在工厂，总是能看到许多回路都处于手动状态，原因是很难让过程在“自动”模式下平稳工作。由于这些不足，采用PID的工业控制系统总是受产品质量、安全、产量和能源浪费等问题的困扰。PID参数自整定就是为了处理PID参数整定这个问题而产生的。现在，自动整定或自身整定的PID控制已是商业单回路控制器和分散控制系统的一个标准。在一些情况下针对特定的系统设计的PID控制控制得很好，但它们仍存在

42、一些问题需要解决：如果自整定要以模型为基础，为了PID参数的重新整定在线寻找和保持好过程模型是较难的。闭环工作时，要求在过程中插入一个测试信号。这个方法会引起扰动，所以基于模型的PID参数自整定在工业应用不是太好。如果自整定是基于控制律的，经常难以把由负载干扰引起的影响和过程动态特性变化引起的影响区分开来，因此受到干扰的影响控制器会产生超调，产生一个不必要的自适应转换。另外，由于基于控制律的系统没有成熟的稳定性分析方法，参数整定可靠与否存在很多问题。因此，许多自身整定参数的PID控制经常工作在自动整定模式而不是连续的自身整定模式。自动整定通常是指根据开环状态确定的简单过程模型自动计算PID参数

43、。但仍不可否认PID也有其固有的缺点：PID在控制非线性、时变、耦合及参数和结构不确定的复杂过程时，工作地不是太好。最重要的是，如果PID控制器不能控制复杂过程，无论怎么调参数都没用。虽然有这些缺点，PID控制是最简单的有时却是最好的控制方法8。4.2 PID 的控制规律PID控制就是对偏差信号)(te进行比例、积分、微分运算后，形成的一种控制规律。在模拟控制系统中,控制器最常用的控制规律是PID控制。模拟PID控制系统原理框图如图4.1所示。系统由模拟PID控制器和被控对象组成。精选优质文档-倾情为你奉上专心-专注-专业图 4.1 模拟 PID 控制系统原理框图PID 控制器是一种线性控制器

44、，它根据给定值 rin(t)与实际输出值 yout(t)构成控制偏差 error(t)=rin(t)-yout(t) PID 的控制规律为： (4.3)也可以写成传递函数的形式 (4.4)其中，pk比例系数，IT积分时间常数；DT微分时间常数。 简单的说来，PID控制器各校正环节的作用如下：比例环节：成比例的反映控制系统的偏差信号error(t)，偏差一旦产生，控制器立即产生控制作用，以减少偏差。积分环节：主要用于消除静差，提高系统的无差度。积分作用的强弱取决于积分时间常数IT，IT越大，积分作用越弱，反之越强。微分环节：反映偏差信号的变化趋势（变化速率），并能在偏差信号变的太大之前，在系统中

45、引入一个有效的早期修正信号，从而加快系统的动作速度，减少调节时间。4.3 数字 PID 控制计算机控制是一种采样控制，它只能根据采样时刻的偏差值计算控制量。因此，连续PID 控制算法不能直接使用，需要采用离散化方法。)11()()()(sTsTksEsUsGDIptDIpdttderrorTdtterrorTterrorktu0)()(1)()(精选优质文档-倾情为你奉上专心-专注-专业 TkerrorkerrorTTkerrorkTerrordttderrorjerrorTjTerrorTdtterrorkkTttkjkj11.2 , 1 , 00004.3.1 位置式 PID 控制算法按模

46、拟PID控制算法，以一系列的采样时刻点kT代表连续时间t，以矩形法数值积分近似代替积分，以一阶后向差分近似代替微分，即： (4.5) 可以得到离散 PID 表达式： (4.6) 式中，T为采样周期，k为采样序号，k=1，2，error(k-1)和error(k)分别为第(k-1)和第k时刻所得的偏差信号。位置式PID控制系统如下图4.2所示：图 4.2 位置式 PID 控制系统上述PID控制算法的缺点是：由于采用全量输出，所以每次输出均与过去的状态有关，计算时要对error(k)量进行累加，计算机输出控制量u(k)对应的是执行机构的实际位置偏差，如果位置传感器出现故障，u(k)可能会出现大幅度

47、的变化。u(k)的大幅度变化会引起执行机构位置的大幅度变化，这种情况是在实际生产中不允许的，在某些场合还可能造成重大事故。为避免这种情况的发生，可以采用增量式PID控制算法。 kjdjpkjDIpTkerrorkerrorkTjerrorkkerrorkkerrorkerrorTTjerrorTTkerrorkku0011DpdIpiTkkTkk,精选优质文档-倾情为你奉上专心-专注-专业4.3.2 增量式 PID 控制算法当执行机构需要的是控制量的增量（例如驱动步进电机）时，应采用增量式PID控制。根据递推原理可以得到： (4.7) kjDipkerrorkerrorkjerrorkkerr

48、orkku0111增量式 PID 控制算法： 由于 2121kerrorkerrorkerrorkkerrorkkerrorkerrorkkudip控制算法中不需要累加，控制增量u(k)仅与最近k次的采样有关，所以误动作时影响小，而且较为容易的通过加权处理获的比较好的控制效果。在计算机控制系统中，PID控制是通过计算机程序来实现的，因此它的灵活性很大。一些原来在模拟PID控制器中无法实现的问题，在引入计算机以后，就可以得到解决，于是产生了一系列的改进算法，形成非标准的控制算法，以改善系统的品质，满足不同的控制系统的需要。4.4 常用的 PID 控制系统单回路PID控制系统系统中只有一个PID控

49、制器,如图4.3所示.图 4.3 单回路 PID 控制系统4.4.1 串级 PID 控制串级计算机控制系统的典型结构如图4.4所示，图 4.4 串级控制系统框图精选优质文档-倾情为你奉上专心-专注-专业系统中有两个PID控制器， sGc2称为副调节传递函数，包围 sGc2的内环节称为副回路。 sGc1称为主调节器传递函数，包围 sGc1的外环称为主回路。主调节器的输出控制量1u作为副回路的给定量 sR2。串级控制系统的计算顺序是先主回路(PID1)，后副回路(PID2)。控制方式有两种：一种是异步采样控制，即主回路的采样控制周期1T是副回路采样控制周期2T的整数倍。这是因为一般串级控制系统中主

50、控对象的响应速度慢、副控对象的响应速度快的缘故。另一种是同步采样控制，即主、副回路的采样控制周期相同。这时应根据副回路选择采样周期，因为副回路的受控对象的响应速度较快。串级控制的主要优点：将干扰加到副回路中，由副回路控制对其进行抑制；副回路中参数的变化，由副回路给予控制，对被控量1cG的影响大为减弱；副回路的惯性由副回路给予调节，因而提高了整个系统的响应速度。副回路是串级系统设计的关键。副回路设计的方式有很多种，下面介绍按预期闭环特性设计副调节器的设计方法。由副回路框图可得到副回路闭环系统的传递函数为 (4.8)可得副调节器控制规律 (4.9)4.4.2 纯滞后系统的大林控制算法大林控制算法原

51、理早在1968年，美国IBM公司的大林(Dahlin)就提出了一种不同于常规的PID控制规律的新型算法，该算法的最大特点是将期望的闭环响应设计成一阶惯性加纯延迟，然后又反过来得到能满足这种闭环响应的控制器。对于图4.5所示的单回路控制系统， 为数字控制器，为被控对象， zGc zGp则闭环系统传递函数为 (4.10) zGzGzGzGzUzYzCC22221221 zzGzzGc22221 zGzGzGzGzRzYzpcpc1精选优质文档-倾情为你奉上专心-专注-专业4.5 单回路控制系统框图 (4.11)如果能事先设定系统的闭环响应，则可得控制器。大林指出，通常的 z zGc期望闭环响应是一

52、阶惯性加纯延迟形式，其延迟时间等于对象的纯延迟时间 (4.12) 式中，为闭环系统的时间常数，由此而得到的控制律为大林算法。T4.4.3 纯滞后系统的 Smith 控制算法在工业过程控制中，许多被控对象具有纯滞后的性质，Smith（史密特）提出了一种纯滞后补偿模型，其原理为：与PID控制器并接一补偿环节，该补偿环节称为Smith预估器。连续Smith预估控制带有纯延迟的单回路控制系统如图4.6所示，其闭环传递函数为 (4.13)其特性方程为 (4.14) 010 scesGsG图 4.6 有纯延迟的单回路控制系统 zzzGzEzUzGpc11 1sTesRsYss scscesGsGesGsG

53、sRsYs001精选优质文档-倾情为你奉上专心-专注-专业可见，特性方程中出现了纯延迟环节，使系统稳定性降低，如果足够大，系统将不稳定，这就是大延迟过程难于控制的本质。而之所以在特性方程中出现，是se由于反馈信号是从系统的a点引出来的。若能将反馈信号从b点引出，则把纯延迟环节移到控制回路的外边，如图4.7经过的延迟时间后，被调量Y将重复X同样的变化。图 4.7 改进的有纯延迟的单回路控制系统由于反馈信号X没有延迟，系统的响应会大大地改善。但在实际系统中， 点或是不存在，或是受物理条件的限制，无法从 点引出反馈信号来。针对这种问题，Smith 提出采用人造模型的方法，构造如图4.8所示的控制系统

54、。图 4.8 Smith 预估控制系统如果模型是精确的，即，且不存在负荷扰动（D=0），则 ,0mmsGsG则可以用Xm代替X作第一条反馈回路，实现将纯延迟, 0,mmmmXXYYEYY环节移动到控制回路的外边。如果模型是不精确的或是出现负荷扰动，则X就不等于Xm，控制精度也就不能令人满意。为此，采用E 实现第二条反馈回路。, 0mmYYE这就是Smith预估器的控制策略。实际上预估模型不是并联在过程上的，而是反向并联在控制器上的，因此，将图4.7变换可的到Smith预估控制系统等效图，如图4.8所示。显然，Smith控制方法的前提是必须确切的知道被控对象的数学模型，在此基础上才能建立精确的预

55、估模型。精选优质文档-倾情为你奉上专心-专注-专业4.4.4 PID 控制原理的特点PID控制器就是根据系统的误差，利用比例、积分、微分计算出控制量进行控制的。比例（P）控制 比例控制是一种最简单的控制方式。其控制器的输出与输入误差信号成比例关系。当仅有比例控制时系统输出存在稳态误差（Steady-state error）。 积分（I）控制 在积分控制中，控制器的输出与输入误差信号的积分成正比关系。对一个自动控制系统，如果在进入稳态后存在稳态误差，则称这个控制系统是有稳态误差的或简称有差系统（System with Steady-state Error）。为了消除稳态误差，在控制器中必须引入“

56、积分项”。积分项对误差取决于时间的积分，随着时间的增加，积分项会增大。这样，即便误差很小，积分项也会随着时间的增加而加大，它推动控制器的输出增大使稳态误差进一步减小，直到等于零。因此，比例+积分(PI)控制器，可以使系统在进入稳态后无稳态误差。 微分（D）控制 在微分控制中，控制器的输出与输入误差信号的微分（即误差的变化率）成正比关系。自动控制系统在克服误差的调节过程中可能会出现振荡甚至失稳。其原因是由于存在有较大惯性组件（环节）或有滞后(delay)组件，具有抑制误差的作用，其变化总是落后于误差的变化。解决的办法是使抑制误差的作用的变化“超前”，即在误差接近零时，抑制误差的作用就应该是零。这

57、就是说，在控制器中仅引入“比例”项往往是不够的，比例项的作用仅是放大误差的幅值，而目前需要增加的是“微分项”，它能预测误差变化的趋势，这样，具有比例+微分的控制器，就能够提前使抑制误差的控制作用等于零，甚至为负值，从而避免了被控量的严重超调。所以对有较大惯性或滞后的被控对象，比例+微分(PD)控制器能改善系统在调节过程中的动态特性。4.4.5 PID 参数的调整PID控制器的参数整定是控制系统设计的核心内容。它是根据被控过程的特性确定PID控制器的比例系数、积分时间和微分时间的大小。PID控制器参数整定的方法很多，概括起来有两大类：一是理论计算整定法。它主要是依据系统的数学模型，经过理论计算确

58、定控制器参数。这种方法所得到的计算数据未必可以直接用，还必须通过工程实际进行调整和修改。二是工程整定方法，它主要依赖工程经验，直接在控制系统的试验中进行，且方法简单、易于掌握，在工程实际中被广泛采用。PID控制器参精选优质文档-倾情为你奉上专心-专注-专业数的工程整定方法，主要有临界比例法、反应曲线法和衰减法。三种方法各有其特点，其共同点都是通过试验，然后按照工程经验公式对控制器参数进行整定。但无论采用哪一种方法所得到的控制器参数，都需要在实际运行中进行最后调整与完善。现在一般采用的是临界比例法。利用该方法进行 PID控制器参数的整定步骤如下：首先预选择一个足够短的采样周期让系统工作；其次仅加

59、入比例控制环节，直到系统对输入的阶跃响应出现临界振荡，记下这时的比例放大系数和临界振荡周期；再次在一定的控制度下通过公式计算得到PID控制器的参数。4.4.6 PID 控制回路的运行在PID控制回路投入运行时，首先可以把它设置在手动状态下，这时设定值会自动跟踪测量值，当系统达到一个相对稳定的状态后，再把它切换到自动状态下，这样可以避免系统频繁动作而导致系统不稳定。如图4.9所示。图 4.9 前馈控制系统复杂回路的控制：前馈控制系统：通常的反馈控制系统中，对干扰造成一定后果，才能反馈过来产生抑制干扰的控制作用，因而产生滞后控制的不良后果。为了克服这种滞后的不良控制，用计算机接受干扰信号后，在还没

60、有产生后果之前插入一个前馈控制作用，使其刚好在干扰点上完全抵消干扰对控制变量的影响,因而又名为扰动补偿控制。纯延迟补偿控制系统：在实际的控制过程中，由于执行机构和测量装置的延迟，系统有可能是一个纯滞后过程，如对于温度的控制其延迟时间可能多达10多分钟。这种滞后性质常引起被控对象产生超调或振荡，造成系统不容易达到稳定过程。因此，可以在控制过程中并联一个补偿环节，用来补偿被控对象的滞后部分，这样可以使系统快速达到稳定的过程。如图4.10所示。精选优质文档-倾情为你奉上专心-专注-专业图 4.10 纯延迟补偿控制系统精选优质文档-倾情为你奉上专心-专注-专业第 5 章 直线一级倒立摆的 PID 控制