摘要倒立摆系统是一个典型的快速、多变量、非线性、不稳定系统,对倒立摆的控制研究无论在理论上和方法上都有深远的意义。
本论文以实验室原有的直线一级倒立摆实验装置为平台,重点研究其PID控制方法,设计出相应的PID控制器,并将控制过程在MATLAB上加以仿真。
本文主要研究内容是:首先概述自动控制的发展和倒立摆系统研究的现状;介绍倒立摆系统硬件组成,对单级倒立摆模型进行建模,并分析其稳定性;研究倒立摆系统的几种控制策略,分别设计了相应的控制器,以MATLAB为基础,做了大量的仿真研究,比较了各种控制方法的效果;借助固高科技MATLAB实时控制软件实验平台;利用设计的控制方法对单级倒立摆系统进行实时控制,通过在线调整参数和突加干扰等,研究其实时性和抗千扰等性能;对本论文进行总结,对下一步研究作一些展望。
关键词:一级倒立摆,PID,MATLAB仿真目录第1章MATLAB仿真软件的应用 (9)1.1 MA TLAB的基本介绍 (9)1.2 MA TLAB的仿真 (9)1.3 控制系统的动态仿真 (10)1.4 小结 (12)第2章直线一级倒立摆系统及其数学模型 (13)2.1 系统组成 (13)2.1.1 倒立摆的组成 (14)2.1.2 电控箱 (14)2.1.3 其它部件图 (14)2.1.4 倒立摆特性 (15)2.2 模型的建立 (15)2.2.1 微分方程的推导 (16)2.2.2 传递函数 (17)2.2.3 状态空间结构方程 (18)2.2.4 实际系统模型 (20)2.2.5 采用MA TLAB语句形式进行仿真 (21)第3章直线一级倒立摆的PID控制器设计与调节 (34)3.1 PID控制器的设计 (34)3.2 PID控制器设计MA TLAB仿真 (36)结论 (41)致谢 (42)参考文献 (43)第1章 MATLAB仿真软件的应用1.1 MATLAB的基本介绍MTALAB系统由五个主要部分组成,下面分别加以介绍。
(1)MATALB语言体系:MATLAB是高层次的矩阵/数组语言.具有条件控制、函数调用、数据结构、输入输出、面向对象等程序语言特性。
利用它既可以进行小规模编程,完成算法设计和算法实验的基本任务,也可以进行大规模编程,开发复杂的应用程序。
(2)MATLAB工作环境:这是对MATLAB提供给用户使用的管理功能的总称.包括管理工作空间中的变量据输入输出的方式和方法,以及开发、调试、管理M文件的各种工具。
(3)图形句相系统:这是MATLAB图形系统的基础,包括完成2D和3D数据图示、图像处理、动画生成、图形显示等功能的高层MATLAB命令,也包括用户对图形图像等对象进行特性控制的低层MATLAB命令,以及开发GUI应用程序的各种工具。
(4)MATLAB数学函数库:这是对MATLAB使用的各种数学算法的总称.包括各种初等函数的算法,也包括矩阵运算、矩阵分析等高层次数学算法。
(5)MATLAB应用程序接口(API):这是MATLAB为用户提供的一个函数库,使得用户能够在MATLAB环境中使用c程序或FORTRAN程序,包括从MATLAB中调用于程序(动态链接),读写MAT文件的功能。
可以看出MATLAB是一个功能十分强大的系统,是集数值计算、图形管理、程序开发为一体的环境。
除此之外,MA丁LAB还具有根强的功能扩展能力,与它的主系统一起,可以配备各种各样的工具箱,以完成一些特定的任务。
MATLAB有几种在不同电脑作业系统的版本,例如在视窗3.1上的MATLAB for Windows, SIMULINK,在麦金塔上的MATLAB for Macintch,另外还有在Unix上的各种工作站版本。
基本上这些版本主要是提供方便的操作环境,采用图形介面[6]。
1.2 MATLAB的仿真工具SIMULINKMATLAB的SIMULINK子库是一个建模、分析各种物理和数学系统的软件。
由于在WINDOWS界面下工作,所以对控制系统的方块图编辑、绘制很方便。
MATLAB命令窗口启动SIMULINK程序后,出现的界面如下。
分别为信号源、输出、离散系统库、线性系统库、非线性系统库、系统连接及扩展系统。
下面分别介绍:(1)信号源程序提供了八种信号源,分别为阶跃信号、正弦波信号、白噪声、时钟、常值信号、文件、信号发生器等可直接使用。
而信号发生器(singal gein)可产生正弦波、方波、锯齿波、随机信号等。
(2)信号输出程序提供了三种输出方式,可将仿真结果通过三种方式之一如仿真窗口、文件等形式输出。
(3)离散系统程序提供了五种标准模式,延迟、零-极点、滤波器、传递函数、状态空间等。
并且每种标准模式都可方便地改变参数以符合被仿真系统。
(4)线性系统程序提供了七种标准模式,加法器、比例、积分器、微分、传递函数、零-极点、状态空间等。
同离散系统一样,每种标准模式都可方便地改变参数以符合被仿真系统。
(5)非线性系统非线性系统库提供了十三种常用标准模式,如绝对值、乘法、函数、回环特性、死区特性、斜率、继电器特性、饱和特性、开关特性等。
(6)系统连接系统连接库提供了四种模式,输入、输出、多路转换等。
(7)系统扩展考虑到各种复杂系统的要求,另外提供了十二种类型的扩展系统库,每一种又有不同的选择模式。
1.3 控制系统的动态仿真由于SIMULINK提供了丰富的数学模型,且兼容于WINDOWS,所以用WINDOWS提供的简单命令即形成各种复杂的系统模型。
下面分别介绍。
连续系统某一位置随动系统的方块图如下所示图1.1 传递函数图根据SIMULINK提供的方框图,转换为符合仿真要求的图形:图1.2 传递函数方块图输入仿真时间、仿真步长,选择数值计算方法即得到系统的阶跃响应。
图1.3 K=4系统阶跃响应图1.4 校正系统阶跃响应如果系统的动态响应特性不好,可以调出扩展库中的各种调节器,以改善系统的动态响应。
比如引入典型的PID调节器,加入调节器后的系统响应如上图所示。
(2)非线性系统某一带有死区的随动系统如下图所示。
死区范围±0.5,从系统的阶跃响应可以看出,由于系统的非线性,使得原来无差系统变为有差系统,同样可以引入各种调节器来校正系统,改善系统的动态响应。
图1.5 非线性系统方框图(3)离散系统从离散系统库调出离散模型,得到系统的方框图和系统的阶跃响应如图所示。
图1.6 离散系统图图1.7 非线性系统阶跃响应图1.8 离散系统阶跃响应1.4 小结MATLAB的SIMULINK对控制系统可以方便地进行仿真计算,分析控制系统的瞬态响应及稳态指标,同时仿真结果可以用图形和数据文件输出,数据文件可以在别的系统中应用。
不仅对单变量,而且对多变量及状态空间均可仿真计算,确实是一种方便、有效的工具。
限于篇幅,MATLAB的其它功能,如控制系统的频域、时域分析另文介绍。
第2章直线一级倒立摆系统及其数学模型GIP 系列倒立摆系统是固高科技有限公司为全方位满足各类电机拖动和自动控制课程的教学需要而研制、开发的实验教学平台。
GIP 系列的主导产品由直线运动型、旋转运动型和平面运动型三个子系列组成。
直线运动倒立摆的基本模块为直线运动控制模块,该模块由交流/直流伺服电机驱动滑动小车沿直线轴承滑动,完成定位控制和速度跟踪的任务。
在滑动小车上加装一个单摆系统,构成经典的控制教学产品:单节倒立摆系统,可完成各类控制课程的教学实验,让学生具有一个可供实验验证的平台。
该系统可用测试、研究和开发各类新的控制算法[7]。
2.1 系统组成倒立摆系统包含倒立摆本体、电控箱及由运动控制卡和普通PC机组成的控制平台等三大部分。
系统组成框图如图 3.1。
图2.1 倒立摆系统框图2.1.1 倒立摆的组成小车由电机通过同步带驱动在滑杆上来回运动,保持摆杆平衡。
电机编码器和角编码器向运动卡反馈小车和摆杆位置(线位移和角位移),如图3.2 。
2.1.2 电控箱电控箱内安装有如下主要部件: 交流伺服驱动器 I/O 接口板 开关电源开关、指示灯等电气元件2.1.3 其它部件图 2.3 电气控制箱 ①电机倒立摆使用的电机是由日本松下公司提供的小型小惯量电机(MSMA 系列,200W )。
电机配有专门的驱动器。
②编码器倒立摆系统使用的是光电编码器,其工作原理是:利用一块特制的光栅板作为位移检测元件,光栅板上方格之间的距离为0.5mm 左右。
编码器内部有一个发光元件和两个聚焦透镜,发射光经过透镜聚焦后从底部的小孔向下射出,照在编码器下面的光栅板上,再反射回编码器器内。
当在光栅板上转动编码器时,由于光栅板上明暗相间的条纹反射光有强弱变化,编码器内部将强弱变化的反射光变成电脉冲,对电脉冲进行计数即可测出移动的距离。
③控制卡倒立摆还使用了由固高提供的控制卡,型号是GT-400-SV 卡。
SV 卡的特点是输出类型可以是模拟量或者是脉冲量,它还采用了PID 滤波器,外加速度和加速度前馈。
通过调节,设置合适的参数,可提高控制系统的速度和精度。
图2.2 一级倒立摆的模型示意图2.1.4 倒立摆特性虽然倒立摆的形式和结构各异,但所有的倒立摆都具有以下的特性:①非线性倒立摆是一个典型的非线性复杂系统,实际中可以通过线性化得到系统的近似模型,线性化处理后再进行控制,也可以利用非线性控制理论对其进行控制,倒立摆的非线性控制正成为一个研究的热点。
②不确定性主要是模型误差以及机械传动间隙,各种阻力等,实际控制中一般通过减少各种误差,如通过施加预紧力减少皮带或齿轮的传动误差,利用滚珠轴承减少摩擦阻力等不确定因素。
③耦合性倒立摆的各级摆杆之间,以及和运动模块之间都有很强的耦合关系,倒立摆的控制中一般都在平衡点附近进行解耦计算,忽略一些次要的耦合量。
④开环不稳定性倒立摆的稳定状态只有两个,即在垂直向上的状态和垂直向下的状态,其中垂直向上为绝对不稳定的平衡点,垂直向下为稳定的平衡点。
⑤约束限制由于机构的限制,如运动模块行程限制,电机力矩限制等。
为制造方便和降低成本,倒立摆的结构尺寸和电机功率都尽量要求最小,行程限制对于倒立摆的摆起尤为突出,容易出现小车的撞边现象。
2.2 模型的建立系统建模可以分为两种:机理建模和实验建模。
实验建模就是通过在研究对象上加上一系列的研究者事先确定的输入信号,激励研究对象并通过传感器检测其可观测的输出,应用数学手段建立起系统的输入-输出关系。
这里面包括输入信号的设计选取,输出信号的精确检测,数学算法的研究等等内容。
机理建模就是在了解研究对象的运动规律基础上,通过物理、化学的知识和数学手段建立起系统内部的输入-状态关系。
对于倒立摆系统,由于其本身是自不稳定的系统,实验建模存在一定的困难。
但是经过小心的假设忽略掉一些次要的因素后,倒立摆系统就是一个典型的运动的刚体系统,可以在惯性坐标系内应用经典力学理论建立系统的动力学方程。