2023年倒立摆实验报告(大全五篇).docx
《2023年倒立摆实验报告(大全五篇).docx》由会员分享,可在线阅读,更多相关《2023年倒立摆实验报告(大全五篇).docx(101页珍藏版)》请在淘文阁 - 分享文档赚钱的网站上搜索。
1、2023年倒立摆实验报告(大全五篇) 第一篇:倒立摆试验报告 倒立摆试验报告 机自 82 组员:李宗泽 李航 刘凯 付荣 倒立摆与自动限制原理试验 一.试验目得: 1、运用经典限制理论限制直线一级倒立摆,包括实际系统模型得建立、根轨迹分析与限制器设计、频率响应分析、PID 限制分析等内容、运用现代限制理论中得线性最优限制LQR 方法试验限制倒立摆 3、学习运用模糊限制理论限制倒立摆系统 4、学习MATLA工具软件在限制工程中得应用 、驾驭对实际系统进行建模得方法,熟识利用MATB 对系统模型进行仿真,利用学习得限制理论对系统进行限制器得设计,并对系统进行实际限制试验,对试验结果进行视察与分析,
2、特殊直观得感受限制器得限制作用。 二、 试验设备 计算机及MATAB、C等相关软件 固高倒立摆系统得软件 固高一级直线倒立摆系统,包括运动卡与倒立摆实物 倒立摆相关安装工具 三 倒立摆系统介绍 倒立摆就是机器人技术、限制理论、计算机限制等多个领域、多种技术得有机结合,其被控系统本身又就是一个确定不稳定、高阶次、多变量、强耦合得非线性系统,可以作为一个典型得限制对象对其进行探讨。倒立摆系统作为限制理论探讨中得一种比较志向得试验手段,为自动限制理论得教学、试验与科研构建一个良好得试验平台,以用来检验某种限制理论或方法得典型方案,促进了限制系统新理论、新思想得进展。由于限制理论得广泛应用,由此系统探
3、讨产生得方法与技术将在半导体及精密仪器加工、机器人限制技术、人工智能、导弹拦截限制系统、航空对接限制技术、火箭放射中得垂直度限制、卫星飞行中得姿态限制与一般工业应用等方面具有广袤得利用开发前景 倒立摆已经由原来得直线一级倒立摆扩展出很多 种类,典型得有直线倒立摆环形倒立摆,平面倒立摆与复合倒立摆等,本次试验接受得就是直线一级倒立摆。 倒立摆得形式与结构各异,但全部得倒立摆都具有以下得 特性: 非线性2 不确定性3)耦合性4)开环不稳定性5 约束限制 倒立摆 限制器得设计就是倒立摆系统得核心内容,因为倒立摆就是一个确定不稳定得系统,为使其保持稳定并且可以承受确定得干扰,需要给系统设计限制器,本小
4、组接受得 限制方法有:ID 限制、双PI限制、R限制、模糊PI限制、纯模糊限制 四.直线一级倒立摆得物理模型: 系统建模可以分为两种:机理建模与试验建模。试验建模就就是通过在探讨对象上加上一系列得探讨者事先确定得输入信号,激励探讨对象并通过传感器检测其可观测得输出,应用数学手段建立起系统得输入-输出关系。机理建模就就是在了解探讨对象得运动规律基础上,通过物理、化学得学问与数学手段建立起系统内部得输入-状态关系。,由于倒立摆本身就是自不稳定得系统,试验建模存在确定得困难。但就是忽视掉一些次要得因素后,倒立摆系统就就是一个典型得运动得刚体系统,可以在惯性坐标系内应用经典力学理论建立系统得动力学方程
5、。 下面我们接受 牛顿-欧拉方 法建立直线型一级倒立摆系统得数学模型: 在忽视了空气阻力与各种摩擦之后,可将直线一级倒立摆系统抽象成小车与匀质杆组成得系统,如下图: 我们不妨做以下假设: M 小车质量 m 摆杆质量 b 小车摩擦系数 l 摆杆转动轴心到杆质心得长度 I 摆杆惯量 F 加在小车上得力 x 小车位置 摆杆与垂直向上方向得夹角 摆杆与垂直向下方向得夹角考虑到摆杆初始位置为竖直向下)图就是系统中小车与摆杆得受力分析图。其中,N 与P 为小车与摆杆互相作用 力得水平与垂直方向得重量。 留意:在实际倒立摆系统中检测与执行装置得正负方向已经完全确定,因此 矢量方向定义如下图,图示方向为矢量正
6、方向。 分析小车水平方向所受得合力,可以得到以下方程: 3)由摆杆水平方向得受力进行分析可以得到下面等式: (-2)即: (3-3)把这个等式代入式3)中,就得到系统得第一个运动方程: 3 为了推出系统得其次个运动方程,我们对摆杆垂直方向上得合力进行分析,可以得到下面方程: (35) 3-6 力矩平衡方程如下: (37)留意:此方程中力矩得方向,由l,故等式前面有负号。 合并这两个方程,约去P 与N,得到其次个运动方程: (38)设+就是摆杆与垂直向上方向之间得夹角),假设与1(单位就是弧 度)相比很小,即,则可以进行近似处理: 用u 来代表被控对象得输入力F,线性化后两个运动方程如下: 3-
7、9)对式(39进行拉普拉斯变换,得到 (310)留意:推导传递函数时假设初始条件为0。 由于输出为角度,求解方程组得第一个方程,可以得到: 或 假如令 则有: 把上式代入方程组得其次个方程,得到: 整理后得到传递函数: 其中 设系统状态空间方程为: 方程组 对,解代数方程,得到解如下: 整理后得到系统状态空间方程: 由(3-9得第一个方程为: 对于质量均匀分布得摆杆有: 于就是可以得到: 化简得到: 设 则有: 另外,也可以利用ALAB 中f2s 叮嘱对-13)式进行转化,求得上述状 态方程。 实际系统得模型参数如下: M 小车质量 .09 Kg m 摆杆质量 0。109 小车摩擦系数 0、N
8、/m/sec 摆杆转动轴心到杆质心得长度 、2 5m I 摆杆惯量 0.034 k*m*m 把上述参数代入,可以得到系统得实际模型。 摆杆角度与小车位移得传递函数: 摆杆角度与小车加速度之间得传递函数为: 摆杆角度与小车所受外界作用力得传递函数: 以外界作用力作为输入得系统状态方程: 以小车加速度作为输入得系统状态方程: 留意事项:在固高科技全部供应得限制器设计与程序中,接受得都就是以 小车得加速度作为系统得输入,假如用户需要接受力矩限制得方法,可以参考以 上把外界作用力作为输入得各式.五.系统得阶越响应分析 根据已经得到系统得状态方程,先对其进行阶跃响应分析,在ATAB 中 键入以下叮嘱:
9、clar; A=;B= 0 1 0 ; =;den=0、01021 0 0、2605; z=ronum;p=rots(d); subplt(,,1)bdnum,dn)subplot(2,1,2 nyuist(nu,d)得到如下列图所示得结果: z = Epy atr: 0by-1 p = 5、1136 、36 可以得到,系统没有零点,但存在两个极点,其中一个极点位于右半s平面,根据 奈奎斯特稳定判据,闭环系统稳定得充分必要条件就是:当 从 到+ 变 化时,开环传递函数Gj 沿逆时针方向包围1 点p 圈,其中p 为开环传递函数 在右半S平面内得极点数。对于直线一级倒立摆,由奈奎斯特图我们可以瞧出
10、,开 环传递函数在S 右半平面有一个极点,因此G )需要沿逆时针方向包围1 点一圈。可以瞧出,系统得奈奎斯特图并没有逆时针绕1 点一圈,因此系统不稳定, 需要设计限制器来冷静系统。 七具体限制方法(一)双 双 PID 限制 直线一级倒立摆双 PID 限制试验 。I 限制分析 经典限制理论得探讨对象主要就是单输入单输出得系统,限制器设计时一般需 要有关被控对象得较精确模型。D 限制器因其结构简洁,简洁调整,且不需要 对系统建立精确得模型,在限制上应用较广。 对于倒立摆系统输出量为摆杆得角度,它得平衡位置为垂直向上得情 况。系统限制结构框图如下: 2、双 PID 试验限制参数设定及仿真。 在 Sl
11、izng 建立直线一级倒立摆模型 上下两个 PID 模块。鼠标右键,选择 “ Lo uner mak打开模型内部结构分别为: 双击其次个模块打开参数设置窗口 令 kp=、k=0、k= 得到摆杆角度仿真结果 可瞧出限制曲线不收敛。因此增大限制量。令 kp-30、k=0、kd=、得到如下仿 真结果 从上面摆杆角度仿真结果可瞧出,稳定比较好。但稳定时间略微有点长。 双击第一个模块打开参数设置窗 经多次尝试在此参数即 k7,ki0,p=-4、5 状况下效果最好。 得到以下仿真结果 黄线为小车位置输出曲线,红线为摆杆角度输出曲线.从图中可以瞧出,系统可以比较好得稳定。稳定时间在3 秒之间。稳定性不错.。
12、双 PID 限制试验 打开直线一级倒立摆爽 PID 实时限制模块 双击oubP限制模块进入参数设置 把参数输入 PID 限制器。编译程序,使计算机同倒立摆连接。 运行程序.试验结果如下列图所示 从图中可以瞧出,倒立摆可以实现比较好得稳定性。 二)线性最优二次限制 LQR 线性二次最优限制R 限制试验 线性二次最优限制 LQR 基本原理及分析 线性二次最优限制QR 基本原理为,由系统方程: 确定以下最正确限制向量得矩阵 K: uKx(t 使得性能指标到达最小值: 式中 Q正定或正半定)厄米特或实对称阵 R为正定厄米特或实对称阵 图 3-54 最优限制 LQR 限制原理图 方程右端其次项就是考虑到
13、限制能量得损耗而引进得,矩阵 Q 与确定了误差与能量损耗得相对重要性。并且假设限制向量 u(t就是无约束得.对线性系统: 根据期望性能指标选取 与 R,利用 MTLAB 叮嘱 lqr 就可以得到反馈矩阵 K 得值。 Klqr(,B,Q,R) 变更矩阵 Q 得值,可以得到不同得响应效果,Q 得值越大(在确定得范围之内,系统抵抗干扰得实力越强,调整时间越短。但就是 不能过大 2、LQR 限制参数调整及仿真 前面我们已经得到了直线一级倒立摆系统得比较精确得动力学模型,下面我们针对直线型一级倒立摆系统应用 LQR 法设计与调整限制器,限制摆杆保持竖直向上平衡得同时,跟踪小车得位置。 前面我们已经得到了
14、直线一级倒立摆系统得系统状态方程: 应 用 线 性 反 馈 控 制 器 , 控 制 系 统 结 构 如 下 图。 图 中 R 就是施加在小车上得阶跃输入,四个状态量 x,x,,分别代表小车位移、小车速度、摆杆角度与摆杆角速度,输出 y = x, 包括小车位置与摆杆角度。设计限制器使得当给系统施加一个阶跃输入时,摆杆会摇摆,然后照旧回到垂直位置,小车可以到达新得指定位置.假设全状态反馈可以实现(四个状态量都可测,找出确定反馈限制规律得向量 .在 Mta 中得到最优限制器对应得K 。Lqr 函数允许您选择两个参数 与 Q,这两个参数用来平衡输入量与状态量得权重。最简洁得状况就是假设 R = 1,Q
15、 =C *C.当然,也可以通过变更 Q 矩阵中得非零元素来调整限制器以得到期望得响应.其中, Q1,1 代表小车位置得权重,而 Q3,3 就是摆杆角度得权重,输入得权重 R 就是 。 下面来求矩阵 K,atlab 语句为 K lqr(,,Q,R 。下面在MALB 中编程计算: A=; D=“; Q1=150;Q33=300; ; R=1;K=qr(,Q,);=;Bc=B;Cc=;Dc=D; T=0:0、005:; U0、neseT);C; Y,X=lsim(A,Bc,Cc,U,T;plot(T,X(:,1,);hold on;ploT,X(:,2),“;hod on; ot(T,X:,3),、
16、“;hold n;plot,(:,4),-); leged(“crtps,“cats,penang,pedsd)令 Q1,1 ,Q3, 1 求得 K 1 1、755 5、422 4、684 在 Simlin 中建立直线一级倒立摆得模型如下列图所示: “LQ ntrole为一封装好得模块,在其上单击鼠标右键,选择“Loo ndr mask打开 LQ Contoller 结构如下: 双击“rix gin K即可输入限制参数: 点击 执行仿真,得到如下仿真结果: LQR 限制得阶跃响应如上图所示,从图中可以瞧出,闭环限制系统响应得超调量很小,但稳定时间与上升时间偏大,我们可以通过增大限制量来缩短稳定
17、时间与上升时间。 可以觉察,Q 矩阵中,增加 Q11 使稳定时间与上升时间变短,并且使摆杆得角度转变减小.经过多次尝试,这里取 Q1,500, 3,3 =00,则 K = -3、798 -23、8255 81、618 14、7098 输入参数,运行得到响应曲线如下: 从图中可以瞧出,系统响应时间有明显得改善,增大1,1 与,3,系统得响应还会更快,但就是对于实际离散限制系统,过大得限制量会引起系统振荡.、直线一级倒立摆QR 限制试验 打开直线一级倒立摆 LR 实时限制模块 其中“LQ Cnollr为 LQR 限制器模块,“Rea Cotol为实时限制模块,双击“LQ Croller模块打开 L
18、QR 限制器参数设置窗口如下: 在“LR ole模块上点击鼠标右键选择“Lok unde mas“打开模 型如下: 双击“R Contol模块打开实时限制模块如下列图: 其中“Pnulum模块为倒立摆系统输入输出模块,输入为小车得速度“Vel 与“Acc ,输出为小车得位置“Pos与摆杆得角度“Angle 。 双击“eulu模块打开其内部结构: 其中“et Carts c and Vel“模块得作用就是设置小车运动得速度与加速度,Gt rs sition模块得作用就是读取小车当前得实际位置,“e Pends ngle“ 得作用就是读取摆杆当前得实际角度.2) 运行程序,试验运行结果如下列图所示
19、: 其中图片上半部分为小车得位置曲线,下半部分为摆杆角度得转变曲线,从图中可以瞧出,小车位置与摆杆角度比较稳定。限制效果很好。 在此试验中,R 值固定,R=1,则只调整 Q 值,1 代表小车位置得权重,而 Q33 就是摆杆角度得权重,若3增加,使得得转变幅度减小,而位移得响应速度变慢;若11 增加,使得 r 得跟踪速度变快,而得转变幅度增大.当给系统施加一个阶跃输入后,得到系统得响应结果。从响应曲线可明显瞧出就是否满意系统所要到达得性能指标要求。通过这样反复不断得试凑,选取能够满意系统动态性能要求得 Q 与 R。 三)直线二级倒立摆 直线两级倒立摆由直线运动模块与两级倒立摆组件组成.6、1 系
20、统物理模型 为简化系统,我们在建模时忽视了空气阻力与各种摩擦,并认为摆杆为刚体。 二级倒立摆得组成如图 61 所示: 图 61 直线两级倒立摆物理模型 倒立摆参数定义如下: M 小车质量 m1 摆杆 得质量 m2 摆杆 2 得质量 3 质量块得质量 l1 摆杆 1 中心到转动中心得距离 l2 摆杆 2 中心到转动中心得距离 1 摆杆 1 与竖直方向得夹角 摆杆 2 与竖直方向得夹角 作用在系统上得外力 利用拉格朗日方程推导运动学方程: 拉格朗日方程为: L(q,q=q,V(q, 其中 L 为拉格朗日算子,q 为系统得广义坐标,T 为系统得动能, 为系统得势能。 其中 =1,2,3n,f i 为
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 2023 倒立 实验 报告 大全
限制150内