倒立摆的自动控制原理课程设计(共29页).doc

《倒立摆的自动控制原理课程设计(共29页).doc》由会员分享，可在线阅读，更多相关《倒立摆的自动控制原理课程设计(共29页).doc（29页珍藏版）》请在淘文阁 - 分享文档赚钱的网站上搜索。

1、精选优质文档-倾情为你奉上全校通识课课程考核 科 目： 倒立摆的自动控制原理课程设计 教 师： 姓 名： 学 号： 2010 专 业： 2010级 自动化 5班 上课时间： 2013年 3月至2013年5月 学 生 成 绩： 教 师 (签名) 重庆大学制目录倒立摆的自动控制原理课程设计1引言 倒立摆是进行控制理论研究的典型实验平台，它在机器人技术、控制理论、计算机控制等自动控制领域，对多种技术的进行了有机结合。它具有高阶次、不稳定、多变量、非线性和强耦合特性，在经典控制理论学习理解以及现代科技方面，诸如半导体及精密仪器加工、机器人控制技术、人工智能、导弹拦截控制系统、航空对接控制技术、火箭发射

2、中的垂直度控制、卫星飞行等有广泛的应用。平面倒立摆可以比较真实的模拟火箭的飞行控制和步行机器人的稳定控制。通过本次简单的倒立摆系统实验来验证所学的控制理论和算法，非常直观，简便。它可以在轻松的氛围下提高学生学习热情，充分调动学生积极性，达到理论与实践的有机统一，更好的学习知识！同时在设计的过程中多次用到了matlab中的simulink模块，可以让我们更好的学习计算机在控制系统中的巨大作用，更好的学习自动控制知识。倒立摆已经扩展出很多种类，典型的有直线倒立摆，环形倒立摆，平面倒立摆和复合倒立摆等，倒立摆系统是在运动模块上装有倒立摆装置。对于倒立摆系统，由于其本身是自不稳定的系统，实验建模存在一

3、定的困难。但是忽略掉一些次要的因素后，倒立摆系统就是一个典型的运动的刚体系统，可以在惯性坐标系内应用经典力学理论建立系统的动力学方程。本文是基于固高倒立摆系统已经建立好的传递函数，根据参数要求，通过根轨迹分析和频域分析等控制算法设计控制器，并通过实际检测，最后得到参数要求的控制器并且倒立后能承受一定的干扰。 2数学模型的建立2.1 倒立摆数学模型的建立直线一级倒立摆由直线运动模块和一级摆体组件组成，是最常见的倒立摆之一，直线倒立摆是在直线运动模块上装有摆体组件，直线运动模块有一个自由度，小车可以沿导轨水平运动，在小车上装载不同的摆体组件。系统建模可以分为两种：机理建模和实验建模。对于倒立摆系统

4、，由于其本身是自不稳定的系统，实验建模存在一定的困难。机理建模就是在了解研究对象的运动规律基础上，通过物理、化学等学科的知识和数学手段建立起系统内部变量、输入变量以及输出变量之间的数学关系。本文用机理建模的方法求取小车的传递函数（设实验环境器材等均处于理想状态）如图： M 小车质量1.096 Kgm 摆杆质量0.109 Kgb 小车摩擦系数0.1N/m/secl 摆杆转动轴心到质心长度0.25mI 摆杆惯量0.0034 kgm2F 加在小车上的力x 小车位置 摆杆与垂直向上方向的夹角 摆杆与垂直向下方向的夹角图1 直线一级倒立摆模型 N 和P 为小车与摆杆相互作用力的水平和垂直方向的分量 图2

5、 小车及摆杆受力分析小车水平方向的合力： (2.1)摆杆水平方向的合力： (2.2) 化简得： (2.3)水平方向的运动方程： (2.4)对摆杆垂直方向上的受力进行分析，可得垂直方向的运动方程： (2.5)即： (2.6)力矩平衡方程如下： (2.7) 合并式（6）和（7）.，消去和得到第二个运动方程： (2.8)设，假设与1（单位均是）相比很小，即，则可以进行如下近似： (2.9)用u 来代表被控对象的输入力F，线性化后两个运动方程如下： (2.10) 假设、和它们的各阶导数的初始值均为零。对上式进行拉普拉斯变换，得到： (2.11)由于角度为输出量，求解方程组的第一个方程，可以得到摆杆角度

6、和小车位移的传递函数： (2.12) 如果令，则摆杆角度和小车加速度之间的传递函数为： (2.13) 把上式代入方程组的第二个方程，得到： (2.14)整理后得到式称为摆杆角度与外加作用力间的传递函数： （2.15）带入实际参数：M=1.096Kgm=0.109Kgb=0.1N/m/secl=0.25mI=0.0034 kgm2最后得到的最终表达式：摆杆角度和小车位移的传递函数： (2.16)摆杆角度和小车加速度之间的传递函数为： (2.17)摆杆角度和小车所受外界作用力的传递函数： (2.18)小车位置和加速度的传递函数 (2.19)3 未校正前系统的时域分析本系统采用以小车的加速度作为系统

7、的输入，摆杆角度为输出响应，此时的传递函数为: (3.1) 图3.1摆杆角度的单位阶跃响应曲线图采用以小车的加速度作为系统的输入，小车位置为响应，则此时的传递函数为 (3.1） 图3.2小车位置的单位阶跃响应曲线图由于以上时域分析中所有的传递函数的响应图都是发散的，说明系统不稳定，需加控制器进行校正4 根轨迹校正4.1 原系统的根轨迹分析以小车的加速度为系统输入，摆杆角度为输出。前面已得到系统传递函数为： (4.1) 4.1 原系统根轨迹曲线图其中：z = 0，0 p = 5.1136，-5.1136可以很直观地看出，系统有两个零点，有两个极点，并且有一个极点为正。画出系统闭环传递函数的根轨迹

8、如图 3-6，可以看出闭环传递函数的一个极点位于右半平面，并且有一条根轨迹起始于该极点，并沿着实轴向左跑到位于原点的零点处，这意味着无论增益如何变化，这条根轨迹总是位于右半平面，即系统不稳定。4.2串连超前系统的设计设计后的参数要求：调整时间： 最大超调量： 4.2.1确定闭环期望极点的位置由最大超调量 (4.2)4.2 闭环主导极点所在的极坐标图在此我们对超调量留有一定余量，令 可以得到：由可以得到： (弧度)其中为位于第二象限的极点和O点的连线与实轴负方向的夹角。又由：其中为位于第二象限的极点和O点的连线与实轴负方向的夹角。又由：对调节时间留有一定余量，令 (2%的误差带)取其为0.3s，

9、可以得到：，于是可以得到期望的闭环主导极点为：代入数据后，可得期望的闭环主导极点为：13.3589j8.67604.2.2 超前校正传递函数设计未校正系统的根轨迹在实轴和虚轴上，不通过闭环期望极点，因此需要对系统进行超前校正，设控制器为： (4.3)4.2.3 校正参数计算计算超前校正装置应提供的相角，已知期望的闭环主导极点和系统原来的极点的相角和为： (4.4) 因此校正装置提供的相角为： (4.5)又已知对于最大的值的角度可由下式计算得到： (4.6) 图4.3直线一级倒立摆根轨迹计算图由于角度都已求出，线段SO的长度即为自然频率的大小，故可用正弦定理计算，求出超前校正装置的零点和极点（正

10、弦定理）分别为： （计算程序见附录4）4.2.4 超前校正控制器校正后系统的开环传递函数为： (4.7) 由幅值条件，并设反馈为单位反馈，所以有对相应参数保留五位有效值，于是我们得到了系统的控制器： (4.8) 4.2.5 matlab环境下串联超前校正后的根轨迹图对系统进行仿真,运行即可以得到以上的计算结果，校正后系统的跟轨迹如下图所示： 图4.4 串联超前校正后系统的根轨迹图图4.5 串联超前校正simulink流程图图4.6 串联超前校正后的阶跃响应曲线 (为便于观察，阶跃信号设置了1s的延时) 小结：在课程设计期间，根轨迹法由于时间较紧，而且看放到计算量很大，我们有没有数学软件，很复杂

11、。算到一半就没算了。然后只是用试探的方法，以为只要仿真达到参数指标就可以了，得到的一组数据仿真效果非常好。但是在实际应用于倒立摆时就不行了，可以立起来，但是不稳定，会向左右摆，然后就倒了。经仔细分析得到原因：我们没有对小车在轴上的运动的距离进行控制，导致它不稳定。5倒立摆系统频域分析 系统对正弦输入信号的响应，称为频率响应。在频率响应方法中，在一定范围内改变输入信号的频率，研究其产生的响应。频率响应可以采用以下两种方法进行分析，一种为伯德图，伯德图采用两幅分离的图来表示，一幅表示幅频特性，一幅表示相频特性；一种是奈奎斯特图，表示的是当从0 变化到无穷大时，向量G( j) 的矢端轨迹。奈奎斯稳定

12、判据使我们有可能根据系统的开环频率响应特性信息，研究线性闭环系统的绝对稳定性和相对稳定性。根据以上所建模型我们已经得到了直线一级倒立摆的数学模型，实际系统的开环传递函数为： 其中输入为小车的加速度,输出为摆杆的角速度。在MATLAB下绘制系统的Bode图和Nyquist图如下所示。计算出开环传递函数的零极点分别为：z = Empty matrix: 0-by-1p =5.1136 -5.1136图5.1 直线一级倒立摆的bode图图5.2 直线一级倒立摆的Nyquist图由上述计算结果可以知系统没有零点，但存在两个极点，其中一个极点位于右半S平面。根据奈奎斯特稳定判据，闭环系统稳定的充分必要条

13、件是：当由变化时， 曲线逆时针包围平面上点的次数等于开环传递函数右极点个数。对于直线一级倒立摆，由图7我们可以看出，开环传递函数在S右半平面有一个极点。因此，曲线逆时针包围点的次数。而本系统的奈奎斯特图并没有逆时针包围点一圈即。因此系统不稳定，需要设计控制器来稳定系统。6 频域法校正6.1频域法控制器设计直线一级倒立摆的频率响应设计可以表示为如下问题：考虑一个单位负反馈系统，其开环传递函数为（5.1）式所示，则可以设计控制器 ，使得系统的静态位置误差常数为10，相位裕量为，增益裕量等于或大于 。6.1.1控制器的选择 根据图7可以初步观察出，给系统增加一个超前校正就可以满足设计要求，设超 前校

14、正装置为： (6. 1) 则已校正系统具有开环传递函数， (6. 2)6.1.2系统开环增益的计算根据稳态误差要求计算增益K (6. 3) 可以得到： 于是有： (6 .4)6.1.3画bode图和Nyquist图用MATLAB画出的Bode图和Nyquist图，如下所示 图6.1 直线一级倒立摆加增益校正后的bode图图6.2 直线一级倒立摆加增益校正后的Nyquist图可以看出，系统的相位裕量为,根据设计要求，系统的相位裕量为，因此需要增加的相位裕量为，增加超前校正装置会改变 Bode 图的幅值曲线，这时增益交界频率会向右移动，必须对增益交界频率增加所造成的的相位滞后增量进行补偿。因此，假

15、设需要的最大相位超前量近似为53。6.1.4计算和T求解校正装置 由 （6.5）计算可以得到值：确定了衰减系统，就可以确定超前校正装置的转角频率和，可以看到，最大相位超前角发生在两个转角频率的几何中心线上，由于包含(Ts+1)/(Ts+1)项，所以幅值变化为：得到并且-11.0756dB对应于 = 29.3rad/s，选择此频率做，相当于=，得到： 于是矫正装置确定为：，Kc=900.00196.1.6 matlab下作校正后系统的Bode图和Nyquist图 图6.3 添加超前校正装置后的倒立摆Bode图 图6.4 添加超前校正装置后的Nyquist图从图6.3图中可以看出，系统具有要求的相

16、角裕量和幅值裕量；从图6.4 Nyquist图中可以看出，曲线绕点逆时针一圈，与校正后系统开环传递函数右极点个数相等，即。系统稳定。6.1.7校正后系统的单位阶跃曲线 图6.5 添加超前矫正后的相应图（为便于观察，阶跃信号设置了1s延时）从图6.5可以看出，系统的超调量和稳态误差都比较大。为使系统获得快速响应特性，又可以得到良好的静态精度，我们可以采用滞后超前校正（通过应用滞后超前校正，低频增益增大，稳态精度提高，又可以增加系统的带宽和稳定性裕量）。6.2 串联滞后-超前校正装置设计6.2.1 控制器设计从上图可知，超前校正后系统仍然存在一定的稳态误差，可以考虑采用滞后-超前校正，设滞后-超前

17、控制器为： （6.9）根据滞后-超前控制器思想，利用MATLAB编程，求得结果如下：最优校正方案的串联滞后-超前校正环节的极点为：optimization_z =2最优校正方案的串联滞后-超前校正环节的零点为： optimization_p =0.1837最优校正方案的串联滞后-超前校正后的开环传递函数为： （6.10） 比超前校正提高了很多，因为-2零点和0.1837极点比较接近，所以对相角裕度影响等不是很大。6.2.2 matlab环境下的bode图和nyquist图图6.8 滞后-超前校正后的系统 Bode 图图6.9 滞后-超前校正后的系统的Nyquist图滞后，超前矫正后的仿真 图6

18、.10 滞后超前校正频域响应仿真结果（为便于观察，设置了1s延时）小结：频域分析法较根轨迹法计算量较小，但当时做的时候算完后没有分析在后面再加一个滞后校正，加了滞后校正后，响应曲线更好！7 PID控制器设计开环传递函数：设计或调整PID控制器参数，使得校正后系统的性能指标满足：最大超调量： 调整时间： SIMULINK仿真模型:7.1控制器设计过程先设置PID控制器的P参数，取P=20，I=0，D=0，得到阶跃响应曲线：从图中可以看出系统阶跃响应呈等幅振荡。为了消除系统的振荡，增加PID控制器的微分控制参数D。取P=20，I=0，D=10，得到阶跃响应曲线如下：从响应曲线可以看出，系统稳定时间

19、在2s左右，基本满足调节时间，但是超调量很大，且存在系统稳态误差。为了减少系统稳态误差，增加PID控制器的积分环节参数I。取P=20，I=10，D=10，得到阶跃响应曲线如下：从得到的响应曲线可以看出，由于加入积分环节，使得调节时间增大。但是超调量有所减少，消除了系统稳态误差。故需进一步对超调量和调节时间进行校正，修改三个参数。取P=60，I=20，D=10，得到阶跃响应曲线如下： 超调量已经满足要求，但是调节时间很长，过对调节时间进行调节。 取P=60，I=100，D=20，得到阶跃响应曲线如下： 调节时间仍然不满足要求。设置P=60，I=300，D=15时，得到阶跃响应曲线： 通过计算超调

20、量，经过一个振荡后达到稳定，调节时间在2s内，已经满足题目要求。故可取PID 控制器的参数为P=60，I=300，D=15。建立下列simulink仿真模型：取PID 控制器的参数为P=60，I=300，D=15。点击scope，得到摆杆位置的阶跃响应曲线：阶跃作用下摆杆往一个方向运动8 课程设计总结 通过本次自动控制原理课程设计，加深了我对课本自动控制原理理论基础知识的认识和理解，初步的将理论和实践联系了起来，特别是使用各类方法进行校正的知识。同时培养了以下几点能力： 1.提高了综合运用各门知识分析问题，解决问题的能力，在设计中，涉及到很多门学科，包括：具体校正用到了自动控制原理、建模用到了

21、大学物理、计算用到了高等数学等。 2.学会了基本的应用matlab来画根轨迹，bode图，Nyquist图，simulink进行系统用仿真等操作。也认识到了计算机在自动控制学科方面的强大应用。 3.通过课程设计，也或多或少的带动了理论考试的复习。4.增加了学习的趣味性，培养了自动控制课程学习的兴趣。 经过用根轨迹分析法，频率响应分析和PID分析法，都可以设计出满足所需要条件的校正装置。不过其中每种方法都有各自的特色。通过对matlab的使用和学习，更能明白自动控制的作用和意义。为以后从事自动控制方面的工作和学习，打下了更加牢固的基础，本次课程设计是不可多的机会。 本次课程设计终于顺利成功了了，在设计中遇到了问题，最后在老师以及同学的辛勤指导下，才顺利完成。同时，在老师及同学的身上我们学也到很多实用东西，谢谢！9参考资料1、固高科技有限公司.直线倒立摆安装与使用手册R1.0，20052、固高科技有限公司. 固高MATLAB实时控制软件用户手册，20053、Matlab/Simulink相关资料4、谢昭莉，李良筑，杨欣. 自动控制原理. 北京：机械工业出版社，20125、胡寿松. 自动控制原理（第五版）. 北京：科学出版社，20076、Katsuhiko Ogata. 现代控制工程. 北京：电子工业出版社，2003专心-专注-专业