倒立摆控制系统的设计

自动控制理论课程设计倒立摆系统的控制器设计学生姓名：指导教师：班级：二O一三目录TOC\o"1-2"\u一、倒立摆控制系统概述 2二、数学模型的建立 3三、系统开环响应分析 4四、根轨迹法控制器设计 54.1根轨迹分析 54.2系统根轨迹设计 64.3校正后系统性能分析 84.4系统控制器的调整 8五、频域法控制器设计 105.1频域法分析 105.2串联校正器的选择与设计 105.3系统的仿真 13六、PID控制器设计 14七、总结及心得体会 16八、参考教材 16一、倒立摆控制系统概述倒立摆装置被公认为自动控制理论中的典型实验设备，也是控制理论教学和科研中控对象，运用控制手段可使之具有良好的稳定性。通过对倒立摆系统的研究，不仅可以解决控制中的理论问题，还能将控制理论所涉及的三个基础学科：力学、数学和电学（含计算机）有机的结合起来，在倒立摆系统中进行综合应用。在多种控制理论与方法的研究和应用中，特别是在工程实践中，也存在一种可行性的试验问题，将其理论和方法得到有效的经验，倒立摆为此提供一个从控制理论通往实践的桥梁。在稳定性控制问题上，倒立摆既具有普遍性又具有典型性。倒立摆系统作为一个控制装置，结构简单、价格低廉，便于模拟和数字实现多种不同的控制方法，作为一个被控对象，它是一个高阶次、不稳定、多变量、非线性、强耦合的快速系统，只有采用行之有效的控制策略，才能使其稳定。倒立摆系统可以用多种理论和方法来实现其稳定控制，如PID、自适应、状态反馈、智能控制、模糊控制及人工神经元网络等多种理论和方法，都能在倒立摆系统控制上得到实现，而且当一种新的控制理论和方法提出以后，在不能用理论加以严格证明时，可以考虑通过倒立摆装置来验证其正确性和实用性。倒立摆的种类：悬挂式、直线、环形、平面倒立摆等。一级、二级、三级、四级乃至多级倒立摆。倒立摆控制系统的组成：倒立摆系统由倒立摆本体，电控箱以及控制平台（包括运动控制卡和PC机）三大部分组成。本次课程设计利用单级倒立摆，主要设计PC机内控制函数，减小超调量和调节时间！二、数学模型的建立系统建模可以分为两种：机理建模和实验建模。对于倒立摆系统，由于其本身是自不稳定的系统，实验建模存在一定的困难。机理建模就是在了解研究对象的运动规律基础上，通过物理、化学等学科的知识和数学手段建立起系统内部变量、输入变量以及输出变量之间的数学关系。图SEQFigure\*ARABIC1直线一级倒立摆系统M小车质量1.096Kgm摆杆质量0.109Kgb小车摩擦系数0.1N/m/secl摆杆转动轴心到质心长度0.25mI摆杆惯量0.0034kg·m2F加在小车上的力x小车位置摆杆与垂直向上方向的夹角摆杆与垂直向下方向的夹角图SEQFigure\*ARABIC2小车及摆杆受力分析N和P为小车与摆杆相互作用力的水平和垂直方向的分量小车水平方向的合力：Mx摆杆水平方向的合力：N=md2dt摆杆水平方向的运动方程：M+m摆杆力矩平衡方程：-Pl摆杆垂直方向的合力：P-mg=m摆杆垂直方向的运动方程：I+用u来代表被控对象的输入力F，线性化后，两个运动方程如下(其中θ=π+φ)：I+M如果令a=x进行拉普拉斯变换，得到摆杆角度和小车加速度把实际参数带入可得系统的实际模型为：三、系统开环响应分析我们已经得到系统的实际模型，下面对其进行单位阶跃响应分析，在MATLAB中输入以下程序：M=0.5;m=0.2;b=0.1;I=0.006;g=9.8;l=0.3;q=(M+m)*(I+m*l^2)-(m*l)^2;num=[m*l/q00];den=[1b*(I+m*l^2)/q-(M+m)*m*g*l/q-b*m*g*l/q0];t=0:0.05:5;impulse(num,den,t);axis([01060]);可以得到小车位置与加速度实际模型的单位阶跃响应如图3：图SEQFigure\*ARABIC3系统的单位阶跃响应曲线由图可知，在进行校正之前，小车的单位阶跃响应是发散的，倒立摆系统不稳定！四、根轨迹法控制器设计4.1根轨迹分析上面已经得到系统被控对象的传递函数：在MATLAB中输入以下程序：clearall;clc;num=[0.02725];den=[0.01021250-0.26705];rlocus(num,den)；图SEQFigure\*ARABIC图SEQFigure\*ARABIC4系统根轨迹图P1=-5.1136可以看出一个极点位于右半平面，并且有一条根轨迹起始于该极点，并沿着实轴向左跑到位于原点的零点处，这意味着无论增益如何变化，这条根轨迹总是位于右半平面，即系统总是不稳定的。 4.2系统根轨迹设计 开环传递函数为：根轨迹设计的要求为：最大超调亮：σp%≤10%调整时间：ts=0.1）根据要求的性能指标，计算出校正后闭环主导极点Sd由σp%=e-πε1-ε2≤10%,计算出ε≤0.6考虑到非主导极点和闭环零点的影响，设计时ε的取值应留有余量。取ε=0.78， 期望闭环主导极点s1,2=-εω ∠G =892）画出未校正系统的根轨迹图及标明s观察发现为校正系统的根轨迹并不经过期望的闭环主导极点，如果想要校正后的根轨迹经过该点，需要增加校正网络。3）计算超前校正网络应提供的超前相角φcφc=184）计算γ角、zc和pc：γ=zp故校正网络的传递函数为：Gcs=该校正网络使校正后的开环传递函数满足了希望极点是根轨迹上的点的相角条件。5）为了使校正后的传递函数满足幅值条件，应当串入一个kc，开环传递函数为：kcGc由幅值条件|kcGcsG0 s=-9+7.22*if1=abs(s+5.246)f2=abs(s+24.54)f3=abs(0.0102125*s^2-0.26705)solve('k*f1*0.02725/(f2*f3)=1')；解得k6）于是系统的校正网络传递函数为：k4.3校正后系统性能分析在Simulink中进行系统仿真，得到校正后系统单位阶跃响应为：图SEQFigure\*ARABIC5校正后系统的单位阶跃响应计算超调量：σp%=3.9%满足要求计算调节时间：ts计算结果表明，校正后系统的超调亮满足要求，但是调节时间不满足要求，并且稳态误差过大。4.4系统控制器的调整调整kc至220，进行仿真，得到系统单位阶跃响应如图6所示图6调整增益后的系统单位阶跃响应同时进行零极点调整，最后得出满足条件的零极点及增益为：k满足条件的控制器单位阶跃响应为：图SEQFigure\*ARABIC6满足条件的单位阶跃响应超调量：σp调节时间：ts=稳态误差：17%以上结果均满足设计要求。五、频域法控制器设计5.1频域法分析 一级倒立摆实际模型的开环传递函数为：在MATLAB中输入以下程序：clearall;clc;num=[0.02725];den=[0.01021250-0.26705];G=tf(num,den);figure;margin(G);gridon;得到校正前系统的bode图为：图SEQFigure\*ARABIC7图SEQFigure\*ARABIC7未校正系统的bode图5.2串联校正器的选择与设计系统开环传递函数：频域法设计要求：系统的静态位置误差常数为：10相位裕量为：5增益裕量等于或者大于10分贝 控制器设计：1）对比bode图和系统频域设计的要求，我们可以看出，只需要给系统增加一个超前校正装置即可使校正后的系统满足频域设计要求。设超前校正装置为：G设计要求校正后的静态位置误差常数为10，所以：K解得K=982）将K带入校正前的开环传递函数，利用MATLAB画出系统的bode图，从图中获取校正前系统的相角裕量为：γ= 3）计算超前校正装置应提供的最大相角：φm式中γ'为性能指标要求的相角裕量，γ为原系统的相角裕量，增加54）计算超前校正装置参数α。α= 5）确定系统校正后的截止频率ωc截止频率就是对应期望相角裕量γ'的频率ωc’。即在校正前的对数幅频特性bode图中，对数幅频特性Lω=-10图SEQFigure\*ARABIC8校正前系统bode图求ωc’ 6）计算超前校正装置的例外一个参数T。T=7）确定校正装置的传递函数：G8) 画出校正后系统的bode图，在MATLAB中输入以下程序： clearall;num1=[0.111];num2=[2.6705]num=conv(num1,num2);den1=[0.0111];den2=[0.01021250-0.267005];den=conv(den1,den2));G=tf(num,den);figure;Margin;gridon;图10校正后系统的bode图由图可以看出，校正后系统的复制频率特性过0db线，幅值裕量和相角裕量都满足条件要求。5.3系统的仿真 在Simulink中进行校正后系统的仿真，如图所示：图11校正后系统的单位阶跃响应由图可以看出，校正后系统的稳态误差为：11%超调亮和调节时间都满足要求。因此频域法超前校正成功。六、PID控制器设计PID控制器是比例-微分-积分控制器的简称。在生产过程自动化的发展历程中，从20世纪40年代之前至今，PID控制是久用不衰、生命力最强的基本控制规律。它原理简单，使用方便，适用性强，广泛应用于生产过程的各个领域，PID控制的控制品质对被控对象特性的变化不敏感，因此在自动控制系统中，首先想到的基本控制规律就是PID控制。控制器中微分控制作用可以减小响应过程中的动态偏差，缩短调节时间，积分作用的特点是消除稳态误差，但将使响应曲线的动态偏差和调节时间增大，故此采用PID控制。PID控制并不需要对系统进行精确的分析，因此采用实验的方法对系统进行控制器参数的设置。系统的实际模型：PID控制器设计的基本要求：最大超调亮：σ调整时间：ts 在Simulink中建立如图所示的直线一级倒立摆模型：图12Simulink构建PID控制MATLAB仿真模型 在初始值下进行仿真，得到系统的单位阶跃响应：图13KP=1，通过仿真图像我们可以看出，在KP=1，KI图14满足条件的PID控制单位阶跃响应此时系统的稳态误差:0,超调量：14.6%,调节时间：1.25s。满足PID控制器的设计要求。七、总结及心得体会通过这次课程设计，是我对自动控制原理这门课程有了更深刻的理解，将抽象的控制理论运用到实际中去，使我对理论知识的运用能力有了很大的提高，通过观察实际的控制效果，也强化了我对自动控制原理理论知识的掌握。在实际的操作过程中，我认识到，理论上可行的东西在实际的模拟过程中并不一定行得通，要综合考虑所有的误差一级影响然后做正确的判断；同时，在实际操作当中，当结果不满意时，并