《自动控制的原理课程设计——倒立摆系统控制器设计》由会员分享,可在线阅读,更多相关《自动控制的原理课程设计——倒立摆系统控制器设计(30页珍藏版)》请在金锄头文库上搜索。
1、word1 引言支点在下,重心在上,恒不稳定的系统或装置的叫倒立摆。倒立摆控制系统是一个复杂的、不稳定的、非线性系统,是进展控制理论教学与开展各种控制实验的理想实验平台。1.1 问题的提出倒立摆系统按摆杆数量的不同,可分为一级,二级,三级倒立摆等,多级摆的摆杆之间属于自有连接即无电动机或其他驱动设备。对倒立摆系统的研究能有效的反映控制中的许多典型问题:如非线性问题、鲁棒性问题、镇定问题、随动问题以与跟踪问题等。通过对倒立摆的控制,用来检验新的控制方法是否有较强的处理非线性和不稳定性问题的能力。倒立摆的控制问题就是使摆杆尽快地达到一个平衡位置,并且使之没有大的振荡和过大的角度和速度。当摆杆到达期
2、望的位置后,系统能克制随机扰动而保持稳定的位置。1.2 倒立摆的控制方法倒立摆系统的输入来自传感器的小车与摆杆的实际位置信号,与期望值进展比拟后,通过控制算法得到控制量,再经数模转换驱动直流电机实现倒立摆的实时控制。直流电机通过皮带带动小车在固定的轨道上运动,摆杆的一端安装在小车上,能以此点为轴心使摆杆能在垂直的平面上自由地摆动。作用力u平行于铁轨的方向作用于小车,使杆绕小车上的轴在竖直平面内旋转,小车沿着水平铁轨运动。当没有作用力时,摆杆处于垂直的稳定的平衡位置竖直向下。为了使杆子摆动或者达到竖直向上的稳定,需要给小车一个控制力,使其在轨道上被往前或朝后拉动。本次设计中我们采用其中的牛顿欧拉
3、方法建立直线型一级倒立摆系统的数学模型,然后通过开环响应分析对该模型进展分析,并利用学习的古典控制理论和Matlab /Simulink仿真软件对系统进展控制器的设计,主要采用根轨迹法,频域法以与PID比例-积分-微分控制器进展模拟控制矫正。2 直线倒立摆数学模型的建立直线一级倒立摆由直线运动模块和一级摆体组件组成,是最常见的倒立摆之一,直线倒立摆是在直线运动模块上装有摆体组件,直线运动模块有一个自由度,小车可以沿导轨水平运动,在小车上装载不同的摆体组件。系统建模可以分为两种:机理建模和实验建模。实验建模就是通过在研究对象上加上一系列的研究者事先确定的输入信号,激励研究对象并通过传感器检测其可
4、观测的输出,应用数学手段建立起系统的输入输出关系。这里面包括输入信号的设计选取,输出信号的准确检测,数学算法的研究等等内容。鉴于小车倒立摆系统是不稳定系统,实验建模存在一定的困难。因此,本文通过机理建模方法建立小车倒立摆的实际数学模型,可根据微分方程求解传递函数。2.1 微分方程的推导牛顿力学方法微分方程的推导在忽略了空气阻力和各种摩擦之后,可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统,如图1所示。做以下假设:M小车质量m摆杆质量b小车摩擦系数I 摆杆惯量F加在小车上的力x小车位置F摆杆与垂直向上方向的夹角q摆杆与垂直向下方向的夹角考虑到摆杆初始位置为竖直向下图2-1 直线一级倒立摆模型
5、系统中小车和摆杆的受力分析图是图2。其中,N和P为小车与摆杆相互作用力的水平和垂直方向的分量。注意:在实际倒立摆系统中检测和执行装置的正负方向已经完全确定,因而矢量方向定义如图2所示,图示方向为矢量正方向。图2-2 小车与摆杆受力分析分析小车水平方向所受的合力,可以得到以下方程:(2-1)由摆杆水平方向的受力进展分析可以得到下面等式:(2-2)即:(2-3)把这个等式代入式(1)中,就得到小车运动方程第一个运动方程:(2-4)为了推出摆杆的运动方程第二个运动方程,对摆杆垂直方向上的合力进展分析,可以得到下面方程:(2-5)(2-6)力矩平衡方程如下:(2-7)注意:方程中力矩的方向,由于(6)
6、和3代入(7),约去P和N,得到摆杆运动方程第二个运动方程:(2-8)设是摆杆与垂直向上方向之间的夹角,假设与1单位是弧度相比很小,即,如此可以进展线性化近似处理:用来代表被控对象的输入力,线性化后两个运动方程如下:进展拉氏变换,得:2-9由于输出为角度,求解方程组的第一个方程,可以得到:,即:2-1010式称为摆杆角度与小车位移的传递函数如令,如此有:2-1111式称为摆杆角度与小车加速度间的传递函数,由于伺服电机的速度控制易于实现在实验中常采用此式。把10式代入9式的第二个方程中,得到:2-12其中,12式称为摆杆角度与外加作用力间的传递函数2.2 实际系统的模型参数2实际数学模型把上述参
7、数代入,可以得到系统的实际模型。1) 摆杆角度和小车位移的传递函数: (2-13)2) 摆杆角度和小车加速度之间的传递函数为: (2-14)3) 摆杆角度和小车所受外界作用力的传递函数: (2-15)4) 小车位置和加速度的传递函数 (2-16)3 开环系统的时域分析3.1 摆杆角度为输出响应的时域分析本系统采用以小车的加速度作为系统的输入,摆杆角度为输出响应,此时的传递函数为(3-1)图3.1 摆杆角度的单位脉冲响应曲线图图3.2 摆杆角度的单位阶跃响应曲线图3.2 小车位置为输出响应的时域分析采用以小车的加速度作为系统的输入,小车位置为响应,如此此时的传递函数为 (3-2) 图3.3 小车
8、位置的单位脉冲响应曲线图图3.4 小车位置的单位阶跃响应曲线图由于以上时域分析中所有的传递函数的响应图都是发散的,所以系统不稳定,需要校正。4 根轨迹法设计4.1 原系统的根轨迹分析本系统采用以小车的加速度作为系统的输入,摆杆角度为输出响应,此前已经得出的传递函数为 (4-1)运行结果: 闭环零点z =Empty matrix: 0-by-1图4.1 原系统根轨迹曲线图可以看出,系统无零点,有两个极点,并且有一个极点为正。画出系统闭环传递函数的根轨迹如图2-6,可以看出闭环传递函数的一个极点位于右半平面,并且有一条根轨迹起始于该极点,并沿着实轴向左跑到位于原点的零点处,这意味着无论增益如何变化
9、,这条根轨迹总是位于右半平面,即系统总是不稳定的。4.2 串联超前校正装置设计对此系统设计控制器,使得校正后系统的要求如下:调整时间: ;最大超调量: 由最大超调量 (4.2)4.2 闭环主导极点所在的极坐标图在此我们对超调量留有一定余量,令 可以得到:由可以得到: (弧度)其中为位于第二象限的极点和O点的连线与实轴负方向的夹角。又由:对调节时间留有一定余量,令 (2%的误差带)取其为0.2s,可以得到:,于是可以得到期望的闭环主导极点为:代入数据后,可得期望的闭环主导极点为:4.2.2 超前校正传递函数设计未校正系统的根轨迹在实轴和虚轴上,不通过闭环期望极点,因此需要对系统进展超前校正,设控
10、制器为: (4-3)4.2.3 校正参数计算计算超前校正装置应提供的相角,期望的闭环主导极点和系统原来的极点的相角和为: (4-4)因此校正装置提供的相角为:(4-5)又 对于最大的值的角度可由下式计算得到: (4-6) 由于角度都已求出,线段SO的长度即为自然频率的大小,故可用正弦定理计算,求出超前校正装置的零点和极点正弦定理分别为: 4.2.4 超前校正控制器校正后系统的开环传递函数为: (4-7) 由幅值条件,并设反应为单位反应,所以有对相应参数保存五位有效值,于是我们得到了系统的控制器:(4.8) 4.2.5 matlab环境下串联超前校正后的根轨迹图在 MATLAB 中编写如下的m
11、文件,对系统进展仿真,运行即可以得到以上的计算结果,校正后系统的跟轨迹如如下图所示:图4.4 串联超前校正后系统的根轨迹图从图4.4中可以看出,系统的三条根轨迹都有位于左半平面的局部,选取适当的 K 就可以稳定系统。4.2.6 simulink环境下对串联超前校正的仿真图4.5 串联超前校正simulink流程图图4.6 串联超前校正后的阶跃响应曲线4.3 串联滞后-超前校正装置设计4.3.1 控制器的设计可以看出,系统在0.5s 的时间内可以稳定,响应比拟迅速,超调比拟小。为使系统满足相应的要求,减少稳态误差,在超前校正的根底上可以引入滞后校正装置。 滞后校正的传递函数采用 (4-9) 如此
12、此时总的超前-滞后校正传递函数为(4-10) 4.3.2 simulink环境下对串联超前校正的仿真图4.7 串联滞后-超前校正simulink流程图图4.8 串联超前校正后的阶跃响应曲线由上图可以看出,参加滞后环节中超调量增加不是很大,但是稳态误差已经明显减少了,所以说串联滞后-超前装置对于改善系统性能来说作用比拟理想5 频域法设计5.1系统频域响应分析 系统对正弦输入信号的响应,称为频率响应。在频率响应方法中,在一定X围内改变输入信号的频率,研究其产生的响应。频率响应可以采用以下两种方法进展分析:一种为伯德图,采用两幅别离图,一幅表示幅频特性,一幅表示相频特性;另一种是奈奎斯特图,表示的是
13、当从0 变化到无穷大时,向量的矢端轨迹。奈奎斯稳定判据使我们有可能根据系统的开环频率响应特性信息,研究线性闭环系统的绝对稳定性和相对稳定性。根据式2-17我们已经得到了直线一级倒立摆的数学模型,实际系统的开环传递函数为:其中输入为小车的加速度,输出为摆杆的角速度。利用Matlab绘制系统的Bode图图5.1和Nyquist图图5.2如下。图 5.1 直线一级倒立摆系统的Bode图图 5.2 直线一级倒立摆系统的Nyquist图由4.1节中的计算可知:系统不存在零点,但存在两个极点,其中一个极点位于S平面的右半局部。根据奈奎斯特稳定判据,闭环系统稳定的充分必要条件是:当由变化时,曲线逆时针包围平
14、面上点的次数等于开环传递函数右极点个数。对于直线一级倒立摆,由图5-1和图5-2我们可以看出,开环传递函数在S右半平面有一个极点。因此,曲线逆时针包围点的次数。而本系统的奈奎斯特图并没有逆时针包围点一圈即。因此系统不稳定,需要设计控制器来稳定系统。直线一级倒立摆的频率响应设计可以表示为如下问题:考虑一个单位负反应系统,其开环传递函数为:设计控制器,使得系统的静态位置误差常数为10,相位裕量为,增益裕量等于或大于。5.2.1 控制器的选择根据图5-1和图5-2可以初步观察出,给系统增加一个超前校正就可以满足设计要求,设超前校正装置为:5-1如此已校正系统具有开环传递函数,设5-2其中。5.2.2 系统开环增益的计算根据稳态误差要求计算增益可以得到:5-4于是有: