(机械电子工程专业论文)平面绳牵引并联机构的控制研究.pdf_第1页
(机械电子工程专业论文)平面绳牵引并联机构的控制研究.pdf_第2页
(机械电子工程专业论文)平面绳牵引并联机构的控制研究.pdf_第3页
(机械电子工程专业论文)平面绳牵引并联机构的控制研究.pdf_第4页
(机械电子工程专业论文)平面绳牵引并联机构的控制研究.pdf_第5页
已阅读5页,还剩66页未读, 继续免费阅读

(机械电子工程专业论文)平面绳牵引并联机构的控制研究.pdf.pdf 免费下载

版权说明:本文档由用户提供并上传,收益归属内容提供方,若内容存在侵权,请进行举报或认领

文档简介

i 飞 c l a s s i f i e di n d e x : u d c : ad i s s e r t a t i o nf o rt h ed e g r e eo fm e n g t h ec o n t r o la n dr e s e a r c ho np l a n a r w i r e d r i v e np a r a l l e lm e c h a n i s m s c a n d i d a t e :w a nx i a o z h e n g s u p e r v is o r :p r o f z h a n gl i x u n a c a d e m i cd e g r e ea p p l i e df o r :m a s t e ro fe n g i n e e r i n g s p e c i a l t y : m e c h a t r o n i ce n g i n e e r i n g d a t eo fs u b m is s i o n :d e c ,2 0 0 9 d a t eo fo r a le x a m i n a t i o n :m a r ,2 0 1 0 u n i v e r s i t y :h a r b i ne n g i n e e r i n gu n i v e r s i t y 哈尔滨工程大学 学位论文原创性声明 本人郑重声明:本论文的所有工作,是在导师的指导下,由 作者本人独立完成的。有关观点、方法、数据和文献的引用已在 文中指出,并与参考文献相对应。除文中已注明引用的内容外, 本论文不包含任何其他个人或集体已经公开发表的作品成果。对 本文的研究做出重要贡献的个人和集体,均已在文中以明确方式 标明。本人完全意识到本声明的法律结果由本人承担。 作者( 签字) :功b 舡 日期:2 0 l o 年3 月1 5 - 日 哈尔滨工程大学 学位论文授权使用声明 本人完全了解学校保护知识产权的有关规定,即研究生在校 攻读学位期间论文工作的知识产权属于哈尔滨工程大学。哈尔滨 工程大学有权保留并向国家有关部门或机构送交论文的复印件。 本人允许哈尔滨工程大学将论文的部分或全部内容编入有关数据 库进行检索,可采用影印、缩印或扫描等复制手段保存和汇编本 学位论文,可以公布论文的全部内容。同时本人保证毕业后结合 学位论文研究课题再撰写的论文一律注明作者第一署名单位为哈 尔滨工程大学。涉辔学位论文待解密后适用本声明。 本论文( 乜任授予学位后即可口在授予学位1 2 个月后口 解密后) 由哈尔滨工程大学送交有关部门进行保存、汇编等。 作者( 签字) :币日让 日期: 2 o o 年3 月盯日 导师( 签字) :黝 伽f o 年3 只fr 日 哈尔滨t 程大学硕+ 学位论文 摘要 绳牵引并联机器人作为新兴特种机器人近年来得到了快速发展和广泛应 用,由于其具有精度高、刚度高、承载能力大、工作空间小、速度高、动态 响应好等好多优点,因此现在越来越多的学者在研究绳牵引并联机构。 本文对国内外绳牵引并联机器人的发展现状及应用进行了分析,以平面 绳牵引并联机器人为研究对象,对机器人的绳索布置方案进行分析研究,主 要对其静力学特性,作业空间进行分析研究,进而确定了本论文采用的绳索 布置。 研制了平面绳索牵引机器人的实验样机,基于本样机建立系统模型运用 m a t l a b s ;i m m e c h a n i c s 对试验样机进行了仿真分析,通过仿真分析得出不 考虑绳索的弹性变形时,各个方向的运动是互不干扰的结论。 提出了三种平面绳牵引并联机器人的控制方案,对三种控制方案进行仿 真分析,通过比较得出每种控制方案的优缺点,并确定最终的控制方案。 基于d s p a c e 半物理仿真系统对平面绳索牵引机器人的驱动控制特性和 轨迹跟踪性能进行了实验研究,主要包括系统标定实验、直线运动控制实验、 转动控制实验、复合运动控制实验、轨迹控制试验。通过对实验结果进行分 析,表明该样机的控制性能和精度满足试验需求。 关键词:绳索牵引;并联机器人;控制方案;实验研究 哈尔滨丁程大学硕十学位论文 a b s t r a c t w i r e - d r i v e np a r a l l e lr o b o t s ( w d p r ) i sw i d e l yu s e da n dd e v e l o p sq u i c k l ya s an e wt y p eo fr o b o ts y s t e m f o rt h i sk i n do fr o b o tp o s s e s s i n gc h a r a c t e r i s t i c so f h i g h a c c u r a c y , h i g h s t i f f n e s s ,l a r g el o a dc a p a c i t y , s m a l lw o r ks p a c e ,h i g hv e l o c i t y , e x c e l l e n td y n a m i cr e s p o n s ea n ds oo n ,i ta t t r a c t sm o r ea n dm o r es c a l a r s r e s e a r c h t h i sp a p e rd o e sas u r v e yo f a b o u tt h er e s e a r c ho fw d p rf r o md o m e s t i ca n d a b r o a dr e s e a r c h e r s t h ep l a n ew d p ri sc h o s e na sar e s e a r c hs u b j e c t ,t h ec a b l e s l a y o u ti sa n a l y z e d ,w h i c hf o c u so ns t a t i c sa n a l y s i s ,w o r ks p a c e a tl a s tt h ec a b l e s l a y o u ti sc o n f i r m e di nt h i sp a p e r w e d e v e l o p e d aw d p r e x p e r i m e n t a lp r o t o t y p er o b o t l a t e l y a m a t l a b s i m m e c h a n i c ss i m u l a t i o na n a l y s i sr e s u l t sb a s e do nt h ep r o t o t y p e s h o w st h a tt h em o t i o n so fd i f f e r e n td i r e c t i o nw i l ln o ti n t e r f e r ew i t he a c ho t h e r w h e nw ei g n o r et h ec a b l e s e l a s t i cd e f o r m a t i o n t h r e ec o n t r o ls c h e m e so fp l a n ew d p ra r ep r o p o s e d t h r o u g hc o m p a r i n gt h e a d v a n t a g e sa n dd i s a d v a n t a g eo fd i f f e r e n tc o n t r o ls c h e m e s ,t h eb e s tc o n t r o ls c h e m e i sc h o s e n b a s eo nd s p a c es e m i - p h y s i c a ls i m u l a t i o ns y s t e m ,t h ec h a r a c t e r i s t i c so f d r i v e ra n dp e r f o r m a n c eo ft r a c k i n gt r a j e c t o r yo fp l a n ew d p ra r eg i v e nf r o m v a r i o u s e x p e r i m e n t s ,i n c l u d i n gs y s t e m c a l i b r a t i o ne x p e r i m e n t ,l i n e a rm o t i o n c o n t r o l e x p e r i m e n t ,r o t a t i o n c o n t r o l e x p e r i m e n t ,c o m p l e xm o t i o n c o n t r o l e x p e r i m e n t ,a n dt r a j e c t o r yt r a c k i n ge x p e r i m e n t b ya n a l y z i n ge x p e r i m e n t a lr e s u l t s , i t sk n o w nt h a tt h ep r o t o t y p ec a ns a t i s f yt h ee x p e r i m e n t a ld e m a n d so fc o n t r o l p e r f o r m a n c ea n dp r e c i s i o n k e yw o r d s :w i r e d r i v e n ,p a r a l l e lr o b o t ,c o n t r o ls c h e m e ,e x p e r i m e n t a lr e s e a r c h 哈尔滨t 程大学硕十学何论文 目录 目 录1 第1 章绪论1 1 1 课题来源、目的及意义1 1 2 绳牵引并联机构1 1 3 绳牵引并联机构研究概况2 1 3 f 国外研究概况- 2 1 3 2 国内研究概况5 1 4 论文主要完成工作9 第2 章平面绳牵引并联机构总体方案1 0 2 1 引言。1 0 2 2 静力学分析1 0 2 3 工作空间分析1 3 2 4 机器人总体控制系统方案1 6 2 5 本章小结1 7 第3 章平面绳牵引并联机构运动学分析及仿真1 8 3 1 引言。1 8 3 2 运动学分析1 8 3 2 1 位置分析1 8 3 2 2 速度分析2 1 3 2 3 加速度分析2 2 3 3 系统建模与仿真2 2 3 3 1 直流伺服电动机模型2 2 3 3 2 系统仿真。2 4 3 4 本章小结2 8 哈尔滨t 稗大学硕十学位论文 第4 章绳牵引并联机器人控制方案研究2 9 4 1 引言2 9 4 2 位置闭环控制方案研究。2 9 4 3 力闭环控制方案研究3 3 4 4 力位并行控制方案研究3 6 4 5 本章小结3 8 第5 章绳牵引控制实验研究3 9 5 1 引言。3 9 5 2 控制系统硬件3 9 5 2 1 基于d s p a c e 的控制系统设计3 9 5 2 2d s p a c e 半实物仿真平台4 0 5 2 3 下位机系统4 0 5 3 实验研究。4 1 5 3 1 程序设计。4 1 5 3 2 系统标定实验。4 3 5 3 3 直线运动控制实验。4 7 5 3 4 转动控制实验。4 9 5 3 5 混合控制实验。5 1 5 4 轨迹控制实验。5 5 5 5 本章小结5 8 结论5 9 参考文献6 0 攻读硕士学位期间发表的论文和取得的科研成果6 4 致 射6 5 2 哈尔滨t 程大学硕十学付论文 第1 章绪论 1 1 课题来源、目的及意义 本课题来源于国家博士点基金项目( 2 0 0 6 0 2 1 7 0 2 4 ) ;黑龙江省自然科学 基金项目( 4 2 4 0 0 6 2 1 1 0 9 1 3 9 ) 。 当今世界各国都在努力发展载人航天技术,我国也努力开展方面的研究, 从“神一”到“神七”已取得一定的成果,然而在宇航员的训练上大家遇到了一 个共同的问题:如何使宇航员能够很好的适应太空环境。众所周之,宇航员 在超重和失重的环境下执行任务,其身体会受到严重的影响。加强在这种环 境下训练能够提高宇航员的身体素质。本文主要是为后续创建微重力环境研 究打下基础。 柔索驱动并联机器人是8 0 年代发展起来的新型机器人,它采用柔索代 替连杆作为驱动元件的并联结构机器人。其结合了并联结构和柔索驱动的优 点,既具有并联结构高刚度、高精度、高负载能力的优点,又具有柔索机构低 重量的优点。因此柔索驱动并联机器人已被广泛的应用于各种高科技场所, 例如:医疗康复、机械制造、航空航天等。随着国家大力发展科技,柔索驱 动并联机器人一定会得到更广泛的应用,该方面的研究具有重要的意义。 1 2 绳牵引并联机构 根据机构其操作端的形式,可分为串联机构和并联机构。并联机构 ( p a r a l l e lm e c h a n i s m ,简称p m ) ,可以定义为动平台和定平台通过至少两个 独立的运动链相连接,机构具有两个或两个以上自由度,且以并联方式驱动 的一种闭环机构i l 】。其概念首先是在2 0 世纪五、六十年代时提出的,但当时 科学界的研究学者对其并不感兴趣。直到上世纪8 0 年代,由于计算机技术的 飞速发展,并联机构才得到科学界研究学者的青睐,从而对并联机构的研究 才逐渐发展起来。与串联机构相比,并联机构具有精度高、刚度高、承载能 力大、工作空间小、速度高、动态响应好等特点1 2 1 。因此现在越来越多的学 者在研究并联机构。 机器人的机构传动介质可以分为刚性传动( 杆支撑) 和柔性传动( 绳索 哈尔滨t 程大学硕+ 学位论文 牵引) 两大类。绳索牵引并联机构是以绳索全部或部分地代替传统并联机构 的连杆而构成的新型机构。 为了便于研究,学者们对绳索牵引并联机构进行了分类。其中经典的分 类方法是r v e r h o e v e n 在y a m a m o t o 建立的动平台力旋量平衡方程基础上,根 据绳索的数目和自由度数将绳索牵引并联机构分为:不完全约束定位机构、 完全约束定位机构和过约束定位机构。当机构绳索的数目m 小于或等于自由 度数n 时,称为不完全约束定位机构;当机构绳索的数目m 等于自由度数n + l 时,称为完全约束定位机构;当机构绳索的数目m 大于自由度数n + l 时,称 为过约束定位机构。 1 3 绳牵引并联机构研究概况 1 3 1 国外研究概况 上世纪8 0 年代初美国国家标准与技术研究所( n i s t ) 在国防部的支持下 开始对绳索悬吊工作台的新型吊车r o b o c r a n e ( 如图1 1 所示) 进行研究,提 出了一种绳索驱动的s t e w a r t 平台,并基于不同型号的样机对其性能进行了测 试i 卅。r o b o c r a n e 的基架为由9 根6 米长的连杆构成,6 根绳索通过过轮牵引 操作平台;采用手动控制和计算机控制两种控制模式。r o b o c r a n e 可以用作吊 车、机器人的基座等。 图1 1n i s t 的r o b o c r a n e 日本r i t s u m e i k a n 大学的k a w a m u r a 研制了一台绳索牵引高速装配的机器 人f a l c o n j 5 7 1 ,如图1 2 所示,该机器人采用并联柔索牵引机构,由7 根绳索 牵引一根刚性杆,杆的一端用3 根绳索牵引,另一端用4 根绳索牵引,绳索的 2 哈尔滨t 程大学硕十学位论文 另一端连接在驱动电机上。f a l c o n 町实现工件的快速传送,如果用6 0 w 的直 流电机驱动,其最大加速度就可达4 3 9 ,最大速度可达1 3 m s ,其名字正是因 此而来( f a s tl o a dc o n v e y a n c e ) 。 图1 2日本r i t s u m e i k a n 大学的f a l c o n 美国俄亥俄州大学研制了轮廓工艺笛卡尔型绳索牵引机器人( c o n t o u r c r a f t i n gc a r t e s i a nc a b l er o b o t ) ,简称c 4 机器人,原理图女1 :1 1 3 所示。该机器人主 要用于房屋建造领域。它由1 2 根绳索牵引,4 根向上,8 根向下,下面的8 根分 成4 组,每组中的两根绳索相互平行l a - l o l 。这种绳索布置结构增加了系统的刚 度,但是同时也增加了操作平台的驱动电机数,且效率低。 图1 3c 4 机器人模型图1 4 绳索阵列机器人 美 p e n n s y l v a n i a 大学i 拘i g o r m a n 等人为了解决码头集装箱等大件装卸时 定位困难的问题【m 1 4 1 ,研制了一种绳索阵列机器人,如图1 4 所示。该机器人 是一种3 自由度绳索悬吊机器人,无法实现姿态控制,只能进行位置控制。 3 机构的立式风洞测量项目的研究工作,并取得了颇丰的理论研究成果。其先 设计了由7 根绳索牵引的立式风洞模型,如图1 6 所示。2 0 0 3 年底又制造出9 根 绳索牵引的六自由度并联立式风洞模型试验样机,如图1 7 所示,并对其进行 图1 67 根绳索牵引的立式风洞模型图1 79 根绳索牵引的立式风洞模型 运动控制实验研究。提出了基于构架的绳索牵引并联机构设计方法,并以理 论工作空间为标准验证了该方法的正确性;同时指出当飞行器模型动平台为 4 哈尔演t 程大学硕十学伊论文 点状或其尺寸相对于机架可忽略不计时,动平台的理论工作空l 旬可容易求出。 典型的并联柔索构型还有麦道( m c d i n n e l ld o u g l a s ) 公司开发的用于太 空实验的8 绳索机构【1 5 l ,如图1 8 所示;n i s t 开发的用于构造机械加工机床 的9 索机构1 1 6 】,如图1 9 所示;以及日本k o b e 大学的t a d o k o r o 和船舶技术 学院的m a e d a 提出了一种冗余并联绳索驱动机器人w a r p ( w i r e p u l l e ra r m d r i v e nr e d u n d a n tp a r a l l e l ) ,如图1 1 0 所示等。但这些机构都还在试验过程, 没有投入生产。 图1 8 麦道公司的8 绳索机构图1 9n i s t 的9 索并联机床 i 彩静鳓甥嬲秽嘲 羹鬈萋熙”鼍辫糍耩蕊 图1 1 0 冗余并联绳索驱动机器人w a r p 1 3 2 国内研究概况 最近几年,国内也出现了许多科研院所对绳索牵引并联机构方面进行研 究。 一飘啊黉l滋慰毒”委慧;貔狻 哈尔滨t 程大学硕十学位论文 西安电子科技大学的王文利、段宝岩等人建立了一种绳索悬吊的大型 s t e w a r t 平台,将绳索牵引并联机构应用到大型射电望远镜【t 7 - 2 1 1 领域中,如图 1 1 1 所示。该系统实际上是一种由不完全约束定位机构系统和一个并联连杆 平台构成的混合串并联机构。该系统与一般小型绳索牵引系统明显不同就是 绳索相对较重,在对系统进行分析时,需要考虑了绳索自重对系统的影响。 段宝岩等人通过分析力映射j a c o b i a n 矩阵的行列式和条件数,确定了该系统工 作空间奇异性,并对大柔性s t e w a r t 平台系统的刚度、绳索牵引系统的控制算 法进行了研究和分析。 图1 1 1 大型射电望远镜绳索牵引装置 ( a )( b ) 图1 1 2自由度受约束的绳索牵引机器人 6 哈尔滨t 稗大学硕十学位论文 东北大学和中科院沈阳自动化研究所合作研制了柔索驱动三自由度球面 并联机器人。该机器人由运动平台、固定平台、约束机构、4 根柔索组成。如 图1 1 2 所示,其中a 为结构图,b 为试验样机。该机器人由于约束机构的作 用,使运动平台只能作空间的三维转动。其姿态由改变柔索长度来控制盼mj 。 他们根据该机器人的机构构型,对机器人进行了运动学、静力学和刚度的研 究,并对机器人的刚度进行了控制研究。 在风洞支撑系统的应用研究中,华侨大学郑亚青1 2 5 - 3 5 1 用绳牵引并联机构解 决了若干关键理论性问题。他们在国家自然科学基金“应用于风洞实验的六 自由度绳牵引并联机构的设计与运动控制方案研究 项目资助下开展了绳索 牵引系统理论研究,并试制了实物模型。图1 1 3 为华侨大学建立的用于飞 行器风洞实验的绳索牵引系统模型。其建立低速风洞绳索牵引并联机构的动 力学模型,并对立面1 r 2 t 三自由度绳牵引并联机构的速度、加速度进行了运 动学分析,论述了绳索牵引并联机构在风洞实验的应用前景,但有关该系统 的控制研究的相对较少。 图1 1 3 华侨大学建立用于飞行器风洞实验的绳索牵引系统模型 厦门大学的高峻严i 蚓对立面1 r 2 t 三自由度绳牵引并联机构进行了系统 分析与控制。其样机如图1 1 4 。其主要对立面1 r 2 t 三自由度绳牵引并联机构 做了运动学分析,静力学分析和动力学分析,并用m a t l a b 对系统的运动学 的正逆解进行了编程运算,同时也用s i m u l i n k 工具箱对系统进行了仿真。其 主要工作放在编程运算上,试验内容只给出了程序代码。 7 哈尔滨t 稗大学硕十学位论文 图1 1 4 试验样机 上海海事大学耿永锋研究了用于集装箱吊装的绳牵引并联起重设备1 3 7 。 他先从机构的构型入手,首先指出了绳牵引并联机构与多指抓取之间的联系, 并由此引出了六自由度绳牵引并联起重设备的约束类型,然后,通过比较分 析不同约束类型机构的优缺点,从而得到六自由度绳牵引并联起重设备的约 束类型;再通过考虑机构中绳的布置问题和基础平台、动平台铰链点的布置 问题,最终设计出了六自由度绳牵引并联起重设备的结构模型。 哈尔滨工程大学机电一体化实验室在绳牵引技术方面也取得了一定的成 果,提出一种对称的5 根绳索牵引的并联机器人模型,并依此模型设计出骨 盆中心运动控制机构。如图1 1 5 。 圃 图1 1 55 根绳索牵引的并联机器人模及试验样机 8 哈尔滨t 程大学硕十学伊论文 基于这种机构模型建立了单自由度绳驱动伺服控制模型,根据此模型设 计了单自由度绳驱动系统力位置混合伺服控制器,并对力位置混合伺服控制 器进行了仿真分析l a a 4 1 1 。基于这种机构模型建立了单自由度绳驱动伺服控制模 型,根据此模型设计了单自由度绳驱动系统力位置混合伺服控制器,并对力 位置混合伺服控制器进行了仿真分析。 1 4 论文主要完成工作 本课题的研究对象是平面绳牵引并联机器人,用其来模拟人体正常走路 时骨盆的运动规律。主要完成该机器人的总体方案设计,包括总体结构方案 设计和总体控制方案设计;完成该机器人的运动分析与仿真:并对该机器人 的控制方案进行规划,得到最好的控制方案;最后研制实验样机,进行各种 运动的实验研究。 ( 1 ) 确立平面绳牵引并联机器人的布置方案。对方案进行工作空间仿真, 并对机器人控制系统总体方案进行分析。 ( 2 ) 对平面绳牵引并联机器人进行运动学分析,包括位置分析,速度分 析,加速度分析。对分析进行仿真验证。 ( 3 ) 建立运动学模型,对系统进行仿真试验,包括直线运动仿真实验、 转动仿真实验和复合运动仿真实验。 ( 4 ) 对平面绳牵引并联机器人的控制方案进行研究,包括位置闭环控制 方案、力闭环控制方案、位力并行控制方案。通过研究找到控制性能较好的 控制方案。 ( 5 ) 基于d s p a c e 进行半物理仿真实验研究。搭建实验平台,在实验平 台上进行系统标定实验、直线运动控制实验、转动控制实验和复合运动控制 实验等实验,证明所研制绳索牵引机构满足骨盆运动规律的控制要求。 9 哈尔滨t 程大学硕+ 学位论文 第2 章平面绳牵引并联机构总体方案 2 1 引言 对于平面绳牵引并联机器人的控制研究,必须先要确定其的结构布置。 只有确定了其结构布置才能展开下面的研究,因此本章先通过对几种平面绳 牵引并联机构布置进行静力学分析、作业空间分析,进而确定本课题最终采 用的结构布置。 2 2 静力学分析 有关平面绳牵引并联机构的布置有很多种,现以3 种典型可用方案为对 象,利用数值解法对其进行静力学分析。3 种布置方案如图2 1 所示。 ( b ) ( c ) 图2 1 绳索牵引结构方案布置 1 0 哈尔滨t 程大学硕十学何论文 根据机构结构形式,坐标原点为平台的中心点。6 1 = ( - 7 1 9 ,一5 2 8 ) m m 、 b 2 = ( 7 1 9 ,5 2 8 ) m m 、b 3 ;( 7 1 9 ,- 5 2 8 ) m i l l 、钆= ( - 7 1 9 ,5 2 8 ) m m 为绳索相对地面的 四个基点。当采用图2 1 ( a ) 的连接形式时,其动平台连接点为 p l = ( 一8 0 ,- 1 0 0 ) m m 、p 2 = ( 8 0 ,1 0 0 ) m m 、p 3 = ( 8 0 ,- 1 0 0 ) m m 、p 4 = ( - 8 0 ,1 0 0 ) m m ; 采用图2 1 ( b ) 的栓法时,p l 一( - 8 0 ,1 0 0 ) m m 、p :一( 8 0 ,一l o o ) m m 、 p 3 ;( 8 0 ,1 0 0 ) m m 、p 。= ( 一8 0 ,一1 0 0 ) n l m ;采用图2 1 ( c ) 的栓法时, p l = ( - 8 0 ,1 0 0 ) m m 、p 2 = ( 8 0 ,1 0 0 ) m m 、p 3 = ( 8 0 ,- 1 0 0 ) m m 、p 4 = ( - 8 0 ,- 1 0 0 ) m m 。 设绳索的拉力为t = ( t i ,t 2 ,t 3 ,t 。) 1 ( t l t 。为绳索的拉力) ,平台受力为 f = ( c ,e ,m :) t ( f x 为平台x 方向的合力,只为平台y 方向的合力,m :为 平台绕z 方向的力矩,) 。则系统满足平衡方程 f 。j t ( 2 - 1 ) j 一 “l y ,g l y 一y “2 z 口2 y h 缸 h 3 y ,2 j 口2 ) ,一吒y 2 j吃,“3 ) 一,3 y h 3 j 口缸 口4 ) , r 4 j 。h 4 y 一,乙y 。口4 x ( 2 - 2 ) 式中,为该位姿下的系数矩阵 当t 。已知时可通过公式算出f ,由于,是一个3 x 4 的矩阵,所以当f 已知时无法求得每根绳唯一的拉力解,根据矩阵知识 t - j + f + z ( 2 3 ) 式中,+ 为厂的广义逆 - ,+ f 为方程( 2 3 ) 的最小范数解 正训j 丁= 0 的通解,即方程( 2 3 ) 的绳索拉力零空间解 在这里根据伪逆矩阵的定义,零空间解r o 。可由( ,。一j + ,) i 计算,其中 i = ( f l ,t 打,t 3 ,t 4 ,) t 为任意拉力向量。可见平面绳索牵引机器人在给定合外力 时,可以对其绳索拉力进行任意的规划,从而满足机器人系统对绳索拉力的 控制。 因此我们可以看出根据静力学力螺旋平衡方程式( 2 - 1 ) ,在已知四根绳 索的拉力和平台位姿的情况下可以对平台的合外力进行分析,即存在静力学 唯一解。而根据反解方程( 2 - 3 ) 我们解不出各个拉力的唯一解,其解有很多 个。在本实验中我们采用先对绳索拉力进行预紧,然后对其进行位置控制, 只要在控制的过程中绳索的拉力一直为正即可。因为存在一组拉力值是符合 哈尔滨t 稗大学硕十学何论文 静力学力螺旋半衡方程式( 2 一1 ) 的。取图2 1 ( a ) 进行验证,当半台处于中 心原点时 _ 0 8 3 1 0 8 3 10 8 3 1 0 8 3 1 1 j l 一0 5 5 6 0 5 5 6 0 5 5 60 5 5 6i l - 3 8 6 2 3 8 6 2 3 8 6 23 8 6 2i l j 取t ;【8 0 , l o o ,1 0 0 ,8 0 】t n ,计算结果为f = 【3 3 2 4 ,0 ,o 】t n 。由于绳索是柔 性的,只能受拉力,不能受压力,这里利用杆来替代机构中的绳在m a t l a b s i m u l i n k s i m m e c h a n i c s 下仿真,只要保证杆件始终受到拉力的作用即可。原 理图如图2 2 所示。 图2 2 仿真原理 在四根绳上分别加上力t 一【8 0 ,1 0 0 , 1 0 0 ,8 0 】t n ,然后在平台上加一个一f 的 力,如果平台不移动说明计算结果正确。仿真程序如图2 3 所示。 c _ _ 图2 3 仿真程序 1 2 哈尔滨下程大学硕十学位论文 通过仿真可以看出平台移动了( 7 8 6 9 e 0 0 5 ,0 ,3 5 4 4 e 0 1 2 ) ( m m ,m m ,。) , 理论上平台的位置应该是不发生运动的,这里平台运动了一点,这是由于计 算的精度不够引起的。平台这里运动的距离很小可以忽略不计。由此可见建 立的仿真模型是正确可用的。 2 3 工作空间分析 绳索牵引机器人的工作空间是指平台处于一定的位姿下,由静力学力螺 旋平衡方程式能够解出绳索拉力都大于零,即绳索都是受拉力作用,由这样 的位姿组成的集合称为绳索牵引机器人的工作空间。 在下肢步态康复训练过程中,骨盆在水平面内的运动轨迹描述方程为 f 珈7 5 c o s ( 0 0 锄) y 一7 5 c o s ( 0 o 撕) ( 2 - 4 ) l 疋= - 5c o s ( 0 0 2 s r t ) 式中x 沿x 轴位移,( m m ) y 沿y 轴位移,( m m ) 足绕垂直轴转动,( 。) 这里为模拟骨盆的运动规律搭建如图2 4 工作台,其运动总范围为 扛,yl - 7 1 9 z 7 1 9 ,- 5 2 8 y 5 2 耐( 姗) 图2 4 试验台的结构布置 当平台处于一定的位姿下,并且在该范围内存在都大于零的拉力解,则 该位姿就在其工作空间内。拉力值是否为正通过其系数矩阵的标准正交零空 1 3 畸目熙 ( c ) 图2 5 平台0 = 0 。时的可控工作空间 在位姿口;5 0 时仿真的工作空间如图2 6 所示,从图2 6 中可以看出工 作空间明显比图2 5 减小了,方案a 、方案b 的可控工作空间还能满足控制 的要求,而方案c 的己明显不能满足控制要求。因此我们在这里选用方案a 和方案b 两种布置方式对平台进行研究。 1 4 哈尔滨t 稃大学硕十学伊论文 ( a ) 挺 尉 暴 誓 型 墨 ( b ) ( c ) 图2 6 平台0 5 。时的可控工作空间 图2 7 转动工作空间 由于平面内每一点都有其对应的转动工作空间,我们不能一一进行仿真, 1 5 哈尔滨t 稗大学硕十学位论文 这里我们只对a 方案平台在原点位置时进行转动工作空间分析,在平台运行 时我们不可能让其转动工作空间大于在原点时的转动工作空间。a 方案平台 在原点时的转动工作空间如图2 7 所示。通过图2 7 可以看出平台的转动空 间为( 一1 2 5 。,1 2 5 。) ,在实验中我们最大取平台的转动工作空间为 ( - 5 。,5 。) ,所以完全满足试验要求。 2 4 机器人总体控制系统方案 本实验机器人主要采用位置闭环系统,同时对四根绳索上的力进行监控, 只要绳的拉力在所允许的范围内系统即为正常。其控制系统总方案如图2 8 所示, 图2 8 系统总体控制方案 主要包括d s p a c e 仿真平台、a t m e g a l 2 8 单片机、驱动放大器、电机、拉线 传感器、编码器、编码器接口等。d s p a c e 与单片机分别完成不同的功能。 上位机d s p a c e 主要完成各种轨迹的算法,接收下位机的反馈信息,并向下 位机发送控制指令。在上位机做人机交互界面,可以使系统得到很好的控制。 上位机具有很高的运算速度,可以进行快速的控制运算,并把相应的控制信 号及时的通过d a 接口发送给单片机。 1 6 哈尔滨下稃大学硕十学位论文 下位机负责执行上位机发送的控制指令,将其转换为4 路对应占空比的 p w m 信号,然后通过驱动放大器来驱动电机的运行,电机的尾部装有增量式 编码器,可以对电机的速度和位置进行即时的反馈。平台的x ,y 方向各按 有拉线传感器,这样可以对平台的实际位置进行直接测控。每根绳索上分别 都有拉力传感器,对力进行实时监控。 2 5 本章小结 本章对平面绳牵引并联机构进行了静力学分析,并通过计算和仿真验证 计算的正确性,同时也提出了一种仿真思路,给平台驱动力的同时给其末端 相反的力,这个力是通过计算得到的,如果平台不移动说明模型计算正确。 同时还针对几种不同平台的布置进行工作空间分析,通过工作空间的分析确 定了绳索并联结构的布置,最后设计了系统的控制方案。 1 7 哈尔滨t 稃大学硕十学何论文 第3 章平面绳牵引并联机构运动学分析及仿真 3 1 引言 为了更好的了解平面绳牵引并联机构的特性,对平面绳牵引并联机构进 行运动学分析,在分析的过程中没有考虑绳索的弹性变形,即认为绳索的刚 度很大,提供的拉力不是太大,所以在运动学分析时没有考虑绳索弹性变形。 3 2 运动学分析 3 2 1 位置分析 针对图2 1 ( a ) 的布置方案,我们在其工作空间内对平面绳牵引并联机 器人进行位置分析。设平台从平面内一点d ,运动到d 如图3 1 图3 1 平面运动图 设0 点位姿坐标为( q ,q ,口) ,0 点位姿为( 0v x ,0 ,口i ) ,由前文知道 皿。b 4 是已知的,根据平台的布置结构,利用机器人学的坐标变换f 4 2 州可求得 号只,p ,。实际坐标。 刚黧等卜引 1 , 式中最a - - 1 4 ) 为号一只的横坐标 只( f = 1 4 ) 为号以的纵坐标 一一为已知的矢量坐标( 由平台的实际尺寸决定, 一( 8 0 ,1 0 0 ) ,厂2 = ( - 8 0 ,l o o ) ,吩= ( - 8 0 ,- 1 0 0 ) ,r 4 = ( 8 0 ,一1 0 0 ) ) 一扣j 孑丽f 耵 即;扣j f 磊而瓦面再瓦i i i 而丽 ( 3 2 ) 限,= 1 4 ) 为日且的坐标 同理可以求得平台中心点在o 点时的ew 1 ,。实际坐标和z :o = l 4 ) , 因此可求得当平台的位移大小为1 0 f _ d i 时,各根绳索的变化量z = 一z :。 当平台的中心位置已知时,可求的工作空间内任何一点的绳索变化量。 针对这种布置我们做逆运动学分析已知各根绳索的长度t o = 1 4 ) 求平 台中心点的位置。由几何关系可知: 2 = ( 凡一兄) 2 + ( 墨,一置,) 2 j 乙= q + ,h c o s 0 一吒ys i n 8 号y = q + 亿s i n 0 + _ y c o s 0 2 = 帆一q 一,hc o s o + r 1 】,s i n e ) 2 + 假y - o , - r h s i n o - r a yc o s o ) 2 ( 3 3 ) 同理,分别利用绳长乞,毛可得到式: 乞2 = ( b ,一q r 2 xc o s o + 厂2 ys i n o ) 2 + ( 垦y q 一仫s i n 0 一c o s o ) 2 ( 3 - 4 ) f 3 2 = ( 召0 一q 一乃。c o s o + r 3 ys i n o ) 2 + ( b y - o , - r 3 ,s i n o - 5 ,c o s o ) 2 ( 3 5 ) 1 9 哈尔滨t 稗大学硕十学何论文 由式( 3 - 3 ) ,( 3 - 4 ) ,( 3 - 5 ) 町以求得d ,0 0 。通过分析可以看出求解 中心点的位置只需要确定三根绳索的长度就可以确定下来,第四根绳索保证 绳索承受的是拉力,需满足位置协调方程即可,即此仿真时,该运动驱动未 加。因此,当已知输入各根绳索的绳索长度l e ( i 一1 。4 ) 时,便可以确定平台 在固定坐标系中的位姿。控制时只需要控制每根绳的长度即可。 基于第二章的机构模型,对位置分析进行仿真验证,为下面控制仿真做 准备。其模型如图3 1 ,取平台从原点开始运动到位姿为( 1 0 0 ,1 0 0 ,5 。) 的d t 点。经过上面的计算可以得出在d 时各绳长分别为 t ;( 6 3 1 7 2 7 ,8 0 4 2 2 4 ,9 7 5 8 6 4 ,7 5 4 0 8 9 ) ( i = 1 4 ) 1 0 7 6 9 5 0 9 = 乇- l , 一( 1 3 7 7 8 2 ,- 3 4 7 1 5 ,- 2 0 6 3 5 5 ,1 5 4 2 ) ( i 一1 4 ) 分别给机构模型中的每根绳索的变化量a , “= 1 4 ) ,然后观看平台中心 点的位置是否为( 1 0 0 ,1 0 0 ,5 。) ,图3 2 为仿真的程序图,图3 3 为仿真结果 图。 图3 2 仿真的程序图 2 0 哈尔滨t 稃大学硕十学位论文 图3 3 仿真结果图 由上面的仿真可以看出平台的稳态位姿为( 1 0 0 ,9 9 9 9 ,5 0 0 6 。) ,虽然与 理想结果有一点误差,但完全可以忽略,这跟计算绳长时所取得精度有关系。 另外在仿真时只添加三个位置驱动,如再施加第四个位置驱动时,仿真将报 错,说明系统约束受到侵犯( 即未满足位置协调方程) ,这也根上面的分析完 全一致,系统只需要三根绳索就可以确定平台的位姿。 3 2 2 速度分析 速度是位移对时间的导数,根据式子( 3 2 ) ,可得 2 = ( 吃一q 一珞c o s 口+ 厂耖s i n o ) 2 + ( 一q - r 。s i n o 一勺c o s o ) 2 ( 3 - 6 ) 两边同时对时间求导得 “;( 吃一q 一乞c o s 日+ 勺s i n p ) ( 一屹+ r 讧s i n 铴+ 勺c o s 铴) ( 3 7 ) + ( 一q r us i n 0 一勺c o s o ) ( 一0 一名c o s o w + r f ys i n o w ) 巧= g ( - v ,+ r n s i no w + , c o s o w ) + n ( - v y k c o s o w + r , s i n o c o ) ( 3 - 8 ) 2 1 哈尔滨t 程大学硕十学位论文 式中m 一坠坚产 虮( 一q 一气s i n 0 一勺c o s 0 ) f 为绳索在绳所在方向上的速度 y ,为平台在x 方向上的速度 v ,为平台在y 方向上的速度 为平台的角速度 由公式可以看出当平台的速度恒定时,各绳的速度不为线性。 3 2 3 加速度分析 , 加速度是速度对时间的导数,我们可以通过对( 3 8 ) 两边求导,得到加 速度的公式。这里采用动力学计算来求平台的加速度,已知四根绳索的拉力 z = ( 毛,t 2 ,t 3 ,t 4 ) 1 (

温馨提示

  • 1. 本站所有资源如无特殊说明,都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
  • 2. 本站的文档不包含任何第三方提供的附件图纸等,如果需要附件,请联系上传者。文件的所有权益归上传用户所有。
  • 3. 本站RAR压缩包中若带图纸,网页内容里面会有图纸预览,若没有图纸预览就没有图纸。
  • 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
  • 5. 人人文库网仅提供信息存储空间,仅对用户上传内容的表现方式做保护处理,对用户上传分享的文档内容本身不做任何修改或编辑,并不能对任何下载内容负责。
  • 6. 下载文件中如有侵权或不适当内容,请与我们联系,我们立即纠正。
  • 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。

评论

0/150

提交评论