固高球杆系统课程设计.doc

固高球杆系统课程设计目 录 一、整体方案设计31.1需求31.2 设定目标3二、系统设计42.1功能分析42.2设计规范和约束52.3 机械系统设计72.4 传感器输出信号的数字滤波9三、理论分析103.1 控制系统建模103.2 原系统稳定性分析103.2.1 原系统概述103.2.2待校正系统单位阶跃响应分析:103.2.3伯德图分析113.3频率响应法设计球杆系统控制器133.3.1设计要求133.3.2相位超前控制器133.3.3相位超前-滞后控制器163.4 P/PD/PID 控制器设计193.4.1 球杆系统的P 控制器设计193.4.2 球杆系统的PD 控制器设计203.4.3 球杆系统的PID 控制器设计243.5 各种控制方法比较总结283.5.1频域校正方法的比较283.5.2 PID校正方法的比较29四、元器件、设备选型304.1激光位移传感器304.2 IPM240-5E 智能伺服驱动器314.3 70W伺服电机31五、加工安装调试335.1超前校正实际检验：335.2 超前-滞后校正实际检验：345.3 PD校正实际检验：355.4 PID校正实际检验：36六、 经济性分析386.1市场分析386.2市场运作386.3成本分析38七、结论40八、心得体会41一、整体方案设计1.1需求 球杆系统是为自动控制原理等基础控制课程的教学实验而设计的实验设备。该系统涵盖了许多经典的和现代的设计方法。这个系统有一个非常重要的性质它是开环不稳定的。不稳定系统的控制问题成了大多数控制系统需要克服的难点，有必要在实验室中研究。但是由于绝大多数的不稳定控制系统都是非常危险的，因此成了实验室研究的主要障碍。而球杆系统就是解决这种矛盾的最好的实验工具，它简单、安全并且具备了一个非稳定系统所具有的重要的动态特性。1.2 设定目标球杆的控制问题就是使小球尽快地达到一个任意的设定位置，并且使之没有较大的超调量和过大的调节时间。当小球达到期望的位置后，系统能克服随机扰动而保持在稳定的位置不变。球杆控制系统的目的是：小球和球杆组成的系统在受到干扰后，小球处于轨道的任意的设定位置，小球将保持在该位置不变。二、系统设计2.1功能分析 （1） 被控对象：球杆的被控对象为球杆和小球。球杆通过传动杆连接在齿轮上，并可以根据齿轮的角度变化来控制球杆的倾角，进而控制小球平衡在设定的平衡位置。通过给小球施加适当的力可以将球杆倾斜起来并最终使小球保持在平衡位置。 （2）控制装置：电机的运动通过IPM100智能伺服驱动器进行控制，IPM100是一个智能的高精度、全数字的控制器，内嵌100W的驱动电路，适合于有刷和无刷电机。基于反馈控制原理，在得到传感器信号后，对信号进行处理，然后给电机绕组施加适当的PWM电压信号，这样，一个相应的扭矩作用于电机轴，使电机开始运动，扭矩的大小决定于用户程序中的控制算法。 IPM100是一款智能的控制器，它除了板载的用于放大控制信号的驱动放大器和PWM调制电路，还有一个全数字的DSP处理芯片，内存以及其它逻辑元件，有了这些，就可以实现先进的运动控制技术和PLC的功能，它产生实时的轨迹路径，实现闭环伺服控制，执行上位机的操作命令，完成板载IO信号的处理，所有这些都依照储存器的程序指令或是主机的在线命令执行，这种嵌入式的智能控制可以提供一个实时性非常好的控制效果，即使因为PC的非实时操作系统而产生延时的情况下。因为控制器可以独立运行，也可以采用从动模式，本手册介绍的球杆系统将采用两种模式。IPM100安装于控制箱内部，通过RS232和上位计算机进行通讯，直流电源也置于控制箱内部。2.2设计规范和约束用现代控制理论中的状态反馈方法来实现球杆系统的控制，就是设法调整闭环系统的极点分布，以构成闭环稳定的球杆系统，它的局限性是显而易见的。只要偏离平衡位置较远，系统就成了非线性系统，状态反馈就难以控制。实际上，用线性化模型进行极点配置求得的状态反馈阵，不一定能使球杆系统稳定起来，能使球杆系统稳定起来的状态反馈阵是实际调试出来的，这个调试出来的状态反馈阵肯定满足极点配置。这就是说，满足稳定极点配置的状态反馈阵很多，而能使球杆系统稳定起来的状态反馈阵只有很少的一个范围，这个范围要花大量的时间去寻找。2.3 机械系统设计机械部分包括底座、小球、横杆、减速皮带轮、支撑部分、马达等。如图 2.2图2.4 球杆系统机械设计图选用直流伺服电机，采用齿轮箱减速机构进行减速，在输出齿轮上距齿轮圆心d（小于齿轮半径）处连接一杠杆臂Leaver Arm，此连接处螺钉不能固定太紧，杠杆臂的另一端与轨道 Beam铰链，机构的另一端是一固定座，此固定座上端与轨道的左侧铰链。如上图2.3，在一长约0.4 米的轨道上放置一不锈钢球，轨道的一侧为不锈钢杆，另一侧为直线位移传感器，当球在轨道上滚动时，通过测量不锈钢杆上输出的电压信号可获得球在轨道上的位置x 。电机转动带动齿轮系驱动杠杆臂转动，轨道随杠杆臂的转动与水平方向也有一偏角,球的重力分量会使它沿着轨道滚动，设计一个控制系统通过调节伺服角度使得不锈钢球在杆上的位置能被控制。系统执行机构原理图如上图2.3。图2.5 球杆系统实物简化图 机械系统数学模型如下：为了便于分析我们将实物模型简化如图2.3。实际上使小球在导轨上加速滚动的力是小球的重力在同导轨平行方向上的分力同小球受到的摩擦力的合力。考虑小球滚动的动力学方程，小球在V型杆上滚动的加速度： 式(2.1-1)其中为小球与轨道之间的摩擦系数，而为轨道杆与水平面之间的夹角。 但在进行数学建模的过程中，我们忽略了摩擦力，因此，其基本的数学模型转换成如下方式： 式(2.1-2)当1时，将上式线性化，得到传递函数如下 式(2.1-3)其中X(s)为小球在轨道上的位置。但是，在实际控制的过程中，杆的仰角是由电动机的转角输出来实现的。影响电动机转角和杆仰角之间关系的主要因素就是齿轮的减速比和非线性。因此，我们可以得到它们的关系如下： 式(2.1-4)把式(2.1-4)式代入式(2.1-3)式，我们可以得到另一个模型： 式(2.1-5)因此，球杆系统实际上可以简化为一个二阶系统。由建模分析我们得到球杆系统的开传递函数为: 式(2.1-6)其中X(s)为小球的实际位置，(s)为电机转角。2.4传感器输出信号的数字滤波在系统的输入信号中，一般都含有各种干扰信号，它们入要来自被测信号本身、传感器或者外界的干扰。为了提高信号的可靠性，减小虚假信息的影响，可采用软件方法实现数字滤波。数字滤波就是通过一定算法程序的计算或判断来剔除或减少干扰信号成分，提高信噪比。它与硬件RC滤波器相比具有以下优点：(1) 数字滤波是用软件程序实现的，不需要增加任何硬件设备，也不存在阻抗匹配问题，可以多个通道共用，不但节约投资，还可提高可靠性、稳定性。(2) 可以对频率很低的信号实现滤波，而模拟RC滤波器由于受电容容量的限制,频率不可能太低。 (3) 灵活性好，可以用不同的滤波程序实现不同的滤波方法，或改变滤波器的参数。正因为用软件实现数字滤波具有上述特点，所以在机电一体化测控系统中得到了越来越广泛的应用。 三、理论分析3.1 控制系统建模 由以上理论分析可得系统的方块图如图3.1控制器电机执行机构球杆 Xd 位置测量装置图3.1 系统方块图 其中Xd为输入的阶跃信号，为齿轮的转角，X为输出的信号。 在我们使用的球杆系统中，建模部分主要包括对电机执行机构的建模和对传动杆和球杆的建模，机械系统的建模如上一章机械系统设计部分内容，在此我们忽略对电机部分的建模，将其在S域中所对应的部分传函视为1。综上，我们可得系统的开环传递函数为：其中X(s)为小球的实际位置，(s)为电机转角，L为横杆长度0.4m，d为小球直径0.04m。3.2 原系统稳定性分析3.2.1 原系统概述球杆系统的原系统就是一个未加任何控制器的模型，是对其分析得出的物理模型，并对其加以建模，然后分析它的稳定性。3.2.2待校正系统单位阶跃响应分析:g=9.8;L=0.4;D=0.04;Num=(g*D)/L;Den=1 0 0;Plant=tf(Num,Den);%系统的开环传函kp=0.0001;Sys_cl=feedback(kp*Plant,1,-1);%求系统的闭环传函Step(Sys_cl);由待校正系统的根轨迹图及单位阶跃响应，可知该系统不稳定。3.2.3伯德图分析num0=98; den0=1 0 0; margin=tf(num0,den0); grid; xlabel(伯德图及稳定度分析margin）由Bode图可以看出系统相角裕度为0，所以原系统处于临界稳定状态。原系统根轨迹：num=0.98;den=1 0 0 ;rlocus(num,den);图3.4 原系统根轨迹3.3频率响应法设计球杆系统控制器3.3.1设计要求 要求系统经过校正后相角裕度达到45，保证系统达到稳定。3.3.2相位超前控制器相位超前补偿器具有如下形式： ， 通过频率范围1/aT和1/T（被称为角频率），相位超前补偿器将使系统增加正的相位。超前补偿器最大可补偿的相位是90度。我们希望大于42度的相位裕度。计算步骤：1、求和由开环传递函数可知：K=0.98=0.99rad /s ， =02、根据要求相角裕量，估算需补偿的超前相角 =+=-+=45-0+8=53其中 是为了补偿校正后，由于截止频率变大而导致的原系统相位滞后，一般取5 12。3、求：令 =53所以 4、求T 为了充分利用超前网络的相位超前特性，应使校正后系统的截止频率c正好在m处，即取：c=m 而在m在点上G0(j)的幅值应为：-10lg = -9.51dB 从原系统的伯德图上，我们可求得：m=1.73rad /sm位于1/T与1/T的几何中点，求得： 5、将以上数据带入校正函数，得系统闭环传递函数为G(s)=Go(s)XGc(s)=0.98（1.78S+1）/S2(0.20S+1)6、作出仿真伯德图程序：Go=tf(0.98,1 0 0);Gc=tf(1.78,1,0.20,1);G=series(Go,Gc);Margin(G);Grid on;校正后的仿真伯德图为： 由仿真可知： =52.9 c=1.73rad/s校正后系统单位阶跃响应:g=9.8;L=0.4;D=0.04;Num=(g*D)/L;Den=1 0 0;Plant=tf(Num,Den);Contr=tf(1.78 1,0.20 1);Sys_cl=feedback(Contr*Plant,1,-1);T=0:0.01:5;Step(0.2*Sys_cl);图3.6 超前校正后阶跃响应仿真图由以上两图可以看出超前校正可以使系统达到稳定。系统的根轨迹：num=conv(0.98,1.78,1);den=conv(2 0 0,0.2,1);rlocus(num,den);图3.7 超前校正后根轨迹图3.3.3相位超前-滞后控制器 校正目标：设定稳定误差为1%，故令K=100. 相角裕度为，截止频率为=11rad/s，K=100。由原bode伯德图可知，rad/s 计算步骤： 控制器的传递函数为： （取) 因为，解得 由，解得 因为，得又，解得则控制器的传递函数为=则系统闭环传递函数为G(s)=*Gc(s)=稳定性分析验证Bode图：num0=214.8 311.6 98;den0=2.189 7.913 1 0 0;margin(num0,den0);grid;xlabel(伯德图及稳定度分析)由仿真图可得：=38.7接近预期的45目标。单位阶跃响应:Num=214.8 311.6 98;Den=2.189 7.913 1 0 0;Plant=tf(Num,Den);Contr=tf(6.246 1,6.94 1);Sys_cl=feedback(Contr*Plant,1,-1);Step(0.2*Sys_cl);超前-滞后校正后系统单位阶跃响应Matlab仿真图：图3.9 超前滞后校正阶跃响应仿真图由以上两图可知超前-滞后控制理论上可以使系统达到很好的预期稳定状态。系统的根轨迹：num=214.8 311.6 98;den=(2.189 7.913 1 0 0;rlocus(num,den);图3.10 超前滞后校正阶跃响应根轨迹图3.5.1频域校正方法的比较 超前校正时，低频段的增益满足稳态精度的要求；中频段对数幅频特性的斜率为-20db/dec ，并具有较宽的频带，使系统具有满意的动态性能，但是其响应速度不够理想；而滞后校正则不能达到本系统的要求。滞后-超前校正系统响应速度较快，抑制高频噪声的性能也较好，控制精度由实际响应曲线可看出比超前高，效果比超前校正好。所以这三种方法比较起来滞后-超前校正系统方法比较好。 八、心得体会自动控制原理是一门应用及其广泛的学科，通过这门课程的学习，我学到了很多知识，例如，如何利用多种方法来分析一个系统的动态性能和静态性能，进而分析其稳定性。如果遇到了性能不好的系统，我们应该如何去利用校正装置将其进行改善等。本次课设主要是教会我如何去利用超前校正和滞后校正网络来对原系统的性能进行改善，并要求我们知道超前校正网络和滞后校正网络各自有何特点，如何更好地去选择它们。此外，这次课设还涉及到了MATLAB这个强大的仿真模拟软件，在进行本次课设过程中，为了能很好地完成本次课设的任务，我到图书馆借阅了一些相关的MATLAB软件书籍，并初步了解和掌握如何利用MATLAB仿真软件来分析一个控制系统的稳定性问题。这次自动控制原理课程设计给我带来很大收获，是我应用MATLAB的一个过渡，从基础到以后专业学习的桥梁，同时，也是为我以后分析更加复杂的控制系统打下了坚实的基础。通过这次课设，我也发现了自己在课堂学习上的一些知识漏洞，这对我本人的发展有很大的提升作用。总之，我很珍惜这次锻炼自己