哈尔滨工程大学硕士学位论文根瞎各点坐标关系有:己COS屈+14COS成=乞COSy+,1cos/31(2-8)(2-9)乇sin压+厶sin成=12sin7+‘sin展将两式联立得:P一,;+学+日+2t/4cos(33一卢。)-2ljlcos(33-f11)-21114cos(34一屈)=:0(2:一10)设计变量取x=(Xl,x2,黾,x4,x5)丁=(厶,12,如,14,),)r确定目标函数为:minE:[Cl窆肛了万+厄而](2-11)式中:m一采样点个数,此处m取11;xP一理想瞬心横坐标值;%一理想瞬心纵坐标值;Cl,C2一加权系数;_:一实际瞬心横坐标;儿:~实际瞬心纵坐标。膝关节运动不同角度时,理想瞬心坐标对应值14317§11表2.2所示。表2.2膝关节理想瞬心坐标值理想瞬心坐标值膝关节屈曲角度(。)xP/mmyp|撇000103147203l8730261074021118501812460161277014129801213090111311009132当四杆膝关节运动时,由BC杆带动CD杆和AB杆运动,此机构为双摇杆机构。由连杆机构运动学可知,与最短杆相对的构件为机架,IiI]BC为机架,则AD为最短杆,且要求最短杆与最长杆长度之和小于或者等于其他两杆长度之和。所以,该机18第2章下肢外骨骼助力机器人整体:方案设计构的运动学约束条件为:‘<‘,厶<乞,‘<如厶+ll≤乞+,3厶+如≤ll+毛么+13≤‘+/2,min≤‘≤k。取,mi。=30mm,k。=60mm。使用MATLAB最优化工具箱中的fmincon()函数进行最优化设计,得到优化结果为‘=59.5mm,乞=46.1mm、,/3=45.5mm,/4=32.1mm,y=O.4625rad。根据优化结果,对多轴四杆膝关节在Pro/E中建立三维简图,如图2.14所示。连接处均销轴连接。大腿连杆销轴前连杆后连杆\小腿连杆图2.14四杆膝关节三维图在Pro/E机构分析模块中,设置伺服电机各项系数,AD杆与大腿杆固连,没有相对转动,运动速度设为10。/s,运动时间为10秒,得到C、B两点的坐标变化曲线如图2.15所示。19哈尔滨工程大学硕士学位论文蠢&§《}≤i{鼙≥}i#j{《dnli}摹峙年缮s铺《☆6∞≥i;i凝弼《j,EiⅣ醚誊l≮§!鬻霪黧鬃i鞭錾l}鹈囊i鞠鞠l鬻璧鹫:鹫鬻添蠢瓣瓣ll×鳓5“粕.嚣.i讳矗。0^#Ii,々‘姐酬t目}{“l姆j榔■”f《瓤lf赫笺i主薹鬻藉篱鬻,i《藕n嚣瀑溺鬻C点横坐标变化轴日‘躏{{:瑟黧}簸}{釉{i缝鳞?普‘抽#C点纵坐标变化黼q垮照l畿骚瞪蜘鬻j疆蟛鬻鬟鬣赣蔓二”qt砘.~辑驰辫秀鬻溺鬃鬻溱鬻孽誓孽i习菇…i蠢※i蠹羞誓辩薅添鎏溪j≤藿鲤、疆!渤錾蓊潦嚣i章姆-一鹈釉i糍瑟瑟l酾’i孬茹∽%灌。硼‘%髓.■㈣舭州斟黼‘啦:#j“t一.『^辨菇越皇妻9{,{拍始i爨i鳓蚋。’擀科”“{黼;警幕《l哆二罄孥r慧’§冬登!磐B点横坐标变化B点纵坐标变化图2.15膝关节各轴运动轨迹坐标变化该机构瞬心位置为CD和AB两直线交点,即C点的每一组坐标值和D点都有一条直线,同理B点的每一组坐标值也和A点有一条直线,然后分将对应的直线求交点即为瞬心轨迹坐标的离散点,如图2.16所示。鏊|||}藕器鬻霪{囊篆黉{攀鬻嚣l鬟,、;||||l§黧瑟。鼙l囊÷i鬻濡瓣墓鬻罄t鍪囊l鬻糕糍霭辫ii鞴囊薹j蕤l||1l黪溺隧l黍鬟鬻雾溪孽囊羹霪黎鎏熬鋈l霾l蒸l蘸ll鬻l蒸l鬃翳鬻鬻鬻鬻l蠢繁鬻i鬻篓攀添鬻鬻l鋈隧缀l蒸《鬻黍鬓鬻繁{篓纛蒺l鎏溪震粪鬻熏溱l》豢I|||i鬻滋鬻滋鬻鬻《戮鬻蒸嚣i黍l鬻。’’∞㈣V誉激瓣目,《i鬃i鬻《l鬻藿戮霪l§l燃囊蓥夔鬻鬟※l蒺鬻溪豢黧瑟i§《i荔li缀鞭i骥麟一麓矗尝j”。’糕。蘩囊l群:讳。糍§搿薹毳…。…一糕“。蔫。,I嚣孽搿一i糖甓L二—型刿薯l”I|:{I。镌l矗辫镥戮群臻黪嚣妻誓萼’嚣8戮一;j—i”垂霎潞嚣c秘“置,叠?j_:{I。11“、i1。馘i羹,*。4女㈣。ioi曩飘靴g、o脚.≮一掣。一蹦辨§矗嚣,獬《斟t。¥i磊r,.:。踟.{哨“‘。5。。2=融4壤“川{、、一r_,、、≈《≈.,;,…。。一隧。。i誉’荔鬈》4戮溪≯“孽‘《瑟■目×、㈡#w‘:o,t。≯j%。■,、一_l糍i。20第2章下肢外骨骼助力机器人整体:孑案设计由图2.16可以看出,该机构运动瞬心轨迹类似“J”形,能够模拟人体膝关节真实的运动,故符合仿生设计要求。2。4机器人驱动方案图外骨骼助力机器人单侧腿驱动方案选择示意图如图2。17所示,在三维设计图案件PRO/E中建立三维效果图如图2.18所示。图2.17驱动方案示意图图2.18整体结构三维效果图2.5机器人整体控制方案2.5.1控制系统设计要求下肢外骨骼助力机器人的主要任务是穿戴在人体下肢外侧,辅助下肢有运动功能障碍的人在给定的关节角度变化曲线下与人体协调运动,模拟正常人体步态特征。要求尽量减小机器人系统与使用者之间相互干涉作用,并在可靠的安全范围内工作,这就对控制系统提出了较高的要求:(1)准确性和快速性要求。由于下肢外骨骼助力机器人是模拟正常人体的步态规律,这就要求控制系统能够快速准确的实现人体下肢各个自由度的位置变化,真正达到辅助人体下肢运动的目的。本系统中,上位机通过传感器和编码器反馈的信息,按照指定的关节角度变化曲线,给下位机位置指令,从而使各个关节协调运动,快速准确地合成步态动作。(2)稳定性和舒适性要求。下肢外骨骼助力机器人主要的使用人群是下肢有运动功能障碍的患者,因为安全性是需要首要考虑的因素,这就要求控制系统要有很高的稳定21哈尔滨工程大学硕士学位论文性,不毙产生突变和失控的可能会对患者造成伤害的现象。另外,机器人要固定:在患者的下肢上,共同运动,对于舒适性也有一定的要求。(3)拟人化要求。下肢外骨骼助力机器人是在人机工程学的拟人化思想的基础上提出的,要求控制系统能够真实的帮助人体下肢完成类似正常人的步态运动,并且对于不同人群要有较好的适应性,这也要求机器人的结构设计在能够满足要求的前提下尽量简单有效。2.5.2控制系统总体方案下肢外骨骼助力机器人系统采用分散控制方式,即上位机和下位机的控制形式。分散控制又称分级控制或者集散控制,其具有功能和任务分散、易于维护能特点,并且伺服控制精度较高,实时控制性能较好。确定下肢外骨骼助力机器人控制系统总体结构原理图如图2.19所示。图2.19机器人控制系统原理图22
好文档 - 专业文书写作范文服务资料分享网站