一级倒立摆控制系统设计.docx

《一级倒立摆控制系统设计.docx》由会员分享，可在线阅读，更多相关《一级倒立摆控制系统设计.docx（8页珍藏版）》请在第一文库网上搜索。

1、基于双闭环PID控制的一阶倒立摆控制系统设计一、设计目的倒立摆是一个非线性、不稳定系统,经常作为研究比较不同控 制方法的典型例子。设计一个倒立摆的控制系统，使倒立摆这样一个 不稳定的被控对象通过引入适当的控制策略使之成为一个能够满足 各种性能指标的稳定系统。二、设计要求倒立摆的设计要求是使摆杆尽快地达到一个平衡位置，并且 使之没有大的振荡和过大的角度和速度。当摆杆到达期望的位置 后，系统能克服随机扰动而保持稳定的位置。实验参数自己选定, 但要合理符合实际情况，控制方式为双PID控制，并利用MATLAB进 行仿真，并用SinIUlink对相应的模块进行仿真。三、设计原理倒立摆控制系统的工作原理是

2、：由轴角编码器测得小车的位置 和摆杆相对垂直方向的角度，作为系统的两个输出量被反馈至控制计 算机。计算机根据一定的控制算法，计算出空置量，并转化为相应的 电压信号提供给驱动电路，以驱动直流力矩电机的运动，从而通过牵 引机构带动小车的移动来控制摆杆和保持平衡。四、设计步骤首先画出一阶倒立摆控制系统的原理方框图一阶倒立摆控制系统示意图如图所示：分析工作原理，可以得出一阶倒立摆系统原理方框图:一阶倒立摆控制系统动态结构图下面的工作是根据结构框图,1. 一阶倒立摆建模在忽略了空气流动阻力，以及各种摩擦之后，可将倒立 摆系统抽象成小车和匀质杆 组成的系统，如下图所示，其中：M：小车质量m：为摆杆质量J:

3、为摆杆惯量分析和解决各个环节的传递函数!F：加在小车上的力X：小车位置 ：摆杆和垂直向上方向的夹角1 :摆杆转动轴心到杆质心的长度根据牛顿运动定律以及刚体运动规律，可知:(I)摆杆绕其重心的转动方程为(2)摆杆重心的运动方程为(3)小车水平方向上的运动为联列上述4个方程，可以得出 一阶倒立精确气模型：式中J为摆杆的转动惯量：若只考虑在其工作点附近o=O附近(-100910)的细微变化，则可以近似认为：若取小车质量M=2kg,摆杆质量m=lkg,摆杆长度2 1 =Im,重力加速度取g=10加心则可以得一阶倒立摆简化模型：拉氏变换即 Gl (s) = ; I U乙 s二 一阶倒立摆环节问题解决!2

4、 .电动机驱动器选用日本松下电工MSMA021型小惯量交流伺服电动机，其有关参数如下：驱动电压：U=OlOOV额定转速：n=3000rmin额定转矩：TN=O. 64Nm电磁时间常数:Tl=O. OOls额定功率：PN=200W转动惯量：J=310-6kg. m2最大转矩：TM=L 91Nm电机时间常数:TM=O. 003s经传动机构变速后输出的拖动力为：F=016N;和其配套的驱动器为：MSDA021A1A,控制 电压：UDA=(T IOV。若忽略电动机的空载转矩和系统摩擦，就可以认为驱动器和机械传动装置均为纯比例环节，并假设这两个环节的增益分别为Kd和Kmo即 D3(s)=1.6电动机驱动

5、器部分问题解决！3 .双闭环PID控制器设计剩下的问题就是如何确定控制器DI(S)/和打/以的结构和 参数。(一)内环控制器的设计其中，KS=I.6为伺服电动机和减速机构的等效模型1 .控制器的选择内环系统未校正时的传递函数为对于内环反馈控制器D2(s)可有PD, PI, PlD三种可能的结构形 式，怎么选取呢？这里，不妨采用绘制各种控制器结构下“系统根轨 迹”的办法加以分析比较，从之选出一种比较适合的控制器结构。各种控制器的开环传函的传递函数分别为：在MATLAB下输入以下程序用“凑试”的方法画根轨迹图：num=分子;den=分母;xlabel ( Real Axis,);ylabel (

6、Imag Axis,);axis(横、纵坐标范围);title (, Root Locus,);grid;rlocus (num, den)下图为各种控制器下的系统根轨迹。(a) PD(b) PD(c) PId) PID从根轨迹不难发现，采用PD结构的反馈控制器，结构简单且可 保证闭环系统的稳定。所以，选定反馈控制器的结构为PD形式的控 制器。2 .控制器参数的选定首先暂定K=-20。这样可以求出内环的传递函数为：注释：工程上常用阻尼比J=O. 707作为二阶系统最优解！3 .系统内环的Simulink仿真及结果仿真结果为:Step ResponseProperty EditorLabels

7、Limits Units Style Character1Oq 6R 5 OPndEChanacteris tics(二)外环控制器的设计Show settling time within 2 %Show rise time from io to 90可见，系统开环传递函数可视为一个高阶(4阶)且带有不稳定 零点的“非最小相位系统”，为了便于设计，需要首先对系统进行一 些简化处理(否则，不便利用经典控制理论和方法对它进行设计)。1.系统外环模型的降阶(1)对内环等效闭环传递函数的近似处理将高次项/忽略，有近似条件可由频率特性导出，即由(2)得：(2)对象模型GI(S)的近似处理,/、/口 /.

8、、-1.1(7)2+1010 + 1.W由(3)得：G(H) = -”一 = 一丁(J )由(4)得：G(jo)(:)2 =Zl，所以，有q095近似条件为：cmin(1.13, 0.95)=0.95MS)DI(S), 闭环系解构图 / IJ o J-IiiULJ- XIIIY JJ/. 口p J *T!J Z、 I HJ m /二I J l T 系统框图为仿真结果:倒立摆位置在阶跃信号下的响应3.系统的Simulink仿真连接图如下:仿真结果为：倒立摆在阶跃信号下摆杆和小车位置的响应从图中可以看出建立的一阶倒立摆控制系统在matIab中能够实 现倒立摆的要求，能通过电动机牵引机构带动小车的移

9、动来控制摆杆 和保持平衡。为了进一步验证在不同摆杆下的，该一阶倒立摆控制系统是否还 具有鲁棒特性，分别取摆杆不同的质量和摆长，进行SinIUlink仿真!由图可知，建立的一阶倒立摆模型在不同摆长下能实现要求。但 摆长不能过长！同理，建立的一阶倒立摆模型在不同质量的摆杆下能 也实现要求，但同样不能过重！五、课程设计心得1、通过实验了解了一阶倒立摆是的非线性、不确定性、不稳定系统和约束限制，同时倒立摆也是经常作为研究比较不同控制方法的典 型例子。2、对一阶倒立摆控制系统的研究使我了解到倒立摆还有二阶倒立 摆、三阶倒立摆，甚至四阶倒立摆，同时还涉及到起摆的问题！增加 了了倒立摆研究的兴趣！3、建立的一阶倒立摆控制系统忽略了许多因素，应用一些简化处 理，即建立的只是一阶倒立摆控制系统的简化模型。当摆杆的质量和 摆长超过一定范围，系统失效,所以该系统有待改进！