2022年倒立摆控制系统设计报告 .pdf

《2022年倒立摆控制系统设计报告 .pdf》由会员分享，可在线阅读，更多相关《2022年倒立摆控制系统设计报告 .pdf（37页珍藏版）》请在淘文阁 - 分享文档赚钱的网站上搜索。

1、北京石油化工学院BEIJING INSTITUTE OF PETROCHEMICAL TECHNOLOGY 课程设计用纸控制系统综合设计倒立摆控制系统院（系、部） ：组长：组员班级：指 导 教 师：2014年 1月 2 日星期四名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 1 页，共 37 页 - - - - - - - - - 北京石油化工学院BEIJING INSTITUTE OF PETROCHEMICAL TECHNOLOGY 课程设计用纸1 目录摘要 -3 引言 -3 一

2、、整体方案设计-3 1、需求 -3 2、目标 -3 3、概念设计 -3 4、整体开发方案设计-3 5、评估 -4 二、系统设计 -4 （一）系统设计-4 1、功能分析 -4 2、设计规范和约束-6 3、详细设计 -7 （二） 机械系统设计 -8三、理论分析 -9 1、控制系统建模-9 2、时域和频域分析-13 3、设计 PID或其他控制器 -21 四、元器件、设备选型-30 名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 2 页，共 37 页 - - - - - - - - - 北京

3、石油化工学院BEIJING INSTITUTE OF PETROCHEMICAL TECHNOLOGY 课程设计用纸2 五、加工制作 -33 1、加工图纸 -38 2、材料选择 -38 3、加工方案 -38 六、安装调试 -38 七、经济性分析-39 八、结论 -39 1、课程设计总结-39 2、感悟和体会 -39 3、致谢 -40 九、参考文献 -40名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 3 页，共 37 页 - - - - - - - - - 北京石油化工学院BEIJI

4、NG INSTITUTE OF PETROCHEMICAL TECHNOLOGY 课程设计用纸3 倒立摆控制系统设计摘要：在稳定性控制问题上，倒立摆既具有普遍性又具有典型性。倒立摆系统作为一个控制装置，结构简单，便于实现多种不同类型的控制方法，作为一个被控对象，它是一个高阶次、不稳定、多变量、非线性、强耦合的快速系统，只有采用行之有效的控制策略，才能使其稳定。本文采用频率响应控制方式和PID 控制方式对倒立摆的控制过程进行分析和研究，最终使倒立摆立起并保证其稳定。关键词：倒立摆最优控制 PID调节频率响应引言：自动控制理论在当前的工程技术界，主要解决如何面向工程的实际应用问题。一项工程的实施也

5、存在一种可行性的试验问题，因而，用一套较好的、较完备的试验设备，将其理论及方法进行有效的检验是极其重要的。倒立摆装置被公认为自动控制理论中的典型实验设备，也是控制理论教学和科研中的被控对象，运用控制手段可使之具有良好的稳定性。因此说，倒立摆为科技研究提供了一个从控制理论通往实践的桥梁。一整体方案设计1、需求随着科学技术的不断进步，人们在生产和生活中越来越注重事物的精确性，因此， 不确定因素就开始引起人们的广泛关注。提及不确定性，控制领域的人都会想起倒立摆系统，因为倒立摆系统是典型的多变量、非线性、不稳定系统，通过对它的研究，能有效的反映出许多抽象的控制理论及概念。 其控制方法在军事、航空航天、

6、机器人和一般工业过程领域中都有着广泛的用途，如机器人行走过程中的平衡控制、火箭发射中的垂直度控制和卫星飞行中的姿态控制等。目前，倒立摆已经成为控制领域的一项热门研究。2、目标倒立摆的控制问题就是使摆杆尽快地达到一个平衡位置，并且使之没有大的振荡、过大的角度和速度。当摆杆到达期望的位置后，系统能克服随机扰动而保持稳定的位置。3、概念设计倒立摆是一个非线性、不稳定系统 , 经常作为研究比较不同控制方法的典型例子。设计一个倒立摆的控制系统，使倒立摆这样一个不稳定的被控对象在引入适当的控制策略的基础上而成为一个能够满足各种性能指标的稳定系统。4、整体开发方案设计通过对倒立摆物理模型的分析，建立倒立摆的

7、动力学模型，然后使用状态空间理论，推导出其非线性模型，再在平衡点处进行线性化，得到倒立摆的状态方程和输出方程，再设计出PID 控制器名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 4 页，共 37 页 - - - - - - - - - 北京石油化工学院BEIJING INSTITUTE OF PETROCHEMICAL TECHNOLOGY 课程设计用纸4 实现对其的控制。 实验参数自己选定， 但要合理， 符合实际情况， 使用模糊控制方式，并利用 MATLAB软件，用simulin

8、k对相应的模块进行仿真。5、评估对自然不稳定物体，人为地施加一定的控制手段，使之稳定，达到人们的需求。这正是倒立摆的控制思想，不仅如此，日常生活中，所有重心在上、支点在下的物体的控制思想都源于此。一般而言，对倒立摆的控制目的就是通过控制力F 的作用，使小车左右运动，从而带动摆杆的摆动，将单摆控制在倒立点附近，在这样的单摆系统中，摆杆的平衡位置有两个，一个是自然下垂位置，另一个是竖直向上的倒立位置，因此倒立点是一个不稳定的平衡位置，摆杆一旦偏离倒立点，即使很小的角度，也会使整个系统失去平衡。二系统设计（一）1、功能分析（1） 被控对象倒立摆的被控对象为摆杆和小车。摆杆通过铰链连接在小车上，并可以

9、围绕连接轴自由旋转。通过给小车施加适当的力可以将摆杆直立起来并保持稳定的状态。（2） 传感器倒立摆系统中的传感器为光电编码盘。旋转编码器是一种角位移传感器，它分为光电式、接触式和电磁感应式三种，本系统用到的就是光电式增量编码器。光电编码器外观、剖面图和原理示意图图为光电式增量编码器示意图，它由发光元件、光电码盘、光敏元件和信号处理电路组成。当码盘随工作轴一起转动时，光源透过光电码盘上的光栏板形成忽明忽暗的光信号，光敏元件把光信号转换成电信号，然后通过信号处理电路的整形、放大、分频、记数、译码后输出。名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - -

10、 - - - - 名师精心整理 - - - - - - - 第 5 页，共 37 页 - - - - - - - - - 北京石油化工学院BEIJING INSTITUTE OF PETROCHEMICAL TECHNOLOGY 课程设计用纸5 光电式增量编码器的测量精度取决于它所能分辨的最小角度 ， 而这与码盘圆周内所分狭缝的线数有关： =360 / n， 其中n为编码器线数。对于线数为n的编码器，设信号采集卡倍频数为m ，则有角度换算关系为= 360N/n? m，式中 为编码器轴转角，N 为编码器读数。对于电机编码器，在倒立摆使用中需要把编码器读数转化为小车的水平位置，因此l =180 N

11、/n? m式中l 为小车位移， 为同步带轮直径。（3）电控箱：电控箱内安装有以下主要部件：1）交流伺服驱动器;2)I/O接口板： 3）开关电源： 4）开关、等电器元件（4） 执行机构倒立摆系统的执行机构为松下伺服电机和与之连接的皮带轮。电机的转矩和速度通过皮带轮传送到小车上，从而带动小车的运动。电机的驱动由与其配套的伺服驱动器提供。松下伺服电机及其驱动器如图所示。名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 6 页，共 37 页 - - - - - - - - - 北京石油化工学院

12、BEIJING INSTITUTE OF PETROCHEMICAL TECHNOLOGY 课程设计用纸6 电机的控制是通过固高公司的GT 系列运动控制器（见图）实现的。该控制器可以同步控制四个运动轴， 实现多轴协调运动。运动控制器以计算机为主机，提供标准的 ISA 总线或 PCI 总线接口，并且可以提供RS232 串行通讯和 PC104 通讯接口。运动控制器同时具有A/D 信号采集功能，从而能够将光电编码盘的信号传递到计算机。2、设计规范和约束用现代控制理论中的状态反馈方法来实现倒立摆系统的控制，就是设法调整闭环系统的极点分布，以构成闭环稳定的倒立摆系统，它的局限性是显而易见的。只要偏离平衡

13、位置较远，系统就成了非线性系统，状态反馈就难以控制。实际上，用线性化模型进行极点配置求得的状态反馈阵，不一定能使倒立摆稳定竖起来，能使倒立摆竖立起来的状态反馈阵是实际调试出来的，这个调试出来的状态反馈阵肯定满足极点配置。这就是说，满足稳定极点配置的状态反馈阵很多，而能使倒立摆稳定竖立的状态反馈阵只有很少的一个范围，这个范围要花大量的时间去寻找。3、详细设计名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 7 页，共 37 页 - - - - - - - - - 北京石油化工学院BEIJ

14、ING INSTITUTE OF PETROCHEMICAL TECHNOLOGY 课程设计用纸7 原料清单：器件名称单价 / 加工费用数量倒立摆基座100元1角编码器520元1松下伺服电机2700元1滑杆25元2摆杆15元1小车160元1同步带28元1限位开关2元2带轮50元2运动控制器6300元1带轮基座65元2滑杆基座50元2电线拖链30元1设计原型：产品分析：我们所使用的是固高科技直线二级倒立摆，型号为GLIP2002 ，它具有工业化、模块化、开放性和创新性的特点。工业化即它的机械结构是按照工业标准设计及制造，所有产品零部件均采用工业级产品；模块化即只需增减摆杆组件就可实现同类倒立摆单

15、级与多级之间的转换，不同类别倒立摆的转换只需要更换基座；开放性是指基于PC 和 DSP 运动控制器的开放式硬件控制平台，固高Simulink通用软件实验平台，可直接对系统进行建模、仿真和实际控制；创新性即随意配置独具个性的实验平台，开发和验证自己的控制算法。名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 8 页，共 37 页 - - - - - - - - - 北京石油化工学院BEIJING INSTITUTE OF PETROCHEMICAL TECHNOLOGY 课程设计用纸8

16、（二）机械系统设计倒立摆系统中的计算机、运动控制卡、伺服驱动器、倒立摆本体（包含摆杆、小车、伺服电机、光电码盘）几大部分组成了下图所示的一个闭环系统。倒立摆系统框图倒立摆硬件组成方框图光电码盘 1 将小车的位移、 速度信号反馈给伺服驱动器和运动控制卡，而光电码盘 2 将摆杆的位置、速度信号反馈回控制卡。计算机从运动控制卡中读取实时数据，确定控制决策（小车向哪个方向移动、移动速度、加速度等），并由运动控制卡来实现该控制决策，产生相应的控制量，使电机转动，带动小车运动，保持摆杆平衡。名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名

17、师精心整理 - - - - - - - 第 9 页，共 37 页 - - - - - - - - - 北京石油化工学院BEIJING INSTITUTE OF PETROCHEMICAL TECHNOLOGY 课程设计用纸9 三理论分析1、控制系统建模微分方程的推导：在忽略了空气阻力，各种摩擦之后， 可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统，如下图 4.1 所示。我们不妨做以下假设：M 小车质量m 摆杆质量b 小车摩擦系数l 摆杆转动轴心到杆质心的长度I 摆杆惯量F 加在小车上的力x 小车位置 摆杆与垂直向上方向的夹角 摆杆与垂直向下方向的夹角（考虑到摆杆初始位置为竖直向下）下图是系

18、统中小车和摆杆的受力分析图。其中，N和P为小车与摆杆相互作用力的水平和垂直方向的分量。倒立摆模型受力分析图图 4.1 直线一级倒立摆系统名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 10 页，共 37 页 - - - - - - - - - 北京石油化工学院BEIJING INSTITUTE OF PETROCHEMICAL TECHNOLOGY 课程设计用纸10 注意：在实际倒立摆系统中检测和执行装置的正负方向已经完全确定，因而矢量方向定义如图所示，图示方向为矢量正方向分析小车水

19、平方向所受的合力，可以得到以下方程：.NxbFxM对摆杆水平方向的受力进行分析可以得到下面等式：)sin(22lxdtdmN把这个等式代入上式中，就得到系统的第一个运动方程：FmlmlxbxmMsincos)(2.为了推出系统的第二个运动方程，我们对摆杆垂直方向上的合力进行分析，可以得到下面方程：)cos(22ldtdmmgP力矩平衡方程如下：.cossinINlPl注意： 此方程中力矩的方向，由于 =+?，cos ?=-cos ,sin ?=-sin , 故等式前面有负号。合并这两个方程，约去和，得到第二个运动方程：cossin)(.2xmlmglmlI设（是摆杆与垂直向上方向之间的夹角），

20、假设与1（单位是弧度）相比很小，即1，则可以进行近似处理：1cos，sin，0)(2dtd，用u来代表被控对象的输入力 F，线性化后两个运动方程如下: umlxbxmMxmlmglmlI.2)()(令a=.x, 拉氏变换后为)()()()(22smlVsmgssmlI角度与加速度之间传递函数为：mglsmlImlSVs22)()()(对方程组 (1.3) 进行拉普拉斯变换，得到 : 名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 11 页，共 37 页 - - - - - - - -

21、 - 北京石油化工学院BEIJING INSTITUTE OF PETROCHEMICAL TECHNOLOGY 课程设计用纸11 )()()()()()()()(222.22sUssmlssbXssXmMssmlXmglssmlI把方程组化简得到一级倒立摆的传递函数为: sqbmglsqmglmMsqmlIbssqmlsUs23)242)()()(其中 q=(M+m)(I+ml2)-(ml)2 实际系统的模型参数如下: M 小车质量 1.096 Kg m 摆杆质量 0.109 Kg b 小车摩擦系数 0 .1N/m/sec l 摆杆转动轴心到杆质心的长度 0.2 5m I 摆杆惯量 0.00

22、34 kg*m*m T 采样频率 0.005 秒校正前系统动态性能分析:mglsmlImlsG220)()(将参数值带入得到系统开环传递函数为26705.00102125.002725.0)(20ssG起摆时系统建模名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 12 页，共 37 页 - - - - - - - - - 北京石油化工学院BEIJING INSTITUTE OF PETROCHEMICAL TECHNOLOGY 课程设计用纸12 起摆演示操作模块采用能量控制策略和时间

23、最优控制法来实现倒立摆的起摆控制。摆杆的初始位置是自然下垂状态，要使摆杆从初始位置起摆直到竖直向上位置，且速度减少到0，所需的能量为mg lE20而倒立摆系统在任意角度时的能量为)1(cos21.2mglIE对其求微分可得：cossin.mulmglIdtdE由于倒立摆本身系统特点，刚开始运动的摆杆具有摆动能量小于2mgl，只有经过能量反馈，调整小车的加速度，从而增加摆杆的摆动能量，最终达到mgl2。能量反馈表达式为：)(0EEku其中， K为系数。摆杆相对于初始位置有四种不同运动状态，如下：（1）0,.0 (2)0,.0 (3)0,.0 (4)0,.0 当cos.为负时，u应该为正。名师资料

24、总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 13 页，共 37 页 - - - - - - - - - 北京石油化工学院BEIJING INSTITUTE OF PETROCHEMICAL TECHNOLOGY 课程设计用纸13 应用李雅普夫方法我们可以得到控制策略。可设李雅普诺夫函数为：20)(21EEV令控制策略为：cos)(.0EEku可以得到：2.0.00)cos)(cos)()(EEmlkmulEEdtdEEEdtdV只要0.并且0cos，则就有0dtdV。虽然在2是摆杆不能控

25、，但是由于摆杆在该位置并不是稳定点，因此将能量E带到0E。为使能量尽快增加，则控制量的幅值需要尽可能大，因此可采用控制策略)cos()(.0signEEksatung其中ngsat代表以ng为限幅的线性函数，()sign为符号函数，且有由上可以看出，摆杆自然下垂时，或系统具有的能量为-mgl2，处于稳定竖直向上的状态时0，所以当摆杆从自然下垂状态开始起摆时，u的起始值始终为正才能保证能量不断增加。2、时域和频域分析时域分析：用MATLAB对此系统的动态性能进行分析。对系统施加单位阶跃输入信号，然后观察响应曲线并分析系统的动态性能。用step( )函数命令编写求单位阶跃响应的MATLAB程序段如

26、下：M=1.096; m=0.109; l=0.25; I=0.0034; 名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 14 页，共 37 页 - - - - - - - - - 北京石油化工学院BEIJING INSTITUTE OF PETROCHEMICAL TECHNOLOGY 课程设计用纸14 T=0.005; g=9.8; num=m*l; den=(I+m*l*l) 0 -m*g*l; step(num,den); title(G(S)=ml/(I+ml*l)s*s

27、-mgl的单位阶跃响应); xlabel(时间 /sec); ylabel(幅度 ) 02468101200.511.522.5x 1025G(S)=ml/(I+ml*l)s*s-mgl的单位阶跃响应时间/sec (seconds)幅度图 2 单位阶跃响应图由系统的单位阶跃响应曲线可知，此系统很不稳定，是发散的，不存在动态性能指标，因此需要对其进行校正。频域分析：num=0.02725; den=0.0102125 0 -0.26705; bode(num,den),grid; %绘制波特图并加栅格名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - -

28、 - - - - 名师精心整理 - - - - - - - 第 15 页，共 37 页 - - - - - - - - - 北京石油化工学院BEIJING INSTITUTE OF PETROCHEMICAL TECHNOLOGY 课程设计用纸15 title(波特图 ) xlabel(频域 /(rad/sec) ylabel(幅度 /dB) ylabel(相位 /deg) -80-70-60-50-40-30-20Magnitude(dB)100101102-180-180-180-180-180-180相位/deg(deg)波特图频域/(rad/sec) (rad/s)上 面 我 们 已

29、经 得 到 了 系 统 的Bode 图 ， 但 是 无 法 找 到 截 止 频 率 ， 因 此 增 加 一 定 比 例 ， 设2 670 5.00 102 1 25.002 72 5.0)()(21sKsKGsG根据稳态误差要求计算增益 K ，1026705.00102125.002725.0lim20skKsP可以得到：98k于是有：26705.00102125.06705.226705.00102125.09802725.0)(22sssG用 MATLAB 求校正前系统的幅值裕量和相位裕量用命令 margin(G) 可以绘制出G的伯德图，并标出幅值裕量、相位裕量和对应的频率。用函数kg,r

30、,wg,wc=margin(G)可以求出G的幅值裕量、相位裕量和幅值穿越频率。程序：名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 16 页，共 37 页 - - - - - - - - - 北京石油化工学院BEIJING INSTITUTE OF PETROCHEMICAL TECHNOLOGY 课程设计用纸16 num=2.6705; den=0.0102125 0 -0.26705; margin(tf(num,den) kg,r,wg,wc=margin(tf(num,den

31、) xlabel( 频域 /(rad/sec) ylabel( 幅度 /dB ) ylabel( 相位 /deg )得到的幅值裕量和相位裕量如图所示：-40-30-20-1001020Magnitude(dB)100101102-180-180-180-180-180-180相位/deg(deg)Bode DiagramGm = -20 dB (at 0 rad/s) , Pm = 0 deg (at 15.3 rad/s)频域/(rad/sec) (rad/s)运行结果： kg=0.1000 r=0 wg=0 wc=15.3409 即相角域度0。对校正前系统进行仿真分析Simulink是可以

32、用于连续、 离散以及混合的线性、非线性控制系统建模、仿真和分析的软件包，并为用户提供了用方框图进行建模的图形接口，很适合于控制系统的仿真。仿真后得到的结果如图所示：名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 17 页，共 37 页 - - - - - - - - - 北京石油化工学院BEIJING INSTITUTE OF PETROCHEMICAL TECHNOLOGY 课程设计用纸17 超前校正设计参数计算上面已求出相角域度0，假设要求系统的相角裕量40，因此需要增加的相角裕

33、量为40，增加超前校正装置会改变Bode 图的幅值曲线，这时增益交界频率会向右移动，必须对增益交界频率增加所造成的相位滞后增量进行补偿，因此，假设需要的最大相位超前量45m。计算可以得到：826.545sin145sin1)(lg20lg10mjwG即26705.00102125.0725. 2lg20826.5lg10mw计算结果为：sradwm/89.25名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 18 页，共 37 页 - - - - - - - - - 北京石油化工学院B

34、EIJING INSTITUTE OF PETROCHEMICAL TECHNOLOGY 课程设计用纸18 最大超前相角m发生的转折频率T1与T1的几何中点mw处，所以Twm1016.0T引入超前校正网络的传递函数：1016.01016.0826.5.826.5111.1)(ssTsTssGc引入倍的放大器。为了补偿超前网络造成的衰减，引入826.5倍的放大器。得到超前校正装置的传递函数1016.01093216.01016.01016.0826.5826.51826.5)(sssssGc所以，校正后系统的开环传递函数26705.00042728.00102125.00001634.0725.

35、22540136.0)1016.0)(26705.00102125.0()1093216.0(6705.2)().()(2320ssssssssGsGsGcMATLAB 程序：num0=2.6705; num1=0.093216 1; num=conv(num0,num1); den0=0.0102125 0 -0.26705; den1=0.016 1; den=conv(den0,den1); ga=tf(num,den); gb=feedback(ga,1,-1); figure(1); step(gb);grid; figure(2); margin(ga);grid; 名师资料总结

36、- - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 19 页，共 37 页 - - - - - - - - - 北京石油化工学院BEIJING INSTITUTE OF PETROCHEMICAL TECHNOLOGY 课程设计用纸19 Step ResponseTime (seconds)Amplitude00.050.10.150.20.250.30.350.400.511.5System: gbPeak amplitude: 1.4Overshoot (%): 26.3At time (seco

37、nds): 0.126System: gbSettling time (seconds): 0.265System: gbRise time (seconds): 0.0487由阶跃响应图像可以得到上升时间为0.0487s ，峰值时间为0.126s ，超调量为26.3%，调节时间为0.265s 。此超前环节可调整系统至稳定，但超调量较大。-60-40-20020Magnitude(dB)10-1100101102103-180-150-120System: gaFrequency (rad/s): 23.8Phase (deg): -135Phase(deg)Bode DiagramGm =

38、-20 dB (at 0 rad/s) , Pm = 44.9 deg (at 23.9 rad/s)Frequency (rad/s)超前校正后系统的Bode图将开环传递函数1016.098135168.9)(sssG转化为零极点形式。MATLAB 语句如下：num=9.135168 98; 名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 20 页，共 37 页 - - - - - - - - - 北京石油化工学院BEIJING INSTITUTE OF PETROCHEMICAL

39、 TECHNOLOGY 课程设计用纸20 den=0.016 1; z,p,k=tf2zp(num,den) 运行结果：z = -10.7278 p = -62.5000 k = 570.9480 进行 simulink仿真：Simulink仿真模块Simulink仿真图名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 21 页，共 37 页 - - - - - - - - - 北京石油化工学院BEIJING INSTITUTE OF PETROCHEMICAL TECHNOLOGY

40、课程设计用纸21 演示操作模块实际演示操作过程小车位置与摆角波形图3、设计 PID 或其他控制器倒立摆的 PID 模型系统输出量为摆杆的位置，它的初始位置为垂直向上，我们给系统施加一个扰动，观察摆杆的响应。系统框图如下：名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 22 页，共 37 页 - - - - - - - - - 北京石油化工学院BEIJING INSTITUTE OF PETROCHEMICAL TECHNOLOGY 课程设计用纸22 图中)(sKD是控制器传递函数，)

41、(sG是被控对象传递函数当摆杆的平衡位置为垂直向上时，闭环控制系统中给定参考输入r(s)为零，所以系统控制框图可以变换为该系统的输出为)()()()()()()(1)()()(1)()(sFnumnumPIDdendenPIDdenPIDnumsFdendenPIDnumnumPIDdennumsFsGsKDsGsy其中，num被控对象传递函数的分子项den被控对象传递函数的分母项numPID PID 控制器传递函数的分子项denPID PID 控制器传递函数的分母项被控对象的传递函数是名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - -

42、 - 名师精心整理 - - - - - - - 第 23 页，共 37 页 - - - - - - - - - 北京石油化工学院BEIJING INSTITUTE OF PETROCHEMICAL TECHNOLOGY 课程设计用纸23 mglsmlImlsG220)()(PID 控制器的传递函数为denPIDnumPIDsKsKsKsKKsKsKDIPDIPD2)(调节 PID 控制器的各个参数，以得到满意的控制效果。程序扫描法求 kp、ki、kd t=0:0.01:10;for kp=70:1:180for ki=95:1:120for kd=5:1:30numpid=kd kp ki;d

43、enpid=1 0;num=0.02725;den=0.0102125 0 -0.26705;numc=conv(num,numpid);d1=conv(denpid,den);sys=tf(numc,d1);sys1=feedback(sys,1,-1);y=step(sys1,t);s=101;while y(s)0.98 & y(s)1.02;s=s-1;end ;settling_time=(s-1)*0.01if settling_time1break;endendif settling_time1break;endendif settling_time1break;endendfi

44、gure(1);step(sys1,t);gridtitle(PID单位阶跃响应 )xlabel( 时间 )名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 24 页，共 37 页 - - - - - - - - - 北京石油化工学院BEIJING INSTITUTE OF PETROCHEMICAL TECHNOLOGY 课程设计用纸24 ylabel( 幅值 )sol=kp;ki;kd;settling_timekpkikdsettling_time;运行结果：Kp=70；ki=1

45、10；kd=8；settling_time=0.9900 PID单位阶跃响应时间 (seconds)幅值01234567891000.20.40.60.811.21.4System: sys1Peak amplitude: 1.32Overshoot (%): 32At time (seconds): 0.19System: sys1Settling time (seconds): 0.995System: sys1Rise time (seconds): 0.0572System: sys1Final value: 1PID参数扫描阶跃响应图（1）比例（ P）控制名师资料总结 - - -精品

46、资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 25 页，共 37 页 - - - - - - - - - 北京石油化工学院BEIJING INSTITUTE OF PETROCHEMICAL TECHNOLOGY 课程设计用纸25 Bode 图Simulink 仿真图P控制器实质上是一个具有可调增益的放大器。在信号变换过程中，P控制器只改变信号的增益不影响其相位。在串联校正中，加大控制器的增益kp，可以提高系统的开环增益，减小系统稳态误差，从而提高系统的控制精度，但会降低系统的相对稳定性，甚至可能造成闭环系统

47、的不稳定。因此，在系统校正设计中，很少单独使用比例控制规律。（2）比例 - 微分（ PD ）控制名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 26 页，共 37 页 - - - - - - - - - 北京石油化工学院BEIJING INSTITUTE OF PETROCHEMICAL TECHNOLOGY 课程设计用纸26 对数频率特性曲线Simulink 仿真图PD控制器中的微分控制规律，能反映输入信号的变化趋势，产生有效的早期修正信号，以增加系统的阻尼程度，从而改善系统的稳定

48、性。（3）比例 - 积分（ PI）控制名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 27 页，共 37 页 - - - - - - - - - 北京石油化工学院BEIJING INSTITUTE OF PETROCHEMICAL TECHNOLOGY 课程设计用纸27 对数频率特性曲线Simulink仿真图在串联校正时，PI 控制器相当于在系统中增加了一个位于原点的开环极点，同时也增加了一个位于 s 左半平面的开环零点。位于原点的极点可以提高系统的型别，以消除或减小系统的稳态误差，

49、改善系统的稳态性能；而增加的负实零点则用来减小系统的阻尼程度，缓和 PI 控制器极点对系统稳定性及动态过程产生的不利影响。在控制工程实践中，PI 控制器主要用来改善控制系统的稳态性能。（4）比例 - 积分 - 微分（ PID）控制规律名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 28 页，共 37 页 - - - - - - - - - 北京石油化工学院BEIJING INSTITUTE OF PETROCHEMICAL TECHNOLOGY 课程设计用纸28 对数频率特性曲线MA

50、TLAB命令：num=0.02725;den=0.0102125 0 -0.26705;k=70ki=110kd=8numPID=kd k ki;denPID=1 0;numc=conv (num,denPID)denc=polyadd(conv(denPID,den),conv(numPID,num)t=0:0.005:5;figure(1);impulse(numc,denc,t)名师资料总结 - - -精品资料欢迎下载 - - - - - - - - - - - - - - - - - - 名师精心整理 - - - - - - - 第 29 页，共 37 页 - - - - - - -