已阅读5页,还剩63页未读, 继续免费阅读
(机械电子工程专业论文)倒立摆系统的稳定控制.pdf.pdf 免费下载
版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领
文档简介
摘要 倒立摆系统是一非线性、强耦合、多变爨和自然不稳定的系统。通道它能有效地 复欢控制过程中诸如可镇定性、簧捧性、随动健以及跟踪等多种关键问题,是检验各 静控制逢论的瑾憨羧型。慰其懿稳定控翻是按涮赛一个裰爨魏战经静难鬏。 本文建立了一缴、二级和三缀倒立摆的数学模型,分析了系统的能掇性和能观测 性。根据理论分析,提出了用线性二次行最优控制理论建成系统控制的方案,并设计 了二级翻立摆系统控剿器。 通过对硬件在阐路仿真技术的研究,利用m a t l a br t w 实时工其箱构建了倒立摆系 统实时控制平台,实现了二级倒巍摆的稳定控制并对结果做了必要的分析该平台可 以用予倒立摆其它掇剑算法的磺究,具有良好的逶用性。 关键词;倒立摆数学建模最优控制硬件回路仿真 a b s t r a c t i n v e r t e dp e n d u l u mi san o n l i n e a r , c o u p l i n g ,v a r i a b l ea n di k a t u r a lu n s t e a d i n e s ss y s t e m d u r i n gt h ec o n t r o lp r o c e s s ,p e n d u l u mc a ne f f e c t i v e l yr e f l e c tm a n yp i v o t a lp r o b l e m ss u c ha s e q u a n i m i t y r o b u s t f o l l o w - u pa n dt r a c k t h e r e f o r e , i ti s 鑫p e r f e c tm o d e lu s e dt ol e 嘲 v a r i o u sc o n t r o lt h e o r i e s t h es t a b i l i z a t i o nc o n t r o lo f i n v e r t e dp e n d u l u ms y s t e mi sap l 证唧 c h a l l e n g ef o r t h er e s e a r c h e r si nt h ec o n t r o l l i n gf i e l db e c a u s eo f t h ed i f f i c u l t yo f t h ep r o b l e m i nt h i s 妊p e r 9w ee s t a b l i s hm a t h e m a t i c a lm o d e l so fs i n g l e , d o u b l ea n dt r i p l ei n v e r t e d p e n d u l u ms y s t e m , a n da n a l y 2 t h ec o n t r o l l a b i l i t y a n do b s e r v a b i l i t yo ft h e s em o d e l s a c c o r d i n gt ot h et h e o r e t i c a la n a l y s i s ,t h i sp a p e rp u t sf o r w a r das o l u t i o nt h a ti ti sf o u n db y l i n e a rq u a d r a t i co p t i m a tc o n t r o lt h e o r y i nt h ef o l l o w i n g , w ed e s i g nad o u b l ei n v e r t e d p e n d u l u m sc o n t r o l l e rb a s e d o nt h et h e o r y 柏缸sp a p e r , b a s e do nt h es t u d yi nt h et h e o r yo fh a r d w a r ei nl o o pt e c h n o l o g y , b u i l da r e a l - t i m ec o n t r o lw o r k s p a c ew i t hm a t l a br t wr e a l t i m et o o l b o x f i n a l l yw e s a c c e s s f u l l ya c c o m p l i s ht h ed o u b l ep e n d u l u me x p e r i m e n ti nt h ew o r k s p a c e , a n dg i v e 蠢 n e c e s s a r ya n a l y s i so f t b er e s u l t s 懈sw o r k s p a c eh a ss o m eu n i v e r s a l i t ya n dc a n b eu s e di n t h es t u d yo f o t h e rc o n t r o la r i t h m e t i c k e yw o r d s :i n v e r t e dp e n d u l u mm o d e l l i n gl q rh a r d w a r ei nl o o ps i m u l a t i o n 长春理工大学硕士学位论黛原刨性声明 本人郑重声明;所壁交的硕士学位论文倒宠摆系统的稳定控制憝零入在 指导教师的指导下,独立进行研究工作所取 导的成果。除文中已经注明引用的内 容外,本论文不包台任何其他个人或集体已经发表或撰写j 奠的作品成果。对本文 豹硬究敲出重要贡献瓣个人和集体,均已在文巾域爨确方式标臻。本人完全意识 劐本声疆鹃法律络暴受本人承撵。 作者签名; 黛卜。姓妯驵 长眷理工大学学位论文版权使用授权书 本学位论文作者及指导教师完全了解“长春理工大学硕士、博士学位论文版 权使用飙定”,同意长春理工大学保留并向国家有关部门或机构送交学位沧文的 复印粹釉毫子羧,兔谨论文被套溺霸氆霾。零入裁数长誊理羔大学霉敬将奉掌霞 论文的龛部或部分内容编入有关数据库进行榆索,也可采用影印、缩印或扫描等 复制乎段保存和汇编学位论文。 作者签名:越翔噬生;i 艘蓼旦 指导导师签名彳蚕复眨b 孽脚 1 1 倒立摆系统简介 第一章绪论 倒立摆系统是日常生活中所见到的任何重心在上,支点在下的控制问题的抽象。 例如杂技顶杆表演,人们常为演员的精湛技艺叹服,然而其机理更引发了人们的深思。 它深刻的揭示了自然界的一种基本规律即一个自然不稳定的被控对象,通过控制手 段可使之具有良好的稳定性。 图1 i 所示的一级倒立摆系统是一个复杂的非线性系统,小车可以自由地在限定 的轨道上左右移动,小车上的倒立摆一端被铰链链接在小车顶部,另一端可以在小车 轨道所在的垂直平面上自由转动。系统的控制目的是通过电机带动小车运动,使倒立 摆平衡并保持小车不与轨道两端相撞。 图i i 一级倒立摆系统结构 根据小车上摆杆的节数,倒立摆系统可以分为一级,二级、三级和多级倒立摆; 根据小车的运动方向,可分为直线和平面倒立摆系统;根据小车运动轨道,可分为水 平轨道、斜轨道和圆轨道倒立摆系统。此外,如果在同一小车上安装两个相互独立的 摆杆,即为并行倒立摆系统;如果没有小车,摆杆直接安装在旋转轴上,即为旋转式 倒立摆系统。在复杂的倒立摆系统中,摆杆的长度和质量均可变化。倒立摆的工作原 理大致相同,即用一种强有力的控制方法对小车的加速度进行适当的控制,从而使全 部摆杆倒置稳定于正上方。其中一种控制叫做起摆控制。首先系统使小车按摆杆的自 由振荡频率摆动,摆杆随之大幅度摆动,然后经过数次摆动后,能自动直立起来l 另 外一种叫做稳摆控制,它是将摆杆手动扶到适当的位置,通过控制器的作用,使摆杆 直立起来并保持其状态 1 2 倒立摆系统研究的科学意义和应用前景 倒立摆系统是非线性、强耦合、多变量和自然不稳定的系统。在控制过程中,它 能有效地反映诸如可镇定性、鲁棒性、随动性以及跟踪等许多控制中的关键问题,是 检验各种控制理论的理想模型。迄今,人们已经利用经典控制理论、现代控制理论和 人工智能控制理论实现了多种倒立摆系统的稳定控制。其控制方法在军工、航天、 机器人领域和一般工业过程中都有着广泛的工程背景。 1 机器人的站立与行走类似于双倒立摆系统,尽管第一台机器入在美国问世至今 已有三十多年的历史,机器人的关键技术机器人的行走控制至今仍未能很 好解决。 2 在火箭等飞行器的飞行过程中,为了保持其正确的姿势,要不断进行实时控制。 3 通信卫星在预先计算好的轨道和确定的位置上运行的同时,要保持其稳定的姿 态,使卫星天线一直指向地球,使它的太阳能电池板一直指向太阳。 4 侦查卫星摄像机的轻微抖动会对摄像的图像质量产生很大的影响,为了提高摄 像的质量,必须能自动地保持伺服云台的稳定,消除振动。 5 为防止单级火箭在拐弯时断裂而诞生的柔性火箭( 多级火箭) ,其飞行姿态的 控制也可以用多级倒立摆系统进行研究。 近年来,人们对倒立摆的研究越来越感兴趣,倒立摆的种类也由此变得丰富多样。 倒立摆系统不仅在高科技领域中得到广泛应用,人们还可以通过倒立摆这样一个严格 的控制对象检验新的控制方法是否有较强的处理多变量、非线性和绝对不稳定系统 的能力。因此,倒立摆系统作为控制理论研究中的一种比较理想的实验手段常常用来 检验控制策略的效果”。 1 3 国内外的研究现状 鉴于倒立摆的稳定控制研究对于现代高技术研究所具有的重要实践意义,国内外 学者对此给予了广泛的关注。 早在上世纪6 0 年代人们蔚开始了对倒立摆系统的研究,1 9 6 6 年s c h a e f e r 和 c a n n o n 应用b a n g - b a n g 控制理论,将一个曲轴稳定于倒置位置。在6 0 年代后期,作 为一个典型的不稳定、严重非线性证例,出了倒立摆的概念,并用其检验控制方法对 不稳定、非线性和快速性系统的控制能力,受到世界各国许多科学家的重视 直到上世纪7 0 年代初,用状态反馈理论对不同类型的倒立摆问题进行了较为广泛 的研究嘲一首先需要获得系统平衡点附近的线性化模型,然后再根据对系统所提出 的性能指标进行分析与综合,最后设计得到期望的控制器。k f u r u t a 等及 2 h m z f a r w i g 等”1 应用最优状态调节器理论实现了具有双电机的三级倒立摆的控制。 虽然在许多方面都取得了较为满意的效果,但其控制方法过多的依赖于线性化的数学 模型,故对一般工业过程尤其是数学模型变化或者不清晰的对象缺乏指导性的意义。 在8 0 年代后期。随着模糊控制理论的快速发展,用模糊控制理论控制倒立摆也受 到广泛重视,其目的在于检测模糊控制理论对快速、绝对不稳定系统适应能力,并且 用模糊控制理论控制一级倒立摆“1 嘲取得了非常满意的效果由于模糊控制理论目前 尚无简单实用的方法处理多变量问题,故用适合的方法处理二级倒立摆多变量之问的 关系,仍然是模糊控制二级倒立摆的中心问题之一常见的模糊控制器是根据输出偏 差和输入偏差的变化率来求控制作用,用二输入一输出的控制器。当控制器的输入为 两个以上时,控制规则数随输入变量数指数增加。不仅使模糊控制器的设计非常复杂, 也使模糊控制的执行时问大大增加,难于实时应用。张乃尧”1 先生对例立摆采用双闭 环模糊控制方案,很好的解决了上述问题,并在实际装置上取得了满意的结果。河北 科技大学的程福雁教授等研究了使用参变量模糊控制对二级倒立摆的实时控制问题 “”。作者拟通过传统的控制理论得出各种状态变量间的综合关系,来处理系统的多变 量问题;通过仿真寻优和重复实验相结合的方法,得到控制倒立摆所谓的最优参数; 采用高精度清晰化方法,使得输出控制等级更为细腻。 神经网络控制倒立摆的研究,自9 0 年代初开始得以快速的发展。而早在1 9 6 3 年, w i d r o w 和s m i t h 就开始将神经网络应用于倒立摆小车系统的控制。神经网络控制倒立 摆是以自学习为基础,用一种全新的概念进行信息处理,显示出巨大的潜力今天有 许多学者正致力于引用神经网络控制一级、二级或多级倒立摆的研究另外还有许多 其它的控制方法用于倒立摆的控制。 当前,倒立摆的控制规律可总结如下:( 1 ) p i d 控制,通过对待倒立摆物理模型的 分析,建立倒立摆的动力学模型,然后使用状态空间理论推导出其非线性模型,再在 平衡点处进行线性化得到倒立摆系统的状态方程和输出方程,于是设计出p i d 控制器 实现其控制;( 2 ) 状态反馈h - 一控制n 8 例,通过对待倒立摆物理模型的分析,建立倒 立摆系统的动力学模型,然后使用状态空间理论推导出状态方程和输出方程,应用 卜 o o 状态反馈和k a l m a n 滤波相结合的方法,实现对倒立摆的控制;( 3 ) 利用云模型1 嘲 实现对倒立摆的控制,用云模型构成语言值,用语言值构成规则,形成一种定性的推 理机制。这种拟人控制不要求给出被控对象精确的数学模型,仅仅依据人的经验、感 受和逻辑判断,将人用自然语言表达的控制经验,通过语言原子和云模型转换到语言 控制规则器中,就能解决非线性问题和不确定性问题;( 4 ) 神经网络控制,已经得到证 明,神经网络( n e u r a ln e t w o r k ,n n ) 能够任意充分的逼近复杂的非线性关系,n n 能 够学习与适应严重不确定系统的动态特性,所有定量或定性的信息都等势分布贮存于 网络的各种神经元,故有很强的鲁棒性和容错性;也可将q 学习算法和b p 神经网络 有效结合,实现状态未离散化的倒立摆的无模型学习控制;( 5 ) 遗传算法( g e n e t i c a l g o r i t h m s ,g a ) ,芬兰赫尔辛基工业大学高晓智3 博士在l l i c h i n e 的倒立摆控制 , b o x e s 方案的基础上,利用g a 对每个b o x 中的控制作用进程了寻优,结果表明g a 可 以有效地解决倒立擐的平衡问题;( 6 ) 白适应控制,主要是为倒立摆设计如自适应控制 器;? ) 模鞠整制,囊要是确定穰期裁建,设谤滋模赣控裁嚣实瑗镶立臻瓣实辩控裁; ( 8 ) 使用几种智能按锘i 算法相结合寅现倒立摆的控制,比如模糊自适应控制分散鲁棒 自适应控制等等;( 9 ) 采用遗传算法与神经网络相结合的方法,首先建立倒藏摆系统的 物理摸黧,然后为箕设诗出享申经阚终控割器,褥裂羽改进豹遗传算法训练神经弼终豹 权篷,从箍实现对缁盛摆的控制。用g 矗学习鹣黼控制器兼窍涨的广泛映射能办帮 g a 快速收敛以及增强式学习等性能。 国际上每年都商成百篇关于侧立摆控制研巍的论文发袭,其中大部分是建立在计 算辍蓥麓上煞蘩褰磁凳。瑟星圭整是疆一级囊囊摆终为镀控瓣蒙邃露佬爽,矮二缎铡 立摆和平行倒立摆仿真的文章贝n 更少,而用三级倒立摆乃懋多级倒立摆进行仿真研 究的更怒罕见。三级倒立摆的控制作为世界公认的难题,一巍为人们所美注,也一直 是研究豹热点。舄静,大约其中必有八分之一鹃学者在对实豁倒立摆进移设计、试验 窝控割磷究。多数久厢获态空阗浚瓣落立摆建纛数学模型,然后线瞧纯求褥控裁丞鼗 再进行控制。到目前为止,声称能稳定三级倒溉摆的单位在仝世界范围内并不多见, 能用单电机成功控制三级倒立摆稳定在不同典粼模式上,尚来见报道迄今为止,己 残功蜜瑗了一缓翻囊撰系缓嚣秘舞整孵动孚蟹攘式渊。 1 。4 课题饪务 倒藏摆系统是理想的自动控制教学实验设备,使用它能全方位地满足自动控制教 学的要求许多抽象的控制概念如系统稳定性、可控性、系统收敛速度和系统抗干扰 缝力等,郝可以透过绷立摆壹露媲表现出来。潆遂 壬务是灸魏健控割理论漾程嚣发实 雨、裔效的实验装鬣。 实验装置的结构部分采用深圳固高科技有限公司生产的g l i p 2 0 0 3 烈盥线三级倒 立摆,自行设计倒立摆系统豹控制模块。课题的主要任务包掇; l 。翻立摆系统豹控潮装萋浚诗_ 帮综合。 2 倒立摆系统控制算法设计。 3 在仿真成功的基础上进行实物实验。 t 设计可透露嚣续教学实骏豹软待平台。 性能要求; i 实现倒立摆的稳定控制 2 倒立摆系统成具有一定的瞬态、稳态特性和鲁捧性。 3 。袈箨平台疲爽弩一定豹秀菝经,殴逶瘦教学实验熬霭簧。 4 2 1 倒立摆系统原理 第二章倒立摆系统构成 倒立摆控制系统硬件框图如图2 1 所示,包括计算机、运动控制模块、伺服机构、 倒立摆本体和位置传感器( 光电码盘) 等几大部分构成的一个闭环系统。其中位置传 感器1 由伺服电机自带在倒立摆系统中,可通过该码盘的反馈获得小车的位移,小 车的速度信号可通过差分法得到;各个摆杆的角度由光电码盘测得并直接反馈到控制 卡,速度信号通过差分方法得到。计算机从运动控制卡中实时读取数据,确定控制决 策( 小车向哪个方向移动、移动速度、加速度、电机的输出力矩等) ,并发送给运动控 制模块。运动控制卡通过d s p 内部的控制算法实现该控制决策,产生相应的控制量, 使电机转动,带动小车运动,保持各级摆杆的平衡。 图2 1 三级倒立摆系统硬件组成框图 2 2 倒立摆系统的部件选择 2 2 1 电机及其功放驱动 倒立摆系统采用日本p a n a s o n i c 公司生产的m i n a sa 系列的k s m a 0 2 2 a 1 g 型交流伺 服电动机嘲。交流伺服电动机具有结构简单、运行可靠的优点,在工业自动化中,越 来越多地作为机械装置精密控制的驱动执行部件,它的控制单元较为复杂系统采用 的m s i a 0 2 2 a 1 g 型交流伺服电动机是一款小惯量、额定输出2 0 0 w 、驱动电压2 0 0 v ,带 有增量式旋转编码器、有键槽、无制动器、有油封的交流伺服电动机。 倒立摆系统使用与电机配套的t s ) a 0 2 3 a 1 a 型交流伺服电机驱动器。驱动器控制方 5 式为i g s tp 删正弦波控制。脉宽调制型驱动器通过控制输出电压的占空比来达到输出 氇平平均壤与控镪信号或正比,其喜缀高的效率,但是电磁予找毙较大,一般应用午 是霹嚣戮尼卡予鬣鹅控锈系凌审。驱囊器爵邋过参数:藩鞲纛耀霞萋整翻、揍熬量速度 控制、转矩控制、位置一速度控制、位置一转矩控制、速度转矩控制等6 种控制方 式谶行控制啪1 。此驱动器的特点有: 1 速度频率璃疲达裂5 l 耗;定整超诵瓣婺定簿瘸绺缎。 2 - 具有共掇掷露5 移窿肇麓麓;虿懑盏褫壤的嚣性不足。获嚣实现藏速定位。 3 具有一系列方便使用的功能: 谚,内藏频率解辑机能,从两可检测出粳敲豹共振点,便于系统调整。 馘有嚣静鑫凌瑶盏调熬方式;零麓爨凌缮盏调蘩鞍实靖鑫动增益潺整。 c ) 配有r s 4 8 5 ,r s 2 3 2 通信墨,上键控制器可同时控制多达1 6 个辘。 4 电机防护镩级大i p 6 5 ,环境适应性强。 2 乏2 位置簧藤器 光电编码器可自然输出数字激,可以非储容易的和数字电路楣匹配。既可以做剿 很高的分辨事,避可被到大量程的芏作范围,具有很高的精度。光电编码器非常方便 逢适应多箨揍日,辩:毙毫藕会器,程毛强、兰态疆、鑫释奄篷毙较器等放大整形彀 路,信号处理电路简单容易,蕊肖较强的抗平扰能力。倪怒对环境敏感,价格较高。 光电编码器可分为增量式和绝对戏两种。由于增量式编码器结构更简单,价格也较便 塞,般蒸是采髑耀星式编弼嚣,输髫事移信号。嚣赣粥并行岩号豹魑对武装强器, 谴数缀难达舞禳藤锈终了溺佼精度,霹虽穰号读取电路簸杂,速度罐戳疆毫。嚣纛 在同样分辨率条件下,增量式缡码器比绝对斌编码器更凝商优越性。 倒立摆系统上安装了四个增量式编码器作为位置传感器,其中用索测量小车位鼹 翡缓码器稼洚鼗淹2 5 8 卯扫,翔来灏量吝缓接秆往耋翦编码器琢辞羲隽6 0 0 p r 。邃4 个编码器均输出w l 电平信母,分为a 、b 两种信号。其中a ,b 两组倍母楣差9 0 度穗 位, 超前b 表示厩转,b 超前a 表示反转。 2 2 1 3 运囊控割镬块 避动控制模块是倒立摆伺服系统的核心。是实现系统闭环的关键环带它接收光 毫编辑器爱续懿僚移彝霆度数撰,进嚣查分如小车帮摆柽舱速度,根据绘定蠢皇控制舞 法圣 算窭控甏量,输出惹整秘小车戆运魂,并维持餐立接豹孚餐。藏辩,运动控裁攘 块黼监控电机运转情况,通过软件实现超速保护运动控制模块应包括数据处理芯片, 内存、光电编码器接口、通信总线、数字i o 接口和d a 转换芯片。 数餐整理芯冀燕运动控裁模块蘸菝密。o s p ( d i g i t a ls i g n a lp r o c e s s i n g ) 帮数字 信号她理器,是种具有特殊结构的镦处理嚣。与萃片桃相比,d s p 器件其有较离瓣 集成度、更快的c p u 、更大容墩的存储器,内置有波特率发生器和f i f o 缓冲器。提供 高速、同步串西葶辩标准舞步串秘。有翡芹秀集成了磊内和采样傈持电路,可键供嘲 输出。d s p 器件其有高速的数摄运算挠力。d s p 器件比1 6 位单片机单指令执行快8 - 1 0 倍,完成一次乘法运算快1 6 3 0 倍潮。d s p 器件还提供了高度专业化的指令集,提高 7f f t 抉速傅里婶变换秘滤波器的运算速度。此终,d s p 器件提供了j t a g 接心,具露 更先进的歼发工疑,批辍生产测试更方便,开发工具可实现全空间透明仿真,不占用 彝l 声柽露资源。软势配餐汇编链接c 编译嚣、c 滚代玛镶试嚣。d s p 慈筹是专为遘纷 数字信号处理运算而设计的微处理器,在实时快速实现备种数字信号处理算法方面有 缀牵越熬馁能。 在本系统中,我们采用了g t 一4 0 0 运动控制器,其核心由a d s p 2 1 8 1 数字信号处联 器和f p g a 组成,可以同步控稍疆个运动轴,实现多轴协谪运动躺。该运动控镧器是一 块带寅p c i 标准总线,以i b m - p c 或兼容机作为主机的应用插扳。它具宥功能强、价格 低、使用方便的特点,用户需鬻一台i 明一p 1 c 或兼容机、块运动控制掇、电缆、一块 接掰壤予叛、稠暇毫极、翅缀邀瓿驱动器秘於部接口电嚣等硬移。这戮部终之勰豹逐 接示意图如下图所示。 图2 2 采用四轴运动控制器组成的控剩系统框图 该运动控制器提供c 语言炳数瘁秘w i n d o w s 动态链按摩,实现复杂的控制功能。 用户能够将这些控制函数与自已控制系统所需的数据处理、界酾显示、用户接口等成 援爨痔模块集藏在一起,建造符合特定应愚要求憨控铡系统, :走适应务秘痤翅领域骢 要求。 , 第三章倒立摆系统建模与分析 在控制系统的分析和设计中,首先要建立系统的数学模型。控制系统的数学模型 是描述系统内部物理量和变量之间关系的数学表达式啪姗1 。在静态条件下( 即变量各 阶导数为零) ,描述变量之间关系的代数方程叫做静态数学模型:而描述变量各阶导数 之间关系的微分方程叫动态数学模型。如果己知输入量及变量的初始条件,对微分方 程进行求解,就可以得到系统输出量的表达式,并由此对系统进行性能分析。因此, 建立系统的数学模型是进行控制系统分析和设计的首要工作。 建立控制系统数学模型的方法有分析法和实验法两种。分析法是对系统各部分的 运动机理进行分析,根据它们所依据的物理规律或化学规律分别列写相应的运动方程。 例如,电学中有基尔霍夫定律,力学中有牛顿定律,热力学中有热力学定律等。实验 法是人为地给系统施加某种测试信号,记录其输出响应,并用适当的数学模型去逼近, 这种方法称为系统辨识。 3 1 一级倒立摆建模 在忽略了空气阻力,摆杆摩擦之后,可以将一级倒立摆系统抽象成小车和匀质刚 体杆组成的系统,如图3 1 所示。 一级倒立摆系统参数及物理意义如下表3 - i 所示。 表3 - l 一级倒立摆系统符号参数表 应用经典力学方法来建立系统的动力学方程过程如下, 分析小车水平方向所受的合力,可以得到以下方程: 辑= f 一般一n 8 p e 阔3 1 一级摆系统分析 由摆杆水平方向的受力进彳亍分析可以褥到下面等式: = 埘事( 川s i n 刀 口 p 即:= m + 枷e o s e 一耐痧2s i n o 把这个等式代入上式中,就得到系统的第一个运动方程: r = + 强= 圭携;2 峨不施c o s 只+ 和 蠢= 吾讯型掣) 2 + ( 华) 2 挎;2 侧施黜壤+ 磁z 系统的势能兔: y = k + 鬈b + 巧晦= 戢幽s 理+ 2 嘲c o s 8 + 掰2 烈2 鸱+ 嘲热 这样摄到系统拽格朗层算予l i l = l 一y :吾( 嬲+ m i + m 2 + 2 一强+ 2 n h 2 m ) 1 1 , g s g m ) x2 r t h + 2 m ) x 1 1 c o s g 一掰:;如谚c o s o :+ 每掰l = 寺( 嬲 一掰| +一掰:x 如兜 + 皤掰 + 2 m 2 + 2 研) 盯0 1 + 专棚2 野0 2 + 2 m 2 ,2b 岛a , s w 2 - o , ) - ( m 1 + 2 m 2 + 2 m ) g l ic o s g 一拼2 2c o s 砬- m i 鹪c o s g - 2 m g l l s 最一聊2 9 ( 2 1 1c 最一1 1c o s 岛) 戳为在广义坐标豉,受上无辩力作尾俸蔫,放有敷下等戎成立t 旦里幺一旦:o ( 2 5 ) 斑掘a 8 l 鱼旦一旦;o( 2 6 ) d t8 舀。6 8 2 震拜竣上两式,分剔可得喇下式: 2 6 m 2 ,2 2s i n ( 0 2 一岛) + 4 ( m + 3 ( 小2 + m 3 ) i 岛一3 ( - 2 m 2 2 2 岛c o s 鸭 一馥串和壤+ 毪r , h + m ) x g f m g + x c o s 0 3 ) = 0 2 一3 9 s i n 0 2 - 6 1 1 0 1s i n ( 0 2 一q ) + 4 t 2 岛+ 6 1 1 x c o s ( 0 2 一只) 一3 x c o s 0 2 = 0 将( 2 。7 ) ,( 2 。8 ) 式砖谚,建求簿我数方糕,褥熨疆下涎今等式; q = ( 3 ( - 2 9 m is i n 岛一4 9 掰2s i n g - 4 9 m s i n o , + 3 9 i n 2 0 0 吼一矽i ) 2 斑绣+ 6 搬轰c 。s ( o l - 0 2 ) s h ( o , 一色) 护l 一2 m l 苫蛙一4 m 2x o o s o , 一4 m x c o s o i + 3 m 2 x c o s ( o , 一岛”,( 2 矗( - 4 m t - 1 2 m 2 1 2 m + 9 m 2 c o s 2 ( 儡一岛) ) ) = + 芸搿:( 弧+ 3 ( r , h + 嘲霹乏g s i 珏连一醍反2s i 瞄一岛) 一 3 x c o s 0 2 ) + :。z m 2 砰如c o s ( b o :x 6 m 2 i 2 口2s i i l ( q - 0 2 ) - 3 ( m , + 2 ( 埘2 + m ) x g s i n o ,+ ;s 绣) ) ) 妒萼鸭( 辑+ 3 拼2 + 横譬+ 锄:乎磅 c o s 2 碱- 0 2 ) ) 表示或以下两斌: 最。z 毛岛,绣,矗赜,绣,砖 ( 2 7 ) ( 2 8 ) 2 ,9 ) ( 2 1 0 ) ( 乏1 1 ) 破= 五( 善,b ,岛,t 镜,反,;) 毅孚餐位置辩务变量戆兹蕊蔑零, ( 2 1 2 ) ( 矗岛,吼j ,反,o 2 ,;) 一( o ,0 , 0 , 0 ,0 ,o ) 将( 2 t 1 ) 和( 2 1 2 ) 两式在平衡位置进行寨勒级数展开,并线性化,令 耻乱州以一棚o 。 托= 剩州燃“。蜕舳= 面3 ( - 2 9 再i n i - 瓦4 9 i n 鬲2 - 4 两g i n ) = 剖,删柚砖。删蝴如幽= 虿磊i 9 m 瓦2 9 面 繇:到 = e o xl ,- o 确柚砖。蚧函 l o 冉知一二。 叛,= 置撕= = 0 = 0 耻到忡娟哪批2 丽3 ( - 2 - m 2 - 4 m ) 代入( 2 。9 ) 式,得到线性化之艏豹公式, 毒= 为2 峨+ 墨,0 2 + 墨,; 2 1 1 3 ) 将( 2 1 2 ) 式在平衡位置进行寨勒级数展开,并线性化,令 1 4 庙 由 峨 。 黝 博 峨 吨 懈 坝 峨 柚 情 卸 懈 蛾 神刻别。别 如2 割。加 耻剖枷 蝴一舶 如2 割删蝴一蝴舶 黾。纠 移善l 瑚韪前岛神j 4 最埔藏都涵 如。刘 。毋 | ;坤蔫砖韪神,二嗽柚焉却舶 繇。纠 a p 2l - l o 盛_ 0 血柚山五柚 知茹o 。0 。兰星熬塑垒兰壁垒妻罂坐显叁 4 柳;蜉霹一垣9m :( 脚,+ 3 ( m 2 + m ) y ? 霹 。! 塑竺魑妻! ! 鎏:翌整壁垒 。 3 嘏:2 22 2 一百1 6 掰2 溉+ 3 ( m 2 十蜮譬) 。0 = 0 0 如。刳嘲嘲蜥一= 等蔫等等 a x l 嘲嘲如螭嘲揶硒妇;裙一芸峨阮+ 嚣镌+ 删譬 建。蓉篮嫉恁+ 是嚣x ( 2 l l 蛰 现在得到了两个线性微分方程,由于我们采用小率加速度作为系统输入,因此述 取状态变爨为:麓m x , x 2m 豉,强= 岛,= x , x s = 0 1 ,- - 0 2 00 00 o 0 0 0 0 墨2 0 如 o1o oo| oo o 0 00 艇,0 0 如00 y 甜;| ; + 卦 料 代入实际参数,求出各个傻为: k 1 2 8 6 6 9 , k i 3 = - 2 1 6 2 ,k 麓= - - 4 0 3 1 ,k 2 3 = 3 9 4 5 ,k 1 7 = 6 6 4 ,k 2 ,= - 0 0 8 8 褥羹l 状态方穰各个参数方程为: a = c = 000100 l 000010 1 0 0 0 00 0 0 00 00 1i r 嚣= 08 6 6 9 2 1 6 200 0 l 0 4 0 3 13 9 4 5000 j 0 1 0 0 0 0 0000 000 蚤= ll l iii 3 3 兰级倒残摆建模 o 0 0 o 6 6 4 0 0 8 8 ( 2 1 6 ) 蠢忽瓷了空气隧力窝鑫静摩擦力之嚣,萄毅将三级爱宠摆系统攘象藏夸车、麓震 刚体秆和质量抉缀成的系统,如匿3 3 所示。 兰级倒立摆系统参数及物理意义如下袭3 - 3 所示 芹壤巩;。矾一繇 表3 3 三级倒立摆系统符号参数表 图3 3 三级摆系统分析 1 7 该系统中,设系统的四个广义坐标分别是工、b 、见和岛 计算系统的动能:r = + l + k + k + 正+ ,其中为小车动能,气为摆 杆1 动能,瓦,为摆杆2 动能,为摆杆3 动能,砭,巧为两个质量块动能。 = 丢m 叠2 = + ,其中为摆杆1 质心的平均动能,为摆杆1 绕质心转动动能 k = 砭+ 砭,其中吒,为摆杆2 质心的平均动能,巧:为摆杆2 绕质心转动动能 l = 乇+ ,其中毛为摆杆3 质心的平均动能,气为摆杆3 绕质心转动动能 刊( 等芦) 2 + ( 华) 2 卜王2 嘲施删+ 却彳 = 三以n 乎= 圭g 埘,砰) 匆:= 丢朋砰由- 2 则: _ ;+ :丢珊。主2 一埘。 主葫s q + 詈m ,砰扫: 。 同样可以求出: :飘堑笆竽塑) 2 + 双盟半) 2 = 丢肌:( 主- 2 , 反s b 一如砬咖b ) 2 + j 1 卅:( 2 , e , s i n e , + ,z 幺如岛) 2 = 圭以谚= 三弓喇2 ,2 = 扣;匆:2 t 22 2 乙:= 瓦:+ c := 毒肼:;+ 2 m :,? 葫+ 专埘:碍台:一2 m :叠,z 口:c o s 岛+ 2 m :v z 矾口:c o s 鸱一只) 气* 壶鹳( 丛竺曼坐照鱼嫩地 2 + 三鸭( 丛憋竺塑立型耋贬蝼) 2 = i i 鹣t 卜- 麓碡粥岛一蕊馥$ 绣一1 , a , c o s a , ) 2 + 吾搿,戳鹾蜘琏+ 放绣斑g + 矗绣 s i n 0 3 ) 2 毛* 墨1j ,2 = 主( ;学) 嵋z 吾鸺学扫: l:222 幺= 麓+ 夏= 毒掰奎2 氇警每l + 2 毽窖荻串善鞠菇热一2 魄毒曩垂;c o s a , 一2 嗨主乏争2 鲻受 一州,叠屯扫,c o s 8 3 + 4 r a s l 。f 2 台。套:州岛一b ) + i 埘,2 ,3 杏:每,。o 岛岛) + 2 m ,厶由。杏,c o “峨岛) 小吾水坠掣) 2 + ( 罕鹏搬f 一嘲施c o s 磷+ 獬 n ;三1 壕型等p 业h 警掣跨 三肼? + 2 嘶台1 2 州台:一驯。童籼c o s q 一2 , 1 2 x b :。o s 岛+ 4 m l , 1 2 # 。识一q ) 爨忿,毒戳缮剩蓉缓动麓; f ;+ + r i + 气f - l + 氛 = 三( 榭+ 码+ 所:+ 灼+ 2 功;2 一( m j + 2 m 2 + 2 m 3 + 4 m ) 叠,i 织岛 + 学强+ 敏+ 辘+ 镪霹岔+ 弓憋+ + 磁蠢一溅+ 魂+ 刎;矗魂粥连 + ( 2 懒+ 4 m ,+ 4 m ) l ,2 馥砬c o s ( i 如只) + 要雕3 譬由,一鸭; c l 雌绣 + 2 鹤乏建谚嘲一甓) + 2 鸭磊& 建毒粥一磅 艨统势能; y = ( 强+ 2 拼2 + 2 鸺+ 4 m ) g l l 粥最+ 枷2 + 2 + 2 掰) 数c o s a = 麟3 照s g 麓此,得到系统拉格朗日算乎t ; l z 哪y l。2 = 酗f + 瓢+ 氇+ + 2 m ) x “轴+ 2 嗨+ 2 鸭+ 毒磅琏谚$ 壤 + 曙懒+ 2 + 2 鸭+ 4 坍研扫;+ ( 墨+ 2 鸭+ 加蛾如2 一( 柳。十挑+ 2 m ) x 1 2 :c o s 岛 + ( 2 m 2 十4 憋+ 薅鸿乏建建蠡嘏一髌) + 搠露垂,一憋毛瞄岛 + 2 鸺屯如岛岛c o s ( 以岛) + 2 m 3 t l i j 岛岛c 0 哦q 一岛) 一( 嗍+ 2 m 2 + 2 m ,十4 r e ) g , c o s g 一( 拼2 + 2 m 3 + 2 m ) g t 2o o s 0 2 一穰l 鹑游s 是 阂为在广义搬标辞,岛,马上笼井力作用作糟,放有戳下等式成立; ! 盟一旦:o 露毋蘸麓 曼旦。堕:0 d t 融鹅 , ! 丝一竺:o 廊d 瓴鹅 展舞强上三式,分鄹可得刹下式; 一溉十2 镌+ 2 鸭+ 锄) ;毛删绣+ 毒碑+ 4 m 2 + 4 m 3 + g 辫群毒+ 2 恍+ 慨+ 4 砷 如或s ( 岛一髌) 一 + ( 2 魄+ 4 鸭+ 4 搠瞩蟊毋;s 醢岛一最) + 2 鸭弛谚螂酶) 一2 鸭,:厶菸斑鹏一色) ( 牌2 + 2 m ,十2 娜 露,s i n 熬= 0 织l ” ( 2 1 8 ) 注1 9 ) ( 2 2 0 ) ( 象2 1 ) 一鸺;屯蝴岛+ ;恍譬巍+ 2 肿,如 亩s ( q ,如) + 2 辨3 藤 ,2 s l | 嚷一建) 2 硝蟊建c o s ( o ,谚) - 2 m , u ,执s l 缓一馥) 泣2 黔 讲3 鹏如绣= o 孽簪以上( 2 1 9 ) 、( 2 。2 0 ) 、( 2 2 1 ) 三我瓣琏,琏,热臻瓣代数方糕,势将其袭涿 戚以下三式; 岛一z ( 坼聩,岛,谚,嚣最,岛,岛 ( 2 2 3 ) 壤一五( 墨壤,琏,婊,赫最,岛,绣母 注2 4 ) 壤m z ( 五嫉,建,鹋,矗最,岛,岛蝴 绉。2 5 ) 取平赞位鼹对各变量豹初缎为零, 瓯绣,姨,绣,墨壤,壤,岛磅= 鳓,蛐0 麟谬,璐 将以上三式戏孚赞位置避移泰勃级数鼹汗,并线性他,求得: 墨t2 割删螂嘲舢咏硝吨魂蛳 焉:2 刮删蝴。却汹;舶一 舻乱椭 张2 剩嘲蝴蝴。锻罅舞础 为,。到 参善 扣司喊碱魂城焉礴枷龋郴坤焉翊,;雌 。到 a e , i ,- o 一神,以柚冉枷j 咄b 枷趣枷, 柚- _ o 燕,。到 参乎2 l h 矗曲# 曲或矗二曲五曲盘柚盎曲t 趣 葛o = 1 5 9 5 潮 = _ 3 s 4 3 5 艿 = o 7 8 4 酗晦 = 0 = 0 = 0 k l f 。到 ;o a 扔i 扣。最越韪柚建蝴j l 。点鹕神砖咄;坤 k i ,。到 ;6 毋xi 驷。最柚趣埔热舡o 丑i o 砖椰商罅每。 x 2 l 如 如 ;到 苏| ,罐矗- 。彝坤焉,o ,荫悬。嗨岫砖柚j 坤 ;到 a bl j l o l o 焉柚牌钟j - o 矗棚 枷一神j l o ;到 蚕幺| 螂曲感峨砖程一蝴碡神篱吨晦柚j - o 。0 = - 1 2 7 9 = 5 7 。9 9 5 l 舻刮删砖柚枷枷神刊,艄9 & 。到 : a xl j - o 神 神焉枷j ,o 一一。焉- 。焉柚一- o 如=刻 :o 尊众| 瑚焉神韪砖磅罅棚最雌悬珊焉蛾;蟠 翰;纠 :o 0 0 2 和。是雌趣砷砖“_ o 矗1 0 焉- o 西柚鼻由 如。纠 ;o 0 0 3 i 瑚 神悬吨岛柚j - o 。n 柙0 旃砷j - 。 如。到 ;引5 8 3 l k 射瑞 神 砷j 柚 砷焉神鹏柚脚 = 0 如。刮州,岛州。 蚋矾坤越s 瑚6 如。剩删鹊蝴如螨啦。麓舶一1 6 麒5 b 。封螂。砖神一枷 蛹如曲焉柚j 柚2 纷s 4 s s 繇。纠 : a x l 枷 - o 焉一。焉幢z o 蠢i o 焉神焉柚j 曲 如。纠 。o 0 秽 l 。盔曲盘柚成越t 柚主商文柚反柚柚 韪 曲 趣 删 识翮 为,:到 :o a 口2l 枷焉枷岛卸岛- 0 一l o o 焉l o 以1 一曲 b :纠 ;o 毒护3 | ,。瞒砘如坤焉砖西矗_ 。惑瞒。赫神 如;到 :o 。0 0 3 1 8 2 1 1 霞诧筲瑷褥爨; 续= 墨2 最+ 燕3 绣+ k i t 绣+ 墨善= 1 5 9 。5 0 4 0 l - 3 8 。4 3 5 6 0 2 + 0 7 8 4 6 4 6 0 3 + 6 6 4 9 0 4 x 0 2 雀宴麓续+ 爱嚣姨+ i i 二描8 + k 挣善= 一1 2 7 9 b l + 5 7 。9 9 5 1 0 2 1 7 1 8 9 0 3 一o t 5 8 3 1 x 0 3 紫鬈羟只+ k 3 3 0 2 + 致岛+ 式辨善= 2 5 7 0 8 6 0 l 一1 6 9 2 4 5 0 2 + 3 9 。3 4 8 5 0 3 + o 0 0 3 1 8 2 1 1 x 现在得到了兰个线性微分方程,由于采用小率加速度作为系统输入,因此还需要 一令方程; 辣攀善 取状态变量为: 而= 五屯。岛,而= 0 2 ,飘= 0 3 ,屯= x , x 6 = o m ,而= 0 2 ,黾= 0 3 手愚褥舅系统熬状态空鬻方程懿下: 善 疗l 如 p j t _ 膏 口 t 一2 十 扔 ) ,兰 x 馥 岛 谚 9o oo o0 oo oo 01 5 9 5 0 4 0 1 2 7 9 o2 。5 7 0 8 6 0l00 0 0lo ol 0000 oe0 0 7 8 4 6 4 6000 一1 7 1 8 900 0 3 9 3 4 8 500 0 loo0ooo 0loo o oo oolo ooo ooolo oo 3 4 储立摆系统的定性分析 3 4 1 系统悛麓分析 + + ( 2 2 6 ) 在褥到系统的数学模登之后,为了递步了解系统性质,需要对系统静特性避行 分拆,最重要黪是系统的稳定性、髓控性以及能观测性。 系统的稳宠性分析一般可以应用l a s a l l e st h t r c n l 或者李韭普诺夫稳定性理论。 最常蔫豹是嚣纛。对予系绞在平饔点壤域麴稳定性可坟壤
温馨提示
- 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
- 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
- 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
- 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
- 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
- 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
- 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。
最新文档
- 六年级语文上学期整本书阅读《童年》期末复习教学设计
- 初中语文七年级下册紫藤萝瀑布教学设计与实施
- 高二英语选择性必修二 Unit 5 Reading and Thinking 语篇深度解读与默写训练教学设计
- 初中语文九年级中考作文选材教学设计
- 小学五年级美术《生活中的标志》教学设计
- 高一英语必修第一册Unit 3 Sports and fitness 单元整体教学设计
- 高一体育五步拳教学设计
- 小学四年级劳动教育煎牛排教学设计
- 小学四年级劳动《花瓶罩饰》项目化教学设计
- 八年级语文下册第三单元养性怡情知识清单教学设计
- 抖音直播运营中心薪酬绩效考核实施管理方案
- 2026年学生入团考试题库及参考答案
- 2027届河南省部分城市联考高三上学期11月阶段检测历史试题(含答案)
- 2026年宁夏水务投资集团有限公司招聘笔试参考题库附带答案详解析版
- 2026秋北师大版选择性必修第一册Unit 1-3 句子语法填空练习(备考期中)
- 智能体电脑行业王伟东白皮书
- 秦皇岛市建设现代有轨电车项目调研报告
- 2026秋新教材苏教版五年级上册数学第七单元 用字母表示数量关系(一) 教案(共7课时)
- 《中药炮制技术》教案-13模块十三 其他炮制技术
- 2026年辅警笔试的题库及答案
- 多模式镇痛在加速康复外科中的应用现状
评论
0/150
提交评论