自动控制原理课程设计直线一级倒立摆设计

陈舒涵：直线一级倒立摆的频率法校正自动控制原理课程设计-直线一级倒立摆 摘 要倒立摆系统是机器人技术、控制理论、计算机控制等多个领域、多种技术的有机结合。本身又是一个绝对不稳定、高阶次、多变量、强耦合的非线性系统，可以作为控制理论研究的典型试验平台。通过倒立摆研究产生的方法和技术将在半导体及精密仪器加工、机器人控制技术、人工智能、火箭发射中的垂直度控制和一般工业应用等方面具有广阔的利用开发前景。由于倒立摆系统的控制策略和杂技运动员顶杆平衡表演的技巧有异曲同工之处，极富趣味性，而且许多抽象的控制理论概念如系统稳定性、可控性和系统抗干扰能力等等，都可以通过倒立摆系统实验直观的表现出来，因此在欧美发达国家的高等院校，它已成为必备的控制理论教学实验设备。关键词频率，校正，倒立摆，仿真课程设计的目的本课程设计的目的是让学生掌握对实际系统进行建模的方法，熟悉利用MATLAB /SIMULINK对系统模型进行仿真，利用学习的古典控制理论对系统进行控制器的设计，并对控制系统进行仿真，对仿真结果进行观察和分析，非常直观的感受控制器的控制作用。培养学生对控制系统进行分析和设计的能力。数学模型的推导系统建模可以分为两种：机理建模和实验建模。实验建模就是通过在研究对象上加上一系列的研究者事先确定的输入信号，激励研究对象并通过传感器检测其可观测的输出，应用数学手段建立起系统的输入输出关系。这里面包括输入信号的设计选取，输出信号的精确检测，数学算法的研究等等内容。机理建模就是在了解研究对象的运动规律基础上，通过物理、化学的知识和数学手段建立起系统内部的输入状态关系。对于倒立摆系统，由于其本身是自不稳定的系统，实验建模存在一定的困难。但是忽略掉一些次要的因素后，倒立摆系统就是一个典型的运动的刚体系统，可以在惯性坐标系内应用经典力学理论建立系统的动力学方程。微分方程的推导：在忽略了空气阻力和各种摩擦之后，可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统，如图1 所示。做以下假设：M 小车质量m 摆杆质量b 小车摩擦系数I 摆杆惯量F 加在小车上的力x 小车位置F 摆杆与垂直向上方向的夹角q 摆杆与垂直向下方向的夹角（考虑到摆杆初始位置为竖直向下）图 1.直线一级倒立摆模型系统中小车和摆杆的受力分析图是图2。其中，N 和P 为小车与摆杆相互作用力的水平和垂直方向的分量。注意：在实际倒立摆系统中检测和执行装置的正负方向已经完全确定，因而矢量方向定义如图2所示，图示方向为矢量正方向。 图 2 小车及摆杆受力分析分析小车水平方向所受的合力，可以得到以下方程： (1)由摆杆水平方向的受力进行分析可以得到下面等式：(2)即： (3)把这个等式代入式(1)中，就得到小车运动方程（第一个运动方程）：(4)为了推出摆杆的运动方程（第二个运动方程），对摆杆垂直方向上的合力进行分析，可以得到下面方程： (5) (6)力矩平衡方程如下： (7)注意：方程中力矩的方向，由于(6)和（3）代入(7)，约去P 和N，得到摆杆运动方程（第二个运动方程）： (8)设（是摆杆与垂直向上方向之间的夹角），假设与1（单位是弧度）相比很小，即，则可以进行线性化近似处理：用来代表被控对象的输入力，线性化后两个运动方程如下：进行拉氏变换，得： （9）由于输出为角度，求解方程组的第一个方程，可以得到：，即：（10）（10）式称为摆杆角度与小车位移的传递函数如令，则有： （11）（11）式称为摆杆角度与小车加速度间的传递函数，由于伺服电机的速度控制易于实现在实验中常采用此式。把（10）式代入（9）式的第二个方程中，得到：（12）其中，（12）式称为摆杆角度与外加作用力间的传递函数。 直线倒立摆的实际系统模型把上述参数代入，可以得到系统的实际模型。摆杆角度和小车位移的传递函数：摆杆角度和小车加速度之间的传递函数为： 摆杆角度和小车所受外界作用力的传递函数：以外界作用力作为输入的系统状态方程： 系统阶跃响应分析上面已经得到系统的状态方程，先对其进行阶跃响应分析，在 MATLAB 中键入以下命令、得到如下计算结果：clearA=0 1 0 0; 0 0 0 0; 0 0 0 1; 0 0 29.4 0;B=0 1 0 3;C=1 0 0 0; 0 1 0 0;D=0 0;step(A,B,C,D)可以看出，在单位阶跃响应作用下，小车位置和摆杆角度都是发散的,因此我们必须想办法对其进行校正。直线一级倒立摆频率响应控制实验系统对正弦输入信号的响应，称为频率响应。在频率响应方法中，我们在一定范围内改变输入信号的频率，研究其产生的响应。频率响应可以采用以下三种比较方便的方法进行分析，一种为伯德图或对数坐标图，伯德图采用两幅分离的图来表示，一幅表示幅值和频率的关系，一幅表示相角和频率的关系；一种是极坐标图，极坐标图表示的是当 从0变化到时，向量|G(j)|/G(j)的轨迹，极坐标图也常称为奈奎斯特图，奈奎斯特稳定判据使我们有可能根据系统的开环频率响应特性信息，研究线性闭环系统的绝的稳定性和相对稳定性。|频率响应分析：前面我们已经得到了直线一级倒立摆的物理模型，实际系统的开环传递函数为：其中输入为小车的加速度 ，输出为摆杆的角度 。 在MATLAB下绘制系统的Bode图和奈奎斯特图。 绘制Bode图的命令为： Bode(sys) 绘制奈魁斯特图的命令为： Nyquist(sys) 在MATLAB中键入以下命令：num=0.02725den=0.0102125 0 -0.26705z=roots(num)p=roots(den)subplot(2,1,1)bode(num,den)subplot(2,1,1)nyquist(num,den)得到如下图所示的结果：图 直线一级倒立摆的 Bode 图图 直线一级倒立摆的奈魁斯特图可以得到，系统没有零点，但存在两个极点，其中一个极点位于右半s 平面，根据奈奎斯特稳定判据，闭环系统稳定的充分必要条件是：当从到变化时，开环传递函数G(j)沿逆时针方向包围-1点 p圈，其中 p为开环传递函数化时，开环传递函数S平面内的极点数。对于直线一级倒立摆，由图 3-21我们可以看出，开在右半环传递函数在S 右半平面有一个极点，因此G(j) 需要沿逆时针方向包围-1 点一圈。可以看出，系统的奈奎斯特图并没有逆时针绕-1点一圈，因此系统不稳定，需要设计控制器来镇定系统。频率响应设计及仿真:直线一级倒立摆的频率响应设计可以表示为如下问题： 考虑一个单位负反馈系统，其开环传递函数为：设计控制器，使得系统的静态位置误差常数为 10，相位裕量为，10分贝。增益裕量等于或大于10分贝。根据要求，控制器设计如下： 1) 选择控制器，上面我们已经得到了系统的Bode图，可以看出，给系统增加一个超前校正就可以满足设计要求，设超前校正装置为： 已校正系统具有开环传递函数设 ，式中2）根据稳态误差要求计算增益K，可以得到于是有 4) 可以看出，系统的相位裕量为 ，根据设计要求，系统的相位裕量为，因此需要增加的相位裕量为，增加超前校正装置会改变 Bode 图的幅值曲线，这时增益交界频率会向右移动，必须对增益交界频率增加所造成的G1( j)的相位滞后增量进行补偿，因此，假设需要的最大相位超前量m近似等于。因为计算可以得到： = 0.09945) 确定了衰减系统，就可以确定超前校正装置的转角频率 =1/T和1/(T)，可以看出，最大相位超前角发生在两个转角频率的几何中心上，即1/(T)，在1/(T)点上，由于包含(Ts +1)/(Ts +1)项，所以幅值的变化为：又 分贝并且| |=11.7441分贝对应于=31.5rad/s,我们选择此频率作为新的增益交界频率，这一频率相应于，即 于是6) 于是校正装置确定为7) 增加校正后系统的根轨迹和奈魁斯特图如下：在matlab中输入以下命令：clear;num=98*0.02725;den=0.0102125 0 -0.26705;subplot(2,1,1)bode(num,den)subplot(2,1,2)nyquist(num,den)z=roots(num);p=roots(den);za=z;-8.9854;pa=p;-90.3965;k=985.9155;sys=zpk(za,pa,k);figuresubplot(2,1,1)bode(sys)subplot(2,1,2)nyquist(sys)figuresysc=sys/(1+sys);t=0:0.005:5;impulse(sysc,t)从 Bode 图中可以看出,系统具有要求的相角裕度和幅值裕度，从奈魁斯特图中可以看出，曲线绕-1 点逆时针一圈，因此校正后的系统稳定。图 添加控制器后的直线一级倒立摆 Bode 图和 Nyquist 图（一阶控制器）得到系统的单位阶跃响应如下：图 利用频率响应方法校正后系统的单位阶跃响应（一阶控制器）可以看出，系统在遇到干扰后，在 1 秒内可以达到新的平衡，但是超调量比较大。8)在 MATLAB Simulink 下对系统进行仿真图 直线一级倒立摆的频率响应校正仿真程序9) 可以看出，系统存在一定的稳态误差，为使系统获得快速响应特性，又可以得到良好的静态精度，我们采用滞后超前校正（通过应用滞后超前校正，低频增益增大，稳态精度提高，又可以增加系统的带宽和稳定性裕量），设滞后超前控制器为：10)滞后-超前控制器为：可以得到静态误差系数： 比超前校正提高了很多，因为-2零点和0.1988 极点比较接近，所以对相角裕度影响等不是很大，滞后-超前校正后的系统 Bode 图和奈魁斯特图如下所示：clear;num=98*0.02725;den=0.0102125 0 -0.26705;z=roots(num);p=roots(den);za=z;-8.9854;pa=p;-90.3965;zaa=za;-2;paa=za;-0.1988k=985.9155;sys=zpk(zaa,paa,k);figure(1)bode(sys)figure(2)nyquist(sys)figure(3)sysc=sys/(1+sys);t=0:0.005:5;impulse(sysc,t)运行仿真结果，可以得到：图 频率响应校正后阶跃响应仿真结果（二阶控制器）可以很明显的看出，系统的稳态误差较少。得到系统的单位阶跃响应如下：可以看出，系统在遇到干扰后，在 1 秒内可以达到新的平衡，超调量也比前面的超前矫正小了许多。MATLAB Simulink 仿真再次校正闭环系统的Simulink 仿真的电路图结论： 倒立摆系统的控制研究长期以来被认为是控制理论极其应用领域里引起人们极大兴趣的问题。它是检验各种控制理论和方法的有效性的著名实验装置，作为一个高阶、非线性、不稳定系统，倒立摆的稳定控制相当困难，对该领域的学者来说是一个极具挑战性的难题。 本文以经典控制理论为基础，建立了小车倒立摆系统的数学模型，使用控制法设计出确定参数下的控制器使系统稳定。本实验采用MATLAB软件进行仿真实验，进一步验证了控制器中各个参数对系统的稳定性和动态性能的影响，在大量的仿真结果中进行比较和挑选，同时根据调节时间1s的设计要求，最后确定控制器的各参数值，通过MATLAB软件的仿真可知，单级倒立摆的经典控制可以实现。总 结这是我上大学以来的第一次课程设计，所以刚开始拿到项目题目时脑子里是一片空白，想：啊，这下完了，就凭我自己怎么可能设计的出来？但是最后我完成了，通过查资料、和同学讨论、向老师学长请教，这一个星期虽然很辛苦，但收获很多，值！完成的同时也增强了自己的信心。本次设计主要完成了直线一级倒立摆的频率法校正，通过这次课程设计不仅让我掌握了如何利用MATLAB仿真，而且使我对自动控制原理课程知识有了进一步的理解。在整个系统设计过程中，我比较圆满的完成了这次设计，在将所学知识应用于实际的同时，也培养了我的项目开发能力以及独立思考的能力。通过本次系统的设计，我收获颇多：第一、 学会了如何运用所学知识，开发一个可用的数据库应用系统；培养了我的项目开发能力；第二、 学会了运用如何利用Intel网及校图书馆检索设计需要的文献资料，并扩充了我的知识面；第三、 增加了对书本知识的理解，也学会了如何用之于实际，积累了实际经验；第四、 提高了课程设计报告撰写水平，也提高了书面表达能力。为以后步入社会打下了很好的基础。 最后，感谢学校各级我们安排了这么好的一次实践机会，让我们得以学以致用，并从中学到了很多知识，也积累了实践经验。特别是在信息世界飞速发展的今天，我们一定要学会如何利用网络和图书馆拓展我们的知识，通过实践来弥补能力上的不足。总之，通过这次课程设计，很好地锻炼了自己，使自己各个方面都有了一定的提高，为以后步入社会踏上工作岗位奠定了良好的基础。参 考 文 献1 涂植英，陈今润.自动控制原理.重庆:重庆大学出版社,20052 胡寿松.自动控制原理.北京:科学出版社,20013 黄家英. 自动控制原理.南京:东南大学出版社，19914 Katsuhiko Ogata.现代控制工程.北京:电子工业出版社,20035 夏德黔.自动控制理论.第2版.北京：机械工业出版社，20046 固高科技有限公司.直线倒立摆安装与使用手册R1.0,20057 固高科技有限公司. 倒立摆与自动控制原理实验,200517