基于摆线的下肢康复机器人轨迹优化.pdf
《基于摆线的下肢康复机器人轨迹优化.pdf》由会员分享,可在线阅读,更多相关《基于摆线的下肢康复机器人轨迹优化.pdf(7页珍藏版)》请在咨信网上搜索。
1、2024年 第48卷 第1期Journal of Mechanical Transmission基于摆线的下肢康复机器人轨迹优化崔冰艳 曾鸿泰 杨中原 桂小庚 李 贺 王经纬(华北理工大学 机械工程学院,河北 唐山 063210)摘要 随着现代机器人学和医疗行业的迅速发展,使用康复机器人对下肢运动损伤患者进行治疗成为国内外研究热点之一。为实现更好的康复治疗效果,对一种3自由度下肢康复机器人开展轨迹规划研究,模拟健康踝关节运动规律,对下肢康复机器人的运动轨迹进行了优化设计。基于踝关节的康复、损伤机制和运动形式,对比分析几种少自由度平面对称并联机构,确定了以2UU-UPU机构为康复执行机构的设计原
2、型;对下肢康复机器人开展下肢康复训练的轨迹规划研究,推导了摆线运动规律、叠加摆线运动规律的轨迹规划运动公式,并验证了在不同康复训练条件下轨迹的合理性;为探究更合理的康复轨迹,使用光学动作捕捉系统采集坐姿状态下踝关节的运动轨迹,建立康复轨迹约束条件,提高了规划轨迹与人体动作的相似度,可实现更好的康复效果。关键词 康复机器人 轨迹规划 动作捕捉Trajectory Optimization of Lower Extremity Rehabilitation Robots Based on CycloidCui Bingyan Zeng Hongtai Yang Zhongyuan Gui Xiao
3、geng Li He Wang Jingwei(College of Mechanical Engineering,North China University of Science and Technology,Tangshan 063210,China)Abstract With the rapid development of modern robotics and medical industry,the use of rehabilitation robots for the treatment of patients with lower limb sports injuries
4、has become one of the research hotspots at home and abroad.In order to achieve better rehabilitation treatment effect,trajectory planning of a three-degree-of-freedom lower limb rehabilitation robot is studied,and the motion law of healthy ankle joint is simulated to optimize the trajectory design o
5、f the lower limb rehabilitation robot.Based on the rehabilitation,injury mechanism,and motion form of the ankle joint,a comparative analysis of several low degree of freedom planar symmetric parallel mechanisms is conducted,and a design prototype using a 2UU-UPU mechanism as the rehabilitation actua
6、tor is determined;research on trajectory planning for lower limb rehabilitation training of lower limb rehabilitation robots,trajectory planning motion formulas for cycloidal motion laws and superimposed cycloidal motion laws are derived,and the rationality of trajectory under different rehabilitati
7、on training conditions is verified.In order to further explore a more reasonable rehabilitation trajectory,the optical motion capture system is used to collect the ankle joint movement trajectory in the sitting position,establish the rehabilitation trajectory constraints,improve the similarity betwe
8、en the planned trajectory and the human movement,and achieve better rehabilitation effect.Key words Rehabilitation robot Trajectory planning Motion capture0 引言外骨骼这一概念在早期的科幻小说中被提出,在现实社会中最早被提出可以追溯到 19 世纪 30 年代1。如今,许多下肢医疗康复机器人产品已被应用到康复治疗当中,取得了较好的临床效果。瑞士Hocoma 公司开发了 Lokomat系统2。樊晓琴等3提出一种(2-SPS+PU)&R混联式下肢
9、康复机器人,该机器人不仅能够实现踝关节的三维转动,还能实现沿腿部方向的伸展运动。崔冰艳等4提出一种以 2-URS&UPS并联机构为原型的下肢康复机器人,该机器人具有6自由度,可以做三维复合运动。崔冰艳等5还提出一种以3-UPS并联机构为机构原型的下肢康复机器人,并给出结构参数,设计了下肢康复机器人。郑凯等6研发了一款踝关节外骨骼机器人,可文章编号:1004-2539(2024)01-0075-07DOI:10.16578/j.issn.1004.2539.2024.01.01175第48卷减小穿戴者代谢能耗。为了确保下肢康复机器人对下肢康复操作的安全性、有效性,进行下肢康复机器人的轨迹规划与优
10、化是必要的。对于有简单运动轨迹要求的常采用直线插补和圆弧插补方法。陈伟华等7在机器人启停阶段加入抛物线轨迹进行过渡,减小了启停时刻的冲击值。除此之外,机器人智能轨迹规划算法主要有快速随机扩展树方法8-9、人工势场法10、遗传算法、粒子群算法以及神经网络算法等。Ayas等11基于自适应控制方法提出一种含冗余驱动的下肢康复机构,用于提高机构的轨迹规划能力。曹金鑫12基于傅里叶公司Fourier X2下肢康复机器人,对其进行改进二次开发,研究了其步态康复轨迹。1 下肢康复机器人机构建模设计下肢康复机器人的关键问题在于机构的运动形式是否与下肢踝关节、膝关节的运动形式相一致。为避免对患者造成二次伤害,机
11、构的自由度不能高于关节活动自由度,机构的工作空间要能够覆盖下肢康复运动空间。为了解决以上问题,根据医学专家对下肢踝关节、膝关节的临床研究,本文提出了一种新型2UU-UPU机构作为下肢康复机器人的机构原型,其机构简图如图1(a)所示。2UU-UPU并联机构具有3个自由度,分别是沿着动平台U轴的移动、绕动平台坐标系V轴和U轴的转动。其2个转动自由度符合踝关节的双轴转动结构,1个移动自由度可以带动膝关节做内收外展运动。该两转一移机构可以满足下肢踝关节、膝关节的运动要求,验证了机构构型的合理性。下肢康复机器人的设计目标是能够完成下肢膝关节、踝关节的康复运动。下肢关节相比上肢灵活性较差,运动幅度小,运动
12、形式简单,康复机构不需要设置太多自由度;但下肢关节处韧带大多粗壮,腿部肌肉力量大,被动康复时需要较大牵引力。因此,选用具有较高负载能力的伺服电动机作为下肢康复机器人的驱动。图1(b)为下肢康复机器人的模型示意图。该机构上下两个平台均为等边三角形,3条支链置于等边三角形的3个顶点上;驱动电动机放置在静平台上,驱动U副工作;支链两端的U副分别与动平台、静平台连接,动平台上脚托足尖指向UPU支链所在顶点,康复时人体足部固定在动平台上的脚托中。定义 UPU 支链l1可调节范围为 300400 mm,两个UU支链长度为l1=l2=300 mm。下肢康复机器人的工作空间分析是轨迹规划的基础,工作空间的大小
13、代表了康复机器人末端的运动范围,即表达了康复运动中患者下肢关节可达角度的大小,是衡量机器人工作能力的评价指标。给定下肢康复机器人的结构参数就能确定其工作空间。图2为机构空间参数约束示意图。图2 机构空间参数约束Fig.2 Spatial parameter constraints of the mechanism1)长度约束。UPU支链存在运动最大值与最小值,当支链长度达到最大值时,动平台达到工作空间的极限位置。支链1的杆长向量为l1=lA1B1=lB1P+lPO-lA1O(1)UPU支链杆长为l1=|lB1P+lPO-lA1O|(2)支链1杆长的变化有范围限制,l1max与l1min分别表示
14、规定的杆长最大值和最小值,则杆长限制条件为l1min l1 l1max2)转角约束。机构的尺寸结构限制支链的旋转角度,当U副运动发生干涉时,U副转角达到最大。机构U副不产生干涉的转角为40。静平台夹角为-40 40,动平台夹角为-40 40。使用极限边界搜索法求解机构的工作空间,给(a)机构简图(b)机构模型示意图图1下肢康复机器人机构的构型Fig.1Configuration of the lower limb rehabilitation robot mechanism76第1期崔冰艳,等:基于摆线的下肢康复机器人轨迹优化定起始转角、杆长条件并逐步增加,当杆长、平台转角等参数任意值达到极限
15、值后,对动平台P-UVW坐标系原点位置进行标记,所有标记点组合即为该机构的工作空间。将机构的结构参数代入编程,求解得出机构的工作空间。机构的工作空间如图3所示。下肢康复机器人的工作空间整体为锥体,上表面由3个凸面组成,下表面由3个凹面组成,工作空间内部紧实无空洞。工作空间在x轴方向的范围是-300300 mm,在y轴方向的范围是-300300 mm,在z轴方向的范围是0400 mm。图3 机构工作空间Fig.3 Workspace of the mechanism由图3可以看出,机构工作空间具有对称性,工作空间内部连续性好,可以覆盖踝关节的运动范围,满足左右脚踝关节的康复需求。2 基于 S 形
16、速度曲线的摆线运动轨迹规划为保证康复运动的平稳性,减小运动冲击,常用摆线运动规律13进行轨迹规划。摆线运动的位移函数连续可导,速度、加速度曲线连续,在启动、停止阶段稳定性较好,其运动规律与S形速度曲线运动规律大致相同。本文基于S形速度曲线运动规律,使用摆线运动轨迹对下肢康复机器人进行轨迹规划,以背屈、跖屈运动轨迹为例进行研究。2.1摆线运动轨迹规划摆线运动规律位移函数为S(t)=2Tt-sin(2Tt)(3)式中,T为摆线运动周期;t0,T。由图4可知,摆线运动规律中位移、速度、加速度曲线平稳,位移曲线从0开始逐渐增加,速度曲线的起点和终点都为0,且速度和加速度呈一个运动周期性变化,速度轨迹和
17、加速度轨迹的起、停阶段运动特性良好,基本满足康复轨迹的要求。由速度曲线可以看出,其运动规律类似于S形速度曲线,但其速度最大值在运动中间时刻,没有位移的匀速运动阶段,影响康复训练效果,需要对摆线轨迹进行优化处理。2.2叠加摆线运动轨迹规划优化除了康复过程中必需的匀速运动外,在极限位置的牵引拉伸也十分重要。如在康复脚踝后侧跟腱时,跟腱粗壮有力韧性强,需要在极限位置有一定时间的停止拉伸,才能逐渐恢复跟腱弹性;又如膝关节十字交叉韧带断裂后的康复训练,手术后韧带长度受限,患者只有反复进行极限位置的停留拉伸训练,才能恢复到健康膝关节的屈曲、外展角度。因此,需对叠加摆线轨迹进行优化,优化后的康复轨迹既可以做
18、匀速往返拉伸运动,也能在极限位置停留,规划完整的背屈、跖屈康复运动轨迹。患者的脚从动平台原点出发,沿动平台U轴正方向运动,达到最大位置时停止一段时间后返回,此时,踝关节做跖屈、背屈拉伸运动,膝关节做内收、外展拉伸运动,整个过程运动时间T=30 s。将两条摆线周期缩小为原函数的一半,得到轨迹函数分别为s3(t)=a 4Tt-sin(4Tt)(4)s4(t)=b 8Tt-sin(8Tt)(5)式中,a、b均为系数,a=8b。设叠加摆线运动规律函数为S2(t)=s3(t)+s4(t),t 0,T2(6)令函数在t=T2时刻对称,可得到对称函数关系式为 f(T2+x)=f(T2-x)f(x)=f(T-
19、x)(7)则后半段摆线运动函数为S2(t)=S(T-t)=s3(T-t)-s4(T-t),t T2,T(8)图4摆线运动规律的位移、速度、加速度图像Fig.4Charts of displacement,velocity and acceleration following the cycloid motion law77第48卷将初始条件代入式(6)、式(8)中,对优化叠加摆线函数分别求1阶、2阶导数,得到优化叠加摆线的位移、速度、加速度曲线如图5所示。由图5(a)可以看出,优化叠加摆线运动轨迹总体上为一条往返轨迹,轨迹从原点出发,在14.5 s时达到最大位置,并在最大位置保持约1 s的静止
20、,在15.5 s时开始沿原轨迹返回。由图5(b)可以看出,轨迹在68 s和2123 s做匀速运动,优化叠加摆线轨迹的速度曲线十分接近两个相互对称的S形速度曲线,速度曲线平滑。由图5(c)可以看出,加速度曲线整体光滑平稳,有较好的加减速效率,在 14.515.5 s时加速度为0,此时为静止拉伸阶段。通过对插值多项式和摆线运动规律的研究发现,优化叠加摆线运动规律更适合进行背屈、跖屈往复运动的轨迹规划,优化叠加摆线既能实现匀速运动过程,又能实现在最大位置的停留拉伸,能够完成整个背屈、跖屈周期的康复运动,满足下肢机器人康复轨迹的需要。3 下肢运动轨迹的采集及优化3.1动作捕捉设备介绍图6所示光学镜头是
21、动作捕捉系统的核心。本次实验使用的光学镜头是某公司生产的红外线动作捕捉镜头。该镜头表面有多颗可发射特定波长的红外LED灯,这些红外光照射到附有反光材料的反光标记点(图7),就可将红外光反射回动作捕捉镜头,镜头接收到反射回的数据后经系统内部的图像抓取、算法处理,获取每个反光标记点的二维坐标。通过一套系统中多个镜头的自身位置标定和实验空间三维位置标定,利用算法获取每个标记点的三维坐标。3.2踝关节动作捕捉实验设计选取10名在校大学生为实验对象,平均身高为180 cm,平均体质量为75 kg,年龄为2326岁,实验对象的下肢运动状态正常。实验前的准备工作有:1)使用“T”形杆和“L”形杆对实验空间进
22、行空间位置标定。2)测试前,实验对象的踝关节进行充分的拉伸活动。3)根据实验室的空间位置标定,将座椅放在场地中心,右腿垫高,使右脚悬空。4)将反光标记点粘贴到图8所示位置。5)对反光点在软件中进行命名标定,将标记点按一定顺序连线,保存前期标定数据。图8为在实验对象右脚上粘贴的3个反光标记点示意图,具体位置如表1所示。用标记点1、2的平均值表示脚踝中心点位置坐图7反光标记点Fig.7Reflective markers图6 光学镜头Fig.6 Optical lens(a)位移曲线(b)速度曲线(c)加速度曲线图5 优化叠加摆线运动规律Fig.5 Cycloid motion law of op
- 配套讲稿:
如PPT文件的首页显示word图标,表示该PPT已包含配套word讲稿。双击word图标可打开word文档。
- 特殊限制:
部分文档作品中含有的国旗、国徽等图片,仅作为作品整体效果示例展示,禁止商用。设计者仅对作品中独创性部分享有著作权。
- 关 键 词:
- 基于 摆线 下肢 康复 机器人 轨迹 优化
1、咨信平台为文档C2C交易模式,即用户上传的文档直接被用户下载,收益归上传人(含作者)所有;本站仅是提供信息存储空间和展示预览,仅对用户上传内容的表现方式做保护处理,对上载内容不做任何修改或编辑。所展示的作品文档包括内容和图片全部来源于网络用户和作者上传投稿,我们不确定上传用户享有完全著作权,根据《信息网络传播权保护条例》,如果侵犯了您的版权、权益或隐私,请联系我们,核实后会尽快下架及时删除,并可随时和客服了解处理情况,尊重保护知识产权我们共同努力。
2、文档的总页数、文档格式和文档大小以系统显示为准(内容中显示的页数不一定正确),网站客服只以系统显示的页数、文件格式、文档大小作为仲裁依据,个别因单元格分列造成显示页码不一将协商解决,平台无法对文档的真实性、完整性、权威性、准确性、专业性及其观点立场做任何保证或承诺,下载前须认真查看,确认无误后再购买,务必慎重购买;若有违法违纪将进行移交司法处理,若涉侵权平台将进行基本处罚并下架。
3、本站所有内容均由用户上传,付费前请自行鉴别,如您付费,意味着您已接受本站规则且自行承担风险,本站不进行额外附加服务,虚拟产品一经售出概不退款(未进行购买下载可退充值款),文档一经付费(服务费)、不意味着购买了该文档的版权,仅供个人/单位学习、研究之用,不得用于商业用途,未经授权,严禁复制、发行、汇编、翻译或者网络传播等,侵权必究。
4、如你看到网页展示的文档有www.zixin.com.cn水印,是因预览和防盗链等技术需要对页面进行转换压缩成图而已,我们并不对上传的文档进行任何编辑或修改,文档下载后都不会有水印标识(原文档上传前个别存留的除外),下载后原文更清晰;试题试卷类文档,如果标题没有明确说明有答案则都视为没有答案,请知晓;PPT和DOC文档可被视为“模板”,允许上传人保留章节、目录结构的情况下删减部份的内容;PDF文档不管是原文档转换或图片扫描而得,本站不作要求视为允许,下载前自行私信或留言给上传者【自信****多点】。
5、本文档所展示的图片、画像、字体、音乐的版权可能需版权方额外授权,请谨慎使用;网站提供的党政主题相关内容(国旗、国徽、党徽--等)目的在于配合国家政策宣传,仅限个人学习分享使用,禁止用于任何广告和商用目的。
6、文档遇到问题,请及时私信或留言给本站上传会员【自信****多点】,需本站解决可联系【 微信客服】、【 QQ客服】,若有其他问题请点击或扫码反馈【 服务填表】;文档侵犯商业秘密、侵犯著作权、侵犯人身权等,请点击“【 版权申诉】”(推荐),意见反馈和侵权处理邮箱:1219186828@qq.com;也可以拔打客服电话:4008-655-100;投诉/维权电话:4009-655-100。