倒立摆控制系统的设计

1、自动控制理论课程设计倒立摆系统的控制器设计学生姓名： 指导教师： 班 级： 二O一三课程设计指导教师评定成绩表：项目分值优秀(100x90)良好(90x80)中等(80x70)及格(70x60)不及格(x60)评分参考标准参考标准参考标准参考标准参考标准学习态度15学习态度认真，科学作风严谨，严格保证设计时间并按任务书中规定的进度开展各项工作学习态度比较认真，科学作风良好，能按期圆满完成任务书规定的任务学习态度尚好，遵守组织纪律，基本保证设计时间，按期完成各项工作学习态度尚可，能遵守组织纪律，能按期完成任务学习马虎，纪律涣散，工作作风不严谨,不能保证设计时间和进度技术水平与实际能力25设计合理

2、、理论分析与计算正确，实验数据准确，有很强的实际动手能力、经济分析能力和计算机应用能力，文献查阅能力强、引用合理、调查调研非常合理、可信设计合理、理论分析与计算正确，实验数据比较准确，有较强的实际动手能力、经济分析能力和计算机应用能力，文献引用、调查调研比较合理、可信设计合理，理论分析与计算基本正确，实验数据比较准确，有一定的实际动手能力，主要文献引用、调查调研比较可信设计基本合理，理论分析与计算无大错，实验数据无大错设计不合理，理论分析与计算有原则错误，实验数据不可靠，实际动手能力差，文献引用、调查调研有较大的问题创新10有重大改进或独特见解，有一定实用价值有较大改进或新颖的见解，实用性尚可

3、有一定改进或新的见解有一定见解观念陈旧论文(计算书、图纸)撰写质量50结构严谨，逻辑性强，层次清晰，语言准确，文字流畅，完全符合规范化要求，书写工整或用计算机打印成文；图纸非常工整、清晰结构合理，符合逻辑，文章层次分明，语言准确，文字流畅，符合规范化要求，书写工整或用计算机打印成文；图纸工整、清晰结构合理，层次较为分明，文理通顺，基本达到规范化要求，书写比较工整；图纸比较工整、清晰结构基本合理，逻辑基本清楚，文字尚通顺，勉强达到规范化要求；图纸比较工整内容空泛，结构混乱，文字表达不清，错别字较多，达不到规范化要求；图纸不工整或不清晰指导教师评定成绩：指导教师签名： 年 月 日重庆大学本科学生课

4、程设计任务书课程设计题目倒立摆系统的控制器设计学院自动化学院专业自动化年级2010级1、已知参数和设计要求：M：小车质量1.096kgm：摆杆质量0.109kgb：小车摩擦系数0.1N/secl：摆杆转动轴心到杆质心的长度0.25mI：摆杆惯量0.0034kgm2建立以小车加速度为系统输入，以摆杆角度为系统输出的被控对象数学模型。分别用根轨迹法、频率特性法设计控制器使闭环系统满足要求的性能指标；调整PID控制器参数，使闭环系统满足要求的性能指标。2、利用根轨迹法设计控制器，使得校正后系统的性能指标满足：调整时间最大超调量3、利用频率特性法设计控制器，使得校正后系统的性能指标满足：(1) 系统的

5、静态位置误差常数为10；(2) 相位裕量为 50；(3) 增益裕量等于或大于10dB。4、设计或调整PID控制器参数，使得校正后系统的性能指标满足：调整时间最大超调量学生应完成的工作：1、利用设计指示书中的实际参数，通过机理推导，建立倒立摆系统的实际数学模型。2、进行开环系统的时域分析。3、利用根轨迹法设计控制器，进行闭环系统的仿真分析。4、利用频域法设计控制器，进行闭环系统的仿真分析。5、设计或调整PID控制器参数，进行闭环系统的仿真分析。6、将所设计的控制器在倒立摆系统上进行实时控制实验。7、完成课程设计报告。参考资料：1、固高科技有限公司.直线倒立摆安装与使用手册R1.0，20052、固

6、高科技有限公司. 固高MATLAB实时控制软件用户手册，20053、Matlab/Simulink相关资料4、谢昭莉，李良筑，杨欣. 自动控制原理. 北京：机械工业出版社，20125、胡寿松. 自动控制原理（第五版）. 北京：科学出版社，20076、Katsuhiko Ogata. 现代控制工程. 北京：电子工业出版社，2003课程设计的工作计划：1、布置课程设计任务；消化课程设计内容，查阅并参考相关资料，进行初步设计（3天）；2、按课程设计的要求进行详细设计（3天）；3、进行实时控制实验，并按课程设计的规范要求撰写设计报告（3天）；4、课程设计答辩，实时控制验证（1天）。任务下达日期 201

7、2 年 12 月 24 日完成日期 2013 年 1 月 6 日指导教师 （签名）学 生 （签名）IV倒立摆系统的控制器设计目录一、倒立摆控制系统概述2二、数学模型的建立3三、系统开环响应分析4四、根轨迹法控制器设计54.1 根轨迹分析54.2 系统根轨迹设计64.3 校正后系统性能分析84.4 系统控制器的调整8五、频域法控制器设计105.1 频域法分析105.2 串联校正器的选择与设计105.3 系统的仿真13六、PID控制器设计14七、总结及心得体会16八、参考教材16一、倒立摆控制系统概述倒立摆装置被公认为自动控制理论中的典型实验设备，也是控制理论教学和科研中控对象，运用控制手段可使之

8、具有良好的稳定性。通过对倒立摆系统的研究，不仅可以解决控制中的理论问题，还能将控制理论所涉及的三个基础学科：力学、数学和电学（含计算机）有机的结合起来，在倒立摆系统中进行综合应用。在多种控制理论与方法的研究和应用中，特别是在工程实践中，也存在一种可行性的试验问题，将其理论和方法得到有效的经验，倒立摆为此提供一个从控制理论通往实践的桥梁。 在稳定性控制问题上，倒立摆既具有普遍性又具有典型性。倒立摆系统作为一个控制装置，结构简单、价格低廉，便于模拟和数字实现多种不同的控制方法，作为一个被控对象，它是一个高阶次、不稳定、多变量、非线性、强耦合的快速系统，只有采用行之有效的控制策略，才能使其稳定。倒立

9、摆系统可以用多种理论和方法来实现其稳定控制，如PID、自适应、状态反馈、智能控制、模糊控制及人工神经元网络等多种理论和方法，都能在倒立摆系统控制上得到实现，而且当一种新的控制理论和方法提出以后，在不能用理论加以严格证明时，可以考虑通过倒立摆装置来验证其正确性和实用性。 倒立摆的种类：悬挂式、直线、环形、平面倒立摆等。一级、二级、三级、四级乃至多级倒立摆。倒立摆控制系统的组成：倒立摆系统由倒立摆本体，电控箱以及控制平台（包括运动控制卡和PC机）三大部分组成。本次课程设计利用单级倒立摆，主要设计PC机内控制函数，减小超调量和调节时间！二、数学模型的建立 系统建模可以分为两种：机理建模和实验建模。对

10、于倒立摆系统，由于其本身是自不稳定的系统，实验建模存在一定的困难。机理建模就是在了解研究对象的运动规律基础上，通过物理、化学等学科的知识和数学手段建立起系统内部变量、输入变量以及输出变量之间的数学关系。图 1 直线一级倒立摆系统 M 小车质量1.096 Kg m 摆杆质量0.109 Kg b 小车摩擦系数0.1N/m/sec l 摆杆转动轴心到质心长度0.25m I 摆杆惯量0.0034 kgm2 F 加在小车上的力 x 小车位置 f 摆杆与垂直向上方向的夹角 q 摆杆与垂直向下方向的夹角图 2小车及摆杆受力分析- N 和P 为小车与摆杆相互作用力的水平和垂直方向的分量小车水平方向的合力：Mx

11、 =F bx -N 摆杆水平方向的合力：N =m d2dt2x+sin = mx +mlcos -ml2sin摆杆水平方向的运动方程：M+mx +bx +mlcos-mlsin=F摆杆力矩平衡方程：-Plsin -Nlsin=I摆杆垂直方向的合力：P-mg=md2dt2lcos=-mlsin-mlcos摆杆垂直方向的运动方程：I+ml2+mglsin=-mlxcos用u 来代表被控对象的输入力F，线性化后，两个运动方程如下(其中 =+ )：I+Ml2-mgl=mlxM+mx+bx-ml=u如果令a=x进行拉普拉斯变换，得到摆杆角度和小车加速度之间的传递函数：把实际参数带入可得系统的实际模型为：

12、三、系统开环响应分析我们已经得到系统的实际模型，下面对其进行单位阶跃响应分析，在MATLAB中输入以下程序：M = 0.5;m = 0.2;b = 0.1;I= 0.006;g = 9.8;l = 0.3;q = (M+m )*( I+m*l2)-(m*l)2; num = m*l/q 0 0;den = 1 b*(I+m*l2)/q -(M+m)*m*g*l/q -b*m*g*l/q 0;t = 0 : 0.05 : 5;impulse( num , den , t );axis ( 0 1 0 60 );可以得到小车位置与加速度实际模型的单位阶跃响应如图3：图 3 系统的单位阶跃响应曲线由

13、图可知，在进行校正之前，小车的单位阶跃响应是发散的，倒立摆系统不稳定！四、根轨迹法控制器设计4.1 根轨迹分析上面已经得到系统被控对象的传递函数：在MATLAB中输入以下程序：clear all;clc;num =0.02725 ;den =0.0102125 0 -0.26705;rlocus (num,den)；图 Error! Main Document Only. 系统根轨迹图运行程序后便得到控制系统开环传递函数的根轨迹图。由图4我们知道系统有两个开环极点：P1=-5.1136 P2=5.1136可以看出一个极点位于右半平面，并且有一条根轨迹起始于该极点，并沿着实轴向左跑到位于原点的零

14、点处，这意味着无论增益如何变化，这条根轨迹总是位于右半平面，即系统总是不稳定的。4.2 系统根轨迹设计开环传递函数为：根轨迹设计的要求为：最大超调亮：p%10%调整时间：ts=0.5s(2%误差带)1）根据要求的性能指标，计算出校正后闭环主导极点Sd的坐标。由p%=e-1-210%,计算出0.6考虑到非主导极点和闭环零点的影响，设计时的取值应留有余量。取=0.78，=cos-1=39。，再由ts=0.5s得n=11.54rads。期望闭环主导极点s1,2=-njn1-2=-9j7.22,为校正的开环传递函数G0S=0.027250.0102125s2-0.26705G0s1=0.027250.

15、0102125s2-0.26705|s1=0.02725-0.392+j0.729-0.1426+j0.729=89。2）画出未校正系统的根轨迹图及标明sd观察发现为校正系统的根轨迹并不经过期望的闭环主导极点，如果想要校正后的根轨迹经过该点，需要增加校正网络。3）计算超前校正网络应提供的超前相角c。c=180。-G0s1=180。-89。=91。 4）计算角、zc和pc：=12-c=25。zc=nsinsin+c=5.426pc=nsin+csin=24.54故校正网络的传递函数为：Gcs=s+5.426s+24.54该校正网络使校正后的开环传递函数满足了希望极点是根轨迹上的点的相角条件。5）

16、为了使校正后的传递函数满足幅值条件，应当串入一个kc，开环传递函数为：kcGcsG0s由幅值条件 |kcGcsG0s|s1=1 即可求得kc。在MATLAB里面键入以下程序：s=-9+7.22*if1=abs(s+5.246)f2=abs(s+24.54)f3=abs(0.0102125*s2-0.26705)solve(k*f1*0.02725/(f2*f3)=1)；解得kc=1076）于是系统的校正网络传递函数为：kcGcs=107s+5.426s+24.544.3 校正后系统性能分析在Simulink中进行系统仿真，得到校正后系统单位阶跃响应为：图 5校正后系统的单位阶跃响应计算超调量：

17、p%=3.9% 满足要求计算调节时间：ts=0.524s 不满足要求计算结果表明，校正后系统的超调亮满足要求，但是调节时间不满足要求，并且稳态误差过大。4.4 系统控制器的调整调整kc至220，进行仿真，得到系统单位阶跃响应如图6 所示：图 6调整增益后的系统单位阶跃响应同时进行零极点调整，最后得出满足条件的零极点及增益为：kc=900, zc=6, pc=80满足条件的控制器单位阶跃响应为：图 6满足条件的单位阶跃响应超调量：p%=5.3%满足要求调节时间：ts=0.28s 满足要求稳态误差：17% 以上结果均满足设计要求。五、频域法控制器设计5.1 频域法分析一级倒立摆实际模型的开环传递函

18、数为：在MATLAB中输入以下程序：clear all;clc;num = 0.02725;den =0.0102125 0 -0.26705;G = tf(num,den);figure;margin(G);grid on;得到校正前系统的bode图为：图 Error! Main Document Only. 未校正系统的bode图由图可以看出，系统的bode图不经过0dB线，系统不稳定，需要增加串联校正环节。5.2 串联校正器的选择与设计系统开环传递函数：频域法设计要求：系统的静态位置误差常数为：10相位裕量为：50。增益裕量等于或者大于10分贝控制器设计：1）对比bode图和系统频域设计

19、的要求，我们可以看出，只需要给系统增加一个超前校正装置即可使校正后的系统满足频域设计要求。设超前校正装置为：GCs=KTs+1Ts+1设计要求校正后的静态位置误差常数为10，所以：Kp=lims0G0sGcsHs=10解得 K=982）将K带入校正前的开环传递函数，利用MATLAB画出系统的bode图，从图中获取校正前系统的相角裕量为：=0。3）计算超前校正装置应提供的最大相角：m=-+5。10。=55。式中为性能指标要求的相角裕量，为原系统的相角裕量，增加5。10。是为了补偿因增加超前校正装置使开环截止频率右移而造成的相位下降4）计算超前校正装置参数。=1+sinm1-sinm=10.065

20、）确定系统校正后的截止频率c 。截止频率就是对应期望相角裕量的频率c。即在校正前的对数幅频特性bode图中，对数幅频特性L=-10log10时，对应的频率就是系统超前校正后的截止频率c，求得c=28.3 如图示：图8 校正前系统bode图求c6）计算超前校正装置的例外一个参数T。T=1c=0.0117）确定校正装置的传递函数：Gcs=Ts+1Ts+1=0.11s+10.011s+18)画出校正后系统的bode图，在MATLAB中输入以下程序：clear all;num1=0.11 1;num2=2.6705num=conv(num1,num2);den1=0.011 1;den2=0.0102

21、125 0 -0.267005;den=conv(den1,den2);G=tf(num,den);figure;Margin;grid on ;图 10 校正后系统的bode图由图可以看出，校正后系统的复制频率特性过0db线，幅值裕量和相角裕量都满足条件要求。5.3 系统的仿真在Simulink中进行校正后系统的仿真，如图所示：图 11 校正后系统的单位阶跃响应由图可以看出，校正后系统的稳态误差为：11% 超调亮和调节时间都满足要求。因此频域法超前校正成功。六、PID控制器设计PID控制器是比例-微分-积分控制器的简称。在生产过程自动化的发展历程中，从20世纪40年代之前至今，PID控制是久用不衰、生命力最强的基本控制规律。它原理简单，使用方便，适用性强，广泛应用于生产过程的各个领域，PID控制的控制品质对被控对象特性的变化不敏感，因此在自动控制系统中，首先想到的基本控制规律就是PID控制。控制器中微分控制作用可以减小响应过程中的动态偏差，缩短调节时间，积分作用的特点是消除稳态误差，但将使响应曲线的动态偏差和调节时间增大，故此采用PID控制。PID 控制并不需要对系统进行精确的分析，因此采用实验的方法对系统进行控制器参数的设置。系统的实际模型：PID控制器设计的基本要求：最大超调亮：p%10