![点击分享此内容可以赚币 分享](/master/images/share_but.png)
倒立摆实验报告大学论文.doc
《倒立摆实验报告大学论文.doc》由会员分享,可在线阅读,更多相关《倒立摆实验报告大学论文.doc(67页珍藏版)》请在咨信网上搜索。
1、倒立摆实验报告机自82 组员:李宗泽 李航 刘凯 付荣倒立摆与自动控制原理实验一 实验目的:1.运用经典控制理论控制直线一级倒立摆,包括实际系统模型的建立、根轨迹分析和控制器设计、频率响应分析、PID 控制分析等内容.2.运用现代控制理论中的线性最优控制LQR 方法实验控制倒立摆3.学习运用模糊控制理论控制倒立摆系统4.学习MATLAB工具软件在控制工程中的应用5.掌握对实际系统进行建模的方法,熟悉利用MATLAB 对系统模型进行仿真,利用学习的控制理论对系统进行控制器的设计,并对系统进行实际控制实验,对实验结果进行观察和分析,非常直观的感受控制器的控制作用。二. 实验设备计算机及MATLAB
2、.VC等相关软件固高倒立摆系统的软件固高一级直线倒立摆系统,包括运动卡和倒立摆实物倒立摆相关安装工具三 倒立摆系统介绍倒立摆是机器人技术、控制理论、计算机控制等多个领域、多种技术的有机结合,其被控系统本身又是一个绝对不稳定、高阶次、多变量、强耦合的非线性系统,可以作为一个典型的控制对象对其进行研究。倒立摆系统作为控制理论研究中的一种比较理想的实验手段,为自动控制理论的教学、实验和科研构建一个良好的实验平台,以用来检验某种控制理论或方法的典型方案,促进了控制系统新理论、新思想的发展。由于控制理论的广泛应用,由此系统研究产生的方法和技术将在半导体及精密仪器加工、机器人控制技术、人工智能、导弹拦截控
3、制系统、航空对接控制技术、火箭发射中的垂直度控制、卫星飞行中的姿态控制和一般工业应用等方面具有广阔的利用开发前景。倒立摆已经由原来的直线一级倒立摆扩展出很多种类,典型的有直线倒立摆环形倒立摆,平面倒立摆和复合倒立摆等,本次实验采用的是直线一级倒立摆。倒立摆的形式和结构各异,但所有的倒立摆都具有以下的特性: 1) 非线性2) 不确定性3) 耦合性4) 开环不稳定性5) 约束限制倒立摆控制器的设计是倒立摆系统的核心内容,因为倒立摆是一个绝对不稳定的系统,为使其保持稳定并且可以承受一定的干扰,需要给系统设计控制器,本小组采用的控制方法有:PID 控制、双PID控制、LQR控制、模糊PID控制、纯模糊
4、控制四直线一级倒立摆的物理模型:系统建模可以分为两种:机理建模和实验建模。实验建模就是通过在研究对象上加上一系列的研究者事先确定的输入信号,激励研究对象并通过传感器检测其可观测的输出,应用数学手段建立起系统的输入输出关系。机理建模就是在了解研究对象的运动规律基础上,通过物理、化学的知识和数学手段建立起系统内部的输入状态关系。,由于倒立摆本身是自不稳定的系统,实验建模存在一定的困难。但是忽略掉一些次要的因素后,倒立摆系统就是一个典型的运动的刚体系统,可以在惯性坐标系内应用经典力学理论建立系统的动力学方程。 下面我们采用牛顿欧拉方法建立直线型一级倒立摆系统的数学模型: 在忽略了空气阻力和各种摩擦之
5、后,可将直线一级倒立摆系统抽象成小车和匀质杆组成的系统,如图所示:我们不妨做以下假设:M 小车质量m 摆杆质量b 小车摩擦系数l 摆杆转动轴心到杆质心的长度I 摆杆惯量F 加在小车上的力x 小车位置 摆杆与垂直向上方向的夹角 摆杆与垂直向下方向的夹角(考虑到摆杆初始位置为竖直向下)图是系统中小车和摆杆的受力分析图。其中,N 和P 为小车与摆杆相互作用力的水平和垂直方向的分量。注意:在实际倒立摆系统中检测和执行装置的正负方向已经完全确定,因而矢量方向定义如图所示,图示方向为矢量正方向。分析小车水平方向所受的合力,可以得到以下方程: (3-1)由摆杆水平方向的受力进行分析可以得到下面等式: (3-
6、2)即: (3-3)把这个等式代入式(3-1)中,就得到系统的第一个运动方程: (3-4)为了推出系统的第二个运动方程,我们对摆杆垂直方向上的合力进行分析,可以得到下面方程: (3-5) (3-6)力矩平衡方程如下: (3-7)注意:此方程中力矩的方向,由l,故等式前面有负号。合并这两个方程,约去P 和N,得到第二个运动方程: (3-8)设=+( 是摆杆与垂直向上方向之间的夹角),假设与1(单位是弧度)相比很小,即1,则可以进行近似处理: 用u 来代表被控对象的输入力F,线性化后两个运动方程如下: (3-9)对式(3-9)进行拉普拉斯变换,得到 (3-10)注意:推导传递函数时假设初始条件为0
7、。由于输出为角度,求解方程组的第一个方程,可以得到: 或 如果令 则有: 把上式代入方程组的第二个方程,得到: 整理后得到传递函数: 其中 设系统状态空间方程为: 方程组 对, 解代数方程,得到解如下: 整理后得到系统状态空间方程: 由(3-9)的第一个方程为:对于质量均匀分布的摆杆有:于是可以得到: 化简得到: 设 则有: 另外,也可以利用MATLAB 中tf2ss 命令对(3-13)式进行转化,求得上述状态方程。实际系统的模型参数如下:M 小车质量 1.096 Kgm 摆杆质量 0.109 Kgb 小车摩擦系数 0 .1N/m/secl 摆杆转动轴心到杆质心的长度 0.2 5mI 摆杆惯量
8、 0.0034 kg*m*m把上述参数代入,可以得到系统的实际模型。摆杆角度和小车位移的传递函数: 摆杆角度和小车加速度之间的传递函数为:摆杆角度和小车所受外界作用力的传递函数:以外界作用力作为输入的系统状态方程: 以小车加速度作为输入的系统状态方程: 注意事项:在固高科技所有提供的控制器设计和程序中,采用的都是以小车的加速度作为系统的输入,如果用户需要采用力矩控制的方法,可以参考以上把外界作用力作为输入的各式。五系统的阶越响应分析 根据已经得到系统的状态方程,先对其进行阶跃响应分析,在MATLAB 中键入以下命令:clear;A= 0 1 0 0;0 0 0 0;0 0 0 1;0 0 29
9、.4 0;B= 0 1 0 3;C= 1 0 0 0;0 1 0 0;D= 0 0 ;step(A, B ,C ,D)可以看出,在单位阶跃响应作用下,小车位置和摆杆角度都是发散的。六频率响应分析(系统稳定性分析) 前面我们已经得到了直线一级倒立摆的物理模型,实际系统的开环传递函数为:其中输入为小车的加速度V (s) ,输出为摆杆的角度(s) 。在MATLAB 下绘制系统的Bode 图和奈奎斯特图。在MATLAB 中键入以下命令:clear;num=0.02725;den=0.0102125 0 -0.26705;z=roots(num);p=roots(den);subplot(2,1,1)b
10、ode(num,den)subplot(2,1,2)nyquist(num,den)得到如下图所示的结果: z =Empty matrix: 0-by-1p =5.1136-5.1136可以得到,系统没有零点,但存在两个极点,其中一个极点位于右半s 平面,根据奈奎斯特稳定判据,闭环系统稳定的充分必要条件是:当 从 到+ 变化时,开环传递函数G( j ) 沿逆时针方向包围-1 点p 圈,其中p 为开环传递函数在右半S 平面内的极点数。对于直线一级倒立摆,由奈奎斯特图我们可以看出,开环传递函数在S 右半平面有一个极点,因此G( j ) 需要沿逆时针方向包围-1 点一圈。可以看出,系统的奈奎斯特图并
11、没有逆时针绕-1 点一圈,因此系统不稳定,需要设计控制器来镇定系统。七具体控制方法(一)双PID控制 直线一级倒立摆双PID 控制实验 1PID 控制分析 经典控制理论的研究对象主要是单输入单输出的系统,控制器设计时一般需 要有关被控对象的较精确模型。PID 控制器因其结构简单,容易调节,且不需要 对系统建立精确的模型,在控制上应用较广。 对于倒立摆系统输出量为摆杆的角度,它的平衡位置为垂直向上的情 况。系统控制结构框图如下:2.双PID实验控制参数设定及仿真。在Simulinkzhong 建立直线一级倒立摆模型上下两个PID模块。鼠标右键,选择 “ Look under mask”打开模型内
12、部结构分别为:双击第二个模块打开参数设置窗口令kp=1.ki=0.kd=0得到摆杆角度仿真结果可看出控制曲线不收敛。因此增大控制量。令kp=-30.ki=0.kd=4.6.得到如下仿真结果从上面摆杆角度仿真结果可看出,稳定比较好。但稳定时间稍微有点长。双击第一个模块打开参数设置窗经多次尝试在此参数即kp=-7,ki=0,kp=-4.5 情况下效果最好。得到以下仿真结果黄线为小车位置输出曲线,红线为摆杆角度输出曲线。从图中可以看出,系统可以比较好的稳定。稳定时间在2-3秒之间。稳定性不错。3双PID控制实验打开直线一级倒立摆爽PID实时控制模块双击doublePID控制模块进入参数设置把参数输入
13、PID控制器。编译程序,使计算机同倒立摆连接。运行程序。实验结果如下图所示从图中可以看出,倒立摆可以实现比较好的稳定性。(二)线性最优二次控制LQR 线性二次最优控制LQR 控制实验 1线性二次最优控制LQR 基本原理及分析 线性二次最优控制LQR 基本原理为,由系统方程: 确定下列最佳控制向量的矩阵K: u(t)=-K*x(t) 使得性能指标达到最小值: 式中 Q正定(或正半定)厄米特或实对称阵 R为正定厄米特或实对称阵 图 3-54 最优控制LQR 控制原理图 方程右端第二项是考虑到控制能量的损耗而引进的,矩阵Q和R确定了误差和能量损耗的相对重要性。并且假设控制向量u(t)是无约束的。 对
14、线性系统: 根据期望性能指标选取Q 和R,利用MATLAB 命令lqr 就可以得到反馈矩阵 K 的值。 K=lqr(A,B,Q,R) 改变矩阵Q 的值,可以得到不同的响应效果,Q 的值越大(在一定的范围之内),系统抵抗干扰的能力越强,调整时间越短。但是Q 不能过大 2. LQR 控制参数调节及仿真 前面我们已经得到了直线一级倒立摆系统的比较精确的动力学模型,下面我们针对直线型一级倒立摆系统应用 LQR 法设计与调节控制器,控制摆杆保持竖直向上平衡的同时,跟踪小车的位置。 前面我们已经得到了直线一级倒立摆系统的系统状态方程: 应用线性反馈控制器,控制系统结构如下图。图中 R 是施加在小车上的阶跃
15、输入,四个状态量x,x,分别代表小车位移、小车速度、摆杆角度和摆杆角速度,输出y = x, 包括小车位置和摆杆角度。设计控制器使得当给系统施加一个阶跃输入时,摆杆会摆动,然后仍然回到垂直位置,小车可以到达新的指定位置。 假设全状态反馈可以实现(四个状态量都可测),找出确定反馈控制规律的向量K 。在 Matlab 中得到最优控制器对应的K 。Lqr 函数允许你选择两个参数R 和Q,这两个参数用来平衡输入量和状态量的权重。最简单的情况是假设 R = 1,Q =C *C 。当然,也可以通过改变Q 矩阵中的非零元素来调节控制器以得到期望的响应。 其中, Q1,1 代表小车位置的权重,而Q3,3 是摆杆
16、角度的权重,输入的权重R 是 1。 下面来求矩阵K,Matlab 语句为K = lqr(A,B,Q,R) 。下面在MATLAB 中编程计算:A=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 0 1 0;D=0 0;Q11=1500;Q33=300;Q=Q11 0 0 0; 0 0 0 0; 0 0 Q33 0; 0 0 0 0;R=1;K=lqr(A,B,Q,R);Ac=(A-B*K);Bc=B;Cc=C;Dc=D;T=0:0.005:5;U=0.2*ones(size(T);Cn=1 0 0 0;Nbar=rscal
17、e(A,B,Cn,0,K);Bcn=Nbar*B;Y,X=lsim(Ac,Bc,Cc,Dc,U,T);plot(T,X(:,1),-);hold on;plot(T,X(:,2),-);hold on;plot(T,X(:,3),.);hold on;plot(T,X(:,4),-);legend(cartpls,cartspd,pendang,pendspd)令Q1,1= 1,Q3,3 =1求得 K -1 -1.7855 25.422 4.6849 在 Simulink 中建立直线一级倒立摆的模型如下图所示:“LQR Controller”为一封装好的模块,在其上单击鼠标右键,选择“Look
18、 under mask”打开LQR Controller 结构如下: 双击“Matrix gain K”即可输入控制参数: 点击 执行仿真,得到如下仿真结果:LQR 控制的阶跃响应如上图所示,从图中可以看出,闭环控制系统响应的超调量很小,但稳定时间和上升时间偏大,我们可以通过增大控制量来缩短稳定时间和上升时间。 可以发现,Q 矩阵中,增加Q11 使稳定时间和上升时间变短,并且使摆杆的角度变化减小。经过多次尝试,这里取Q1,1=1500, Q3,3 =300, 则K = -32.7298 -23.8255 81.6182 14.7098 输入参数,运行得到响应曲线如下:从图中可以看出,系统响应时
19、间有明显的改善,增大Q1,1 和Q3,3 ,系统的响应还会更快,但是对于实际离散控制系统,过大的控制量会引起系统振荡。3.直线一级倒立摆LQR控制实验打开直线一级倒立摆LQR 实时控制模块 其中“LQR Controller”为LQR 控制器模块,“Real Control”为实时控制模块,双击“LQR Controller”模块打开LQR 控制器参数设置窗口如下:在“LQR Controller”模块上点击鼠标右键选择“Look under mask”打开模 型如下: 双击“Real Control”模块打开实时控制模块如下图: 其中“Pendulum”模块为倒立摆系统输入输出模块,输入为小
20、车的速度“Vel ”和“Acc ”,输出为小车的位置“Pos”和摆杆的角度“Angle ”。 双击“Pendulum”模块打开其内部结构:其中“Set Carts Acc and Vel”模块的作用是设置小车运动的速度和加速度, Get Carts Position”模块的作用是读取小车当前的实际位置,“Get Pends Angle” 的作用是读取摆杆当前的实际角度。2) 运行程序, 实验运行结果如下图所示: 其中图片上半部分为小车的位置曲线,下半部分为摆杆角度的变化曲线,从图中可以看出,小车位置和摆杆角度比较稳定。控制效果很好。在此实验中,R值固定,R=1,则只调节Q值,Q11 代表小车位
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 倒立 实验 报告 大学 论文
![提示](https://www.zixin.com.cn/images/bang_tan.gif)
1、咨信平台为文档C2C交易模式,即用户上传的文档直接被用户下载,收益归上传人(含作者)所有;本站仅是提供信息存储空间和展示预览,仅对用户上传内容的表现方式做保护处理,对上载内容不做任何修改或编辑。所展示的作品文档包括内容和图片全部来源于网络用户和作者上传投稿,我们不确定上传用户享有完全著作权,根据《信息网络传播权保护条例》,如果侵犯了您的版权、权益或隐私,请联系我们,核实后会尽快下架及时删除,并可随时和客服了解处理情况,尊重保护知识产权我们共同努力。
2、文档的总页数、文档格式和文档大小以系统显示为准(内容中显示的页数不一定正确),网站客服只以系统显示的页数、文件格式、文档大小作为仲裁依据,平台无法对文档的真实性、完整性、权威性、准确性、专业性及其观点立场做任何保证或承诺,下载前须认真查看,确认无误后再购买,务必慎重购买;若有违法违纪将进行移交司法处理,若涉侵权平台将进行基本处罚并下架。
3、本站所有内容均由用户上传,付费前请自行鉴别,如您付费,意味着您已接受本站规则且自行承担风险,本站不进行额外附加服务,虚拟产品一经售出概不退款(未进行购买下载可退充值款),文档一经付费(服务费)、不意味着购买了该文档的版权,仅供个人/单位学习、研究之用,不得用于商业用途,未经授权,严禁复制、发行、汇编、翻译或者网络传播等,侵权必究。
4、如你看到网页展示的文档有www.zixin.com.cn水印,是因预览和防盗链等技术需要对页面进行转换压缩成图而已,我们并不对上传的文档进行任何编辑或修改,文档下载后都不会有水印标识(原文档上传前个别存留的除外),下载后原文更清晰;试题试卷类文档,如果标题没有明确说明有答案则都视为没有答案,请知晓;PPT和DOC文档可被视为“模板”,允许上传人保留章节、目录结构的情况下删减部份的内容;PDF文档不管是原文档转换或图片扫描而得,本站不作要求视为允许,下载前自行私信或留言给上传者【精***】。
5、本文档所展示的图片、画像、字体、音乐的版权可能需版权方额外授权,请谨慎使用;网站提供的党政主题相关内容(国旗、国徽、党徽--等)目的在于配合国家政策宣传,仅限个人学习分享使用,禁止用于任何广告和商用目的。
6、文档遇到问题,请及时私信或留言给本站上传会员【精***】,需本站解决可联系【 微信客服】、【 QQ客服】,若有其他问题请点击或扫码反馈【 服务填表】;文档侵犯商业秘密、侵犯著作权、侵犯人身权等,请点击“【 版权申诉】”(推荐),意见反馈和侵权处理邮箱:1219186828@qq.com;也可以拔打客服电话:4008-655-100;投诉/维权电话:4009-655-100。