倒立摆系统的控制器设计(23页).docx

-倒立摆系统的控制器设计摘要倒立摆是一种典型的非线性，多变量，强耦合，不稳定系统，许多抽象的控制概念如系统的稳定性、可控性、系统的抗干扰能力等都可以通过倒立摆直观的反应出来；倒立摆的控制思想在实际中如实验、教学、科研中也得到广泛的应用；在火箭飞行姿态的控制、人工智能、机器人站立与行走等领域有广阔的开发和利用前景。因此，对倒立摆系统的研究具有十分重要的理论和实践意义。本文首先将直线倒立摆抽象为简单的模型以便于受力分析进行机理建模，然后通过牛顿力学原理进行分析，得出相应的模型，进行拉氏变化带入相应参数得出摆杆角度和小车位移、摆杆角度和小车加速度、摆杆角度和小车所受外界作用力、小车位移与小车所受外界作用力的传递函数，其中摆杆角度和小车加速度之间的传递函数为： (1)即我们在本次设计中主要分析的系统的传递函数。然后从时域角度着手，分析直线一级倒立摆的开环单位阶跃响应和单位脉冲响应，利用Matlab中的Simulink仿真工具进行仿真，得出结论该系统的开环响应是发散的。最后分别利用根轨迹分析法，频域分析法和PID控制法对倒立摆系统进行校正。针对目标一：调整时间，最大超调量，选取参数利用根轨迹法进行校正，得出利用超前校正环节的传递函数为： (2)针对目标二：系统的静态位置误差常数为10；相位裕量为 50°；增益裕量等于或大于10 分贝。通过频域法得出利用超前校正环节的传递函数为： (3)针对目标三： 调整时间，最大超调量，设计或调整PID控制器参数，得出调整后的传递函数为： .(4)关键词：直线一级倒立摆根轨迹分析频域分析PID控制1 倒立摆系统概述1.1倒立摆的种类悬挂式、直线、环形、平面倒立摆等。一级、二级、三级、四级乃至多级倒立摆。1.2系统的组成倒立摆系统由倒立摆本体，电控箱以及控制平台（包括运动控制卡和PC机）三大部分组成。1.3工程背景 机器人的站立与行走类似双倒立摆系统。在火箭等飞行器的飞行过程中为了保持其正确的姿态要不断进行实时控制。通信卫星要保持其稳定的姿态使卫星天线一直指向地球，使它的太阳能电池板一直指向太阳。为了提高侦察卫星中摄像机的摄像质量必须能自动地保持伺服云台的稳定消除震动。多级火箭飞行姿态的控制也可以用多级倒立摆系统进行研究。倒立摆系统是机器人技术、控制理论、计算机控制等多个领域、多种技术的有机结合。2 数学模型的建立2.1牛顿力学法系统分析通过以上假设，将倒立摆抽象为如图所示的系统图 直线一级倒立摆模型 M 小车质量1.096 Kg m 摆杆质量0.109 Kg b 小车摩擦系数0.1N/m/sec l 摆杆转动轴心到质心长度0.25m I 摆杆惯量0.0034 kg·m2 F 加在小车上的力 x 小车位置 f 摆杆与垂直向上方向的夹角 q 摆杆与垂直向下方向的夹角图 小车及摆杆受力分析N 和P 为小车与摆杆相互作用力的水平和垂直方向的分量 。首先对小车水平方向所受的合力和对摆杆水平方向的受力进行分析，得到系统的第一个运动方程。对小车水平方向所受的合力进行分析，得到如下方程： （2-1-1）对摆杆水平方向的受力进行分析，得到如下面方程： （2-1-2）即： （2-1-3）把这个表达式代入式(4-1)中，得到系统的第一个运动方程： （2-1-4）然后通过对摆杆垂直方向上的合力进行分析，得到系统的第二个运动方程。对摆杆垂直方向上的合力进行分析，得到方程如下： （2-1-5） （2-1-6）力矩平衡方程如下： （2-1-7）此方程中力矩的方向，如图所示 , 则，故等式前面有负号。合并这两个方程，约去 P 和N，得到第二个运动方程： （2-1-8）设（是摆杆与垂直向上方向之间的夹角），假设与1（单位是弧度）相比很小，即，则可以进行近似认为。用u 来代表被控对象的输入力F，线性化后两个运动方程如下3： （2-1-9）假设初始条件为0，对式(3-9)进行拉普拉斯变换，得到： （2-1-10）由于输出为角度 ，求解方程组的第一个方程，可以得到： （2-1-11） （2-1-12）令v = x，则有： （2-1-13）把上式代入方程组的第二个运动方程，得到：（2-1-14）整理后得到传递函数： （2-1-15）其中。2.2拉氏变换后实际系统的模型本系统采用以小车的加速度作为系统的输入，把上述参数代入，可以得到系统的实际模型。摆杆角度和小车位移的传递函数：（2-2-1）摆杆角度和小车加速度之间的传递函数为： （2-2-2）摆杆角度和小车所受外界作用力的传递函数： （2-2-3）3 开环响应分析当输入为小车加速度时，分析摆杆角度与小车位置的脉冲响应和阶跃响应。由式（2-2-1）、（2-1-2）或者通过受力分析物理公式均可得到小车位移和小车加速度的传递函数： （3-1）利用Matlab中的Simulink仿真工具进行仿真，仿真系统的结构如图摆杆角度的单位脉冲、阶跃响应，小车位置的单位脉冲、阶跃响应如下图摆杆角度的阶跃响应 摆杆角度的脉冲响应小车位置的阶跃响应 小车位置的脉冲响应从图可知，输入加速度时，摆杆角度及小车位移的阶跃响应和脉冲响应都是发散的。倒立摆系统不稳定，需要进行校正。4 根轨迹法设计4.1校正前倒立摆系统的闭环传递函数的分析本系统采用小车的加速度作为系统的输入，摆杆角度为输出响应，得出的传递函数：即式（2-2-2）。4.2系统稳定性分析在MATLAB中新建一个m文件，并进行编程如下： num=0.02725  den=0.0102125 0 -0.26705; rlocus(num,den) p=roots(den) 保存后运行文件，由结果可知该系统不存在开环零点，仅有两个绝对值相等的开环实极点。并绘制出了未校正系统的根轨迹图如下 可以看出闭环传递函数的一个极点位于右半平面，并且有一条根轨迹起始于该极点，并沿着实轴向左到位于原点的零点处，这说明无论增益如何变化，这条根轨迹总是位于右半平面，即系统总是不稳定的。4.3 根轨迹设计开环传递函数：设计控制器，使得校正后系统的性能指标满足：最大超调量调整时间1、根据性能指标，计算校正后闭环主导极点的坐标。 由于最大超调量：s 有公式 我们可以算出为0.591155，取为0.69。由=得，°。又调节时间为 0.5s（=±2%）取 =0.5s 得=13.043由特征根为s1,2= 得期待闭环主导极点s1,2 =-8.999±9.4406j=101.42°2、计算超前校正网络应提供的超前相角。=180°-101.32°=78.58°3、计算角、和。=27.52°=6.2730 =27.1194 故校正网络的传递函数为： 4、由幅值条件，计算Kc根据幅值条件|=1，可得到Kc=135.07755、控制器的确定得到了系统的超前校正控制器： （4-3-1）6、校正后系统的验证通过MATLAB作图，得校正后根轨迹如图单位阶跃响应如图可知虽然本次校正使系统的性能得到了改善，但是还无法达到我们之前要求到的超调量的性能指标，所以我们需要通过改变校正环节中的各项参数来调整系统，使之能够达到系统设计要求。由于增大超调量会变小，经过多次尝试，发现当时，满足性能指标。其单位阶跃如图4.4 SIMULINK仿真建立仿真模型如下：仿真结果如下：由图可看到，系统的超调量较小，调节时间短，性能指标较好，系统校正成功。5 直线一级倒立摆频域法设计5.1 系统频域响应分析系统对正弦输入信号的响应，称为频率响应。在频率响应方法中，在一定范围内改变输入信号的频率，研究其产生的响应。频率响应可以采用以下两种方法进行分析：一种为伯德图，采用两幅分离图，一幅表示幅频特性，一幅表示相频特性；另一种是奈奎斯特图，表示的是当从0 变化到无穷大时，向量 的矢端轨迹。奈奎斯特稳定判据使我们有可能根据系统的开环频率响应特性信息，研究线性闭环系统的绝对稳定性和相对稳定性。根据式（2-2-2）我们已经得到了直线一级倒立摆的数学模型，实际系统的开环传递函数为：其中输入为小车的加速度,输出为摆杆的角速度。利用Matlab绘制系统的Bode图（图5-1-1）如下。>> s=tf('s');>> G0=0.02725/(0.0102125*s2-0.26705);>> figure;margin(G0)>> grid on图 5-1-1、直线一级倒立摆系统的Bode图图 5-1-2、 直线一级倒立摆系统的Nyquist图根据奈奎斯特稳定判据，由根轨迹法中零点、极点的计算可知：系统不存在零点，但存在两个极点，其中一个极点位于S平面的右半部分，另一个位于S平面的左半部分。根据奈奎斯特稳定判据，闭环系统稳定的充分必要条件是：当由变化时， 曲线逆时针包围平面上点的次数等于开环传递函数右极点个数。对于直线一级倒立摆，由图11和图12可以看出，开环传递函数在S右半平面有一个极点。因此，曲线逆时针包围点的次数。而本系统的奈奎斯特图并没有逆时针包围点一圈即。因此系统不稳定，需要设计控制器来稳定系统。5.2频域法控制器设计5.2.1控制器的选择根据图5-1-1和图5-1-2可以初步观察出，给系统增加一个超前校正就可以满足设计要求，设超前校正装置为： （5-2-1-1）则已校正系统具有开环传递函数，设 （5-2-1-2）其中。5.2.2系统开环增益的计算根据稳态误差要求计算增益 (5-2-2-1）可以得到： （5-2-2-2）于是有： （5-2-2-3）5.2.3校正装置的频率分析利用MATLAB画出的Bode图图 5-2-3-1 校正装置的Bode图可以看出，系统的相位裕量为。表明只是满足稳态误差时的系统不能满足动态性能指标的要求。根据设计要求，系统的相位裕量为，因此需要增加的相位裕量为，增加超前校正装置会改变 Bode 图的幅值曲线，这时增益交界频率会向右移动，必须对增益交界频率增加所造成的的相位滞后增量进行补偿。实际需要增加的相角裕量为55°。计算超前校正网络参数：= （5-2-3-1） （5-2-3-2）在图中找到的点，该点的频率就是校正后系统的截止频率，即，该频率就是超前校正网络最大超前角处对应的频率，也即是系统校正后的截止频率。计算超前校正网络的另一个参数T （5-2-3-4）由此得到的校正装置为：校正后的传递函数为：画出校正后系统的Bode图图 5-2-3-2 校正装置的Bode图图 5-2-3-3 校正装置的Bode图从图5-2-3-2和图5-2-3-3可知，校正后的系统相角裕量和幅值裕量符合设计要求，根据奈奎斯特判据可知校正后的系统稳定。现在分析系统的动态性能是否满足要求。Matlab编程如下：>> num=0.02725*985.782 0.02725*985.782*8.9544;>> den1=0.0102125 0 -0.26705;>> den2=1 90.0901;>> den=conv(den1,den2);>> sys=tf(num,den);>> sys2=feedback(sys,1);>> t=0:0.01:20;>> step(sys2,t)>> axis(0 1 0 2);图 5-2-3-4从图可看到，系统的超调量较大，不理想，因此对其进行调整，经过反复试探和分析，得到较好的参数如下：图 5-2-3-5从图可看到，此时系统的超调量很小，调节时间短，稳定性好，符合设计要求且性能指标良好。该控制器设计成功。5.3 Simulink仿真利用Simulink建立含有利用频域法得到的超前校正装置的系统结构图进行仿真观察系统的响应情况。仿真结构图如下：图 5-3-1仿真结果如下图：图 5-3-2由图能看到校正后系统的稳定性，快速性和准确性都比较好，符合设计要求。6 直线一级倒立摆的PID控制设计6.1 PID简介PID控制器又称PID调节器，是工业过程控制系统中常用的有源校正装置，目前应用比较广泛的主要有电子式PID控制器和气动式PID控制器。在自控原理中，经典控制理论的研究对象主要是单输入单输出的系统，控制器设计时一般需要有关被控对象的较精确模型。但是很多场合下，不能也没有必要对控制系统建立精确的数学模型，这种情况下PID控制器的优势得以显现：结构简单，容易调节，且不需要对系统建立精确的模型，在控制上应用较广。6.2 PID控制设计分析我们注意到，PID控制器6设计之初并不需要对被控系统进行精确的分析。为了突出PID控制的这一优势，我们采用实验的方法对系统进行控制器参数的设置，即在Matlab中利用Simulink仿真测试来确定PID控制器的参数。其系统结构框图如下所示:图 6-2-1 PID控制结构图由于，为了方便查看我们将上图进行转换，转换结果如下。图 6-2-2 PID控制等效结构图该图更加方便我们理解PID控制器的作用，系统的输出为其中各个参数的含义如下：通过分析上式便可以评价PID控制器控制的效果，进而得出系统性能的相关指标。主要依据图像所反映出系统性能的欠缺进行有针对性的调节，其中P反映误差信号的瞬时值大小，改变快速性；I反映误差信号的累计值，改变准确性；D反映误差信号的变化趋势，改变平稳性。PID的调节是根据现在的性能指标，和PID三个参数调节的意义进行的调节。（1）、比例P控制器 比例系数 减小，将使系统的平稳性得到改善。但是系统的上升时间变成且系统的稳态精度变差。增大比例系数可以提高系统的稳态精度但是牺牲了系统的平稳性和快速性。（2）、PD控制器选择合适的Td的值，串联PD控制器可以提高系统的平稳性，加快系统的响应速度，串联的PD校正实际上是对系统的串联超前校正，这样容易放大高频噪声，抗干扰能力下降。（3）、PI控制器串联PI控制器后是校正后系统成为有一个左实数的零点n+1阶的系统，此外系统的性别提高，能够改善系统过得稳态精度，其中Ti越小积分作用越强。系统的平稳性会越差。PI通常是用于改善系统的稳态性能。6.3 PID控制器的参数测定通过刚刚的分析，我们已经得出了PID控制系统的传递函数如式。（6-3-1）在Simulink环境中建立PID控制模型，之后可以根据8.2中提到的控制规律进行参数选取，进而求得合适的参数。图 6-3-1 PID控制系统仿真结构图双击PID控制器，选择参数进行仿真。经过多次参数选取，得到了比较合适的参数，如图6-3-2。图6-3-2、 PID参数选择仿真结果如图所示:图6-3-3、PID调节后的阶跃响应图得到相应的指标，符合要求。控制效果比较理想，PID控制器的传递函数为（6-3-2）此外，还可以通过在根轨迹中增加零极点，借助SISO工具进行PID控制器的参数的选择。7 总结与体会7.1总结 本次课程设计主要是通过对倒立摆的受力分析建立相应的数学模型，首先分析系统的稳定性，然后通过自己在课堂上所学的校正方法对系统进行校正。校正方法有很多种，本文中主要选用超前校正装置，并对在本文中分别用根轨迹法和频域法对超前校正装置进行设置，得到相应的参数。再用MATLAB绘图和Simulink仿真进行指标的检验，均符合设计要求。最后尝试用PID进行校正，理解PID装置校正的作用的同时，得到了符合要求的参数。7.2体会通过这次为期两周的课程设计，我学会了用理论指导实践，将自己在课堂和实验课上所学到的关于自动控制理论的知识运用到了课程设计当中。在课程设计中，培养了自己的刻苦钻研、对专业知识运用以及独立创新的能力，为自己以后在学习和工作中打下了良好的基础。完成此次课程设计，使我受益匪浅。经过一周的时间，随着我对此系统深入的思考，我学会了如何运用自己所学的知识结合实际进行设计，锻炼了自己的专业技能。本次课程设计令我收获最大的就是掌握了MATLAB的应用，它可以利用你输入的函数直观的绘制出波特图和奈奎斯特图进行判断我们设计的控制器是否符合要求，还可以使用SIMULINK将设计的传递函数进行仿真，通过曲线反映出此函数的校正能力。这对今后的学习和工作有很大的帮助。其实这次课程设计的时间安排非常紧张，在课程设计和考试安排在了一起的情况下，课程设计对我来说难度很大，但是我和同学们还是利用不复习上课的时间钻研这个课题，经过同学们的讨论，老师的耐心讲解，我们一步一步的完成系统设计，调参数，这个过程让我知道即使困难是无处不有的，但是只要我们用心去解决，虚心请教，困难就不再是困难，而是我们通往成功之路上一片风景。参考文献1 张宁 直线一级倒立摆的起摆与稳摆控制的优化与改进 2 固高科技有限公司.直线倒立摆安装与使用手册R1.0,20053 固高科技有限公司. 倒立摆与自动控制原理实验,20054 王正林 Matlab Simulink与控制系统仿真5 涂植英，陈今润.自动控制原理.重庆:重庆大学出版社,20056 胡寿松.自动控制原理.北京:科学出版社,2001-第 - 2 - 页目录摘 要- 5 -1 倒立摆系统概述- 6 -1.1倒立摆的种类- 6 -1.2系统的组成- 6 -1.3工程背景- 6 -2 数学模型的建立- 7 -2.1牛顿力学法系统分析- 7 -2.2拉氏变换后实际系统的模型- 10 -3 开环响应分析- 11 -4 根轨迹法设计- 13 -4.1校正前倒立摆系统的闭环传递函数的分析- 13 -4.2系统稳定性分析- 13 -4.3 根轨迹设计- 14 -4.4 SIMULINK仿真- 17 -5 直线一级倒立摆频域法设计- 18 -5.1 系统频域响应分析- 18 -5.2频域法控制器设计- 19 -5.2.1控制器的选择- 19 -5.2.2系统开环增益的计算- 20 -5.2.3校正装置的频率分析- 20 -5.3 Simulink仿真- 24 -6 直线一级倒立摆的PID控制设计- 25 -6.1 PID简介- 25 -6.2 PID控制设计分析- 25 -6.3 PID控制器的参数测定- 26 -7 总结与体会- 29 -7.1总结- 29 -7.2体会- 29 -参考文献- 30 -