倒立摆系统的控制器设计.doc
《倒立摆系统的控制器设计.doc》由会员分享,可在线阅读,更多相关《倒立摆系统的控制器设计.doc(22页珍藏版)》请在淘文阁 - 分享文档赚钱的网站上搜索。
1、如有侵权,请联系网站删除,仅供学习与交流倒立摆系统的控制器设计【精品文档】第 - 21 - 页目录摘要倒立摆是一种典型的非线性,多变量,强耦合,不稳定系统,许多抽象的控制概念如系统的稳定性、可控性、系统的抗干扰能力等都可以通过倒立摆直观的反应出来;倒立摆的控制思想在实际中如实验、教学、科研中也得到广泛的应用;在火箭飞行姿态的控制、人工智能、机器人站立与行走等领域有广阔的开发和利用前景。因此,对倒立摆系统的研究具有十分重要的理论和实践意义。本文首先将直线倒立摆抽象为简单的模型以便于受力分析进行机理建模,然后通过牛顿力学原理进行分析,得出相应的模型,进行拉氏变化带入相应参数得出摆杆角度和小车位移、
2、摆杆角度和小车加速度、摆杆角度和小车所受外界作用力、小车位移与小车所受外界作用力的传递函数,其中摆杆角度和小车加速度之间的传递函数为: (1)即我们在本次设计中主要分析的系统的传递函数。然后从时域角度着手,分析直线一级倒立摆的开环单位阶跃响应和单位脉冲响应,利用Matlab中的Simulink仿真工具进行仿真,得出结论该系统的开环响应是发散的。最后分别利用根轨迹分析法,频域分析法和PID控制法对倒立摆系统进行校正。针对目标一:调整时间,最大超调量,选取参数利用根轨迹法进行校正,得出利用超前校正环节的传递函数为: (2)针对目标二:系统的静态位置误差常数为10;相位裕量为 50;增益裕量等于或大
3、于10 分贝。通过频域法得出利用超前校正环节的传递函数为: (3)针对目标三: 调整时间,最大超调量,设计或调整PID控制器参数,得出调整后的传递函数为: .(4)关键词:直线一级倒立摆根轨迹分析频域分析PID控制1 倒立摆系统概述1.1倒立摆的种类悬挂式、直线、环形、平面倒立摆等。一级、二级、三级、四级乃至多级倒立摆。1.2系统的组成倒立摆系统由倒立摆本体,电控箱以及控制平台(包括运动控制卡和PC机)三大部分组成。1.3工程背景 机器人的站立与行走类似双倒立摆系统。在火箭等飞行器的飞行过程中为了保持其正确的姿态要不断进行实时控制。通信卫星要保持其稳定的姿态使卫星天线一直指向地球,使它的太阳能
4、电池板一直指向太阳。为了提高侦察卫星中摄像机的摄像质量必须能自动地保持伺服云台的稳定消除震动。多级火箭飞行姿态的控制也可以用多级倒立摆系统进行研究。倒立摆系统是机器人技术、控制理论、计算机控制等多个领域、多种技术的有机结合。2 数学模型的建立2.1牛顿力学法系统分析通过以上假设,将倒立摆抽象为如图所示的系统图 直线一级倒立摆模型 M 小车质量1.096 Kg m 摆杆质量0.109 Kg b 小车摩擦系数0.1N/m/sec l 摆杆转动轴心到质心长度0.25m I 摆杆惯量0.0034 kgm2 F 加在小车上的力 x 小车位置 f 摆杆与垂直向上方向的夹角 q 摆杆与垂直向下方向的夹角图
5、小车及摆杆受力分析N 和P 为小车与摆杆相互作用力的水平和垂直方向的分量 。首先对小车水平方向所受的合力和对摆杆水平方向的受力进行分析,得到系统的第一个运动方程。对小车水平方向所受的合力进行分析,得到如下方程: (2-1-1)对摆杆水平方向的受力进行分析,得到如下面方程: (2-1-2)即: (2-1-3)把这个表达式代入式(4-1)中,得到系统的第一个运动方程: (2-1-4)然后通过对摆杆垂直方向上的合力进行分析,得到系统的第二个运动方程。对摆杆垂直方向上的合力进行分析,得到方程如下: (2-1-5) (2-1-6)力矩平衡方程如下: (2-1-7)此方程中力矩的方向,如图所示 , 则,故
6、等式前面有负号。合并这两个方程,约去 P 和N,得到第二个运动方程: (2-1-8)设(是摆杆与垂直向上方向之间的夹角),假设与1(单位是弧度)相比很小,即,则可以进行近似认为。用u 来代表被控对象的输入力F,线性化后两个运动方程如下3: (2-1-9)假设初始条件为0,对式(3-9)进行拉普拉斯变换,得到: (2-1-10)由于输出为角度 ,求解方程组的第一个方程,可以得到: (2-1-11) (2-1-12)令v = x,则有: (2-1-13)把上式代入方程组的第二个运动方程,得到:(2-1-14)整理后得到传递函数: (2-1-15)其中。2.2拉氏变换后实际系统的模型本系统采用以小车
7、的加速度作为系统的输入,把上述参数代入,可以得到系统的实际模型。摆杆角度和小车位移的传递函数:(2-2-1)摆杆角度和小车加速度之间的传递函数为: (2-2-2)摆杆角度和小车所受外界作用力的传递函数: (2-2-3)3 开环响应分析当输入为小车加速度时,分析摆杆角度与小车位置的脉冲响应和阶跃响应。由式(2-2-1)、(2-1-2)或者通过受力分析物理公式均可得到小车位移和小车加速度的传递函数: (3-1)利用Matlab中的Simulink仿真工具进行仿真,仿真系统的结构如图摆杆角度的单位脉冲、阶跃响应,小车位置的单位脉冲、阶跃响应如下图摆杆角度的阶跃响应 摆杆角度的脉冲响应小车位置的阶跃响
8、应 小车位置的脉冲响应从图可知,输入加速度时,摆杆角度及小车位移的阶跃响应和脉冲响应都是发散的。倒立摆系统不稳定,需要进行校正。4 根轨迹法设计4.1校正前倒立摆系统的闭环传递函数的分析本系统采用小车的加速度作为系统的输入,摆杆角度为输出响应,得出的传递函数:即式(2-2-2)。4.2系统稳定性分析在MATLAB中新建一个m文件,并进行编程如下:num=0.02725;den=0.01021250-0.26705;rlocus(num,den)p=roots(den)保存后运行文件,由结果可知该系统不存在开环零点,仅有两个绝对值相等的开环实极点。并绘制出了未校正系统的根轨迹图如下 可以看出闭环
9、传递函数的一个极点位于右半平面,并且有一条根轨迹起始于该极点,并沿着实轴向左到位于原点的零点处,这说明无论增益如何变化,这条根轨迹总是位于右半平面,即系统总是不稳定的。4.3 根轨迹设计开环传递函数:设计控制器,使得校正后系统的性能指标满足:最大超调量调整时间1、根据性能指标,计算校正后闭环主导极点的坐标。 由于最大超调量:s 有公式 我们可以算出为0.591155,取为0.69。由=得,。又调节时间为 0.5s(=2%)取 =0.5s 得=13.043由特征根为s1,2= 得期待闭环主导极点s1,2 =-8.9999.4406j=101.422、计算超前校正网络应提供的超前相角。=180-1
10、01.32=78.583、计算角、和。=27.52=6.2730 =27.1194 故校正网络的传递函数为: 4、由幅值条件,计算Kc根据幅值条件|=1,可得到Kc=135.07755、控制器的确定得到了系统的超前校正控制器: (4-3-1)6、校正后系统的验证通过MATLAB作图,得校正后根轨迹如图单位阶跃响应如图可知虽然本次校正使系统的性能得到了改善,但是还无法达到我们之前要求到的超调量的性能指标,所以我们需要通过改变校正环节中的各项参数来调整系统,使之能够达到系统设计要求。由于增大超调量会变小,经过多次尝试,发现当时,满足性能指标。其单位阶跃如图4.4 SIMULINK仿真建立仿真模型如
11、下:仿真结果如下:由图可看到,系统的超调量较小,调节时间短,性能指标较好,系统校正成功。5 直线一级倒立摆频域法设计5.1 系统频域响应分析系统对正弦输入信号的响应,称为频率响应。在频率响应方法中,在一定范围内改变输入信号的频率,研究其产生的响应。频率响应可以采用以下两种方法进行分析:一种为伯德图,采用两幅分离图,一幅表示幅频特性,一幅表示相频特性;另一种是奈奎斯特图,表示的是当从0 变化到无穷大时,向量 的矢端轨迹。奈奎斯特稳定判据使我们有可能根据系统的开环频率响应特性信息,研究线性闭环系统的绝对稳定性和相对稳定性。根据式(2-2-2)我们已经得到了直线一级倒立摆的数学模型,实际系统的开环传
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 倒立 系统 控制器 设计
限制150内