CN105455819B - 可穿戴仿生外骨骼机械腿康复装置的站立模式控制方法 - Google Patents
可穿戴仿生外骨骼机械腿康复装置的站立模式控制方法 Download PDFInfo
- Publication number
- CN105455819B CN105455819B CN201510765556.4A CN201510765556A CN105455819B CN 105455819 B CN105455819 B CN 105455819B CN 201510765556 A CN201510765556 A CN 201510765556A CN 105455819 B CN105455819 B CN 105455819B
- Authority
- CN
- China
- Prior art keywords
- motor
- hip
- knee
- user
- standing
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 239000011664 nicotinic acid Substances 0.000 title claims abstract description 18
- 210000001624 Hip Anatomy 0.000 claims abstract description 103
- 210000003127 Knee Anatomy 0.000 claims abstract description 85
- 210000000689 upper leg Anatomy 0.000 claims abstract description 40
- 210000001699 lower leg Anatomy 0.000 claims abstract description 22
- 230000003068 static Effects 0.000 claims abstract description 14
- 230000000694 effects Effects 0.000 claims abstract description 8
- 210000002414 Leg Anatomy 0.000 claims description 53
- 210000002683 Foot Anatomy 0.000 claims description 42
- 230000001133 acceleration Effects 0.000 claims description 23
- 238000001514 detection method Methods 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 238000011084 recovery Methods 0.000 claims description 3
- 230000001960 triggered Effects 0.000 claims description 3
- 239000007787 solid Substances 0.000 abstract description 3
- 230000001429 stepping Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 13
- 241000209134 Arundinaria Species 0.000 description 8
- 210000003141 Lower Extremity Anatomy 0.000 description 5
- 230000000875 corresponding Effects 0.000 description 5
- 238000000034 method Methods 0.000 description 5
- 239000011248 coating agent Substances 0.000 description 3
- 238000000576 coating method Methods 0.000 description 3
- 238000004891 communication Methods 0.000 description 3
- 210000000629 knee joint Anatomy 0.000 description 3
- 206010033799 Paralysis Diseases 0.000 description 2
- 206010033892 Paraplegia Diseases 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000002708 enhancing Effects 0.000 description 2
- 210000004394 hip joint Anatomy 0.000 description 2
- 230000003387 muscular Effects 0.000 description 2
- 210000000988 Bone and Bones Anatomy 0.000 description 1
- 210000001364 Upper Extremity Anatomy 0.000 description 1
- 210000000707 Wrist Anatomy 0.000 description 1
- 230000002159 abnormal effect Effects 0.000 description 1
- 201000008804 arthropathy Diseases 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000006011 modification reaction Methods 0.000 description 1
- 238000000465 moulding Methods 0.000 description 1
- 201000000585 muscular atrophy Diseases 0.000 description 1
- 230000001131 transforming Effects 0.000 description 1
Abstract
本发明公开了可穿戴仿生外骨骼机械腿康复装置的站立模式控制方法;该方法包括1)站立触发条件判断和2)触发站立动作:若控制模块检测到用户满足站立的触发条件,控制模块随即向髋部电机和膝部电机发出指令,使膝部电机不转动,髋部电机加速至速度v0并匀速转动,∠髋减小,带动用户躯干与大腿产生相对角度运动,随后髋部电机减速至静止;然后髋部电机、膝部电机同时加速至速度v1并匀速转动;∠髋增大,同时,∠膝增大,带动用户躯干与大腿、大腿与小腿产生相对角度运动,随后髋部电机、膝部电机减速至静止,实现平行站立状态;本发明可以帮助患者初期进行站立训练,也有利于逐步提高患者对外骨骼的适应性,为后期的行走动作打好基础。
Description
可穿戴仿生外骨骼机械腿康复装置的站立模式控制方法
技术领域
[0001] 本发明涉及一种站立模式控制方法,特别是涉及一种可穿戴仿生外骨骼机械腿康 复装置的站立模式控制方法,用于下肢瘫痪人员行动与康复。可穿戴仿生外骨骼机械腿康 复装置简称康复装置。
背景技术
[0002] 目前,因各种原因而导致截瘫的患者不断增多,他们不仅行动不便,在心理上也承 受着很大的负担。对于那些下肢瘫痪但上肢健全的患者而言,需要借助康复工程的手段去 改善其下肢的身体机能。
[0003] 可穿戴仿生外骨骼机械腿康复装置是一种穿戴在下肢,由电机关节带动下肢运动 功能障碍患者相应关节运动,达到训练功能的机械装置。为了解决截瘫病人长期卧床或者 坐轮椅引起的肌肉萎缩等身体问题,帮助他们重新站立和行走,提高其生活质量,并减轻患 者心理负担,开发具有高科技含量和自主知识产权的外骨骼机械腿康复装置并研宄相应的 模式控制方法具有很重大的现实意义。
发明内容
[0004]本发明提供了一种可穿戴仿生外骨骼机械腿康复装置的站立模式控制方法,对康 复装置进行控制,使其从坐姿态向平行站立姿态平稳、安全变换。
[0005] 本发明目的通过如下技术方案实现:
[0006]可穿戴仿生外骨骼机械腿康复装置的站立模式控制方法,包括如下步骤:
[0007] 1)站立触发条件判断:控制模块分析处理传感器采集到的数据,判断是否同时满 足以下条件:C1:Z膝=80 (±1 ),/髋=90°(±l°),C2:/_g=+5°〜+15°,Z:fc&=-5°〜+ 5°,C3:Fp+Fc= (10%〜30%)G,|Fpl_Fpr|/Fp = 0〜10%,C4:Fc= (5%〜25%)G;若同时满足 条件Cl、C2、C3和C4,则满足站立触发条件;若未满足条件Cl,控制模块将尝试自动恢复,如 自动恢复不成功则需要请求维护人员进行修复;若未满足条件C2、C3或C4,则通过语音模块 引导用户满足以上条件,并持续检测传感器数据,直至用户姿态满足触发条件;
[0008] 2)触发站立动作:若控制模块检测到用户满足站立的触发条件,控制模块随即向 髋部电机和膝部电机发出指令,膝部电机不转动,髋部电机开始以加速度a0从静止匀加速 至速度v0,以速度v〇转动,咸小,带动用户躯干与大腿产生相对角度运动,直至控制模块 检测到将要达到/髓=8〇°,控制髋部电机以加速度-a〇匀减速至静止;髋部电机、膝部电机 开始同时以加速度al从静止匀加速至速度vl,以速度vl转动;Z髓增大,带动用户躯干与大 腿产生相对角度运动;同时,Z膝增大,带动用户大腿与小腿产生相对角度运动,直至控制模 块检测到将要达到Z髓=170°,Z膝=170°,控制模块控制髋部电机、膝部电机同时以加速 度-al匀减速至静止,实现平行站立状态。
[0009]所述Z膝为膝关节角度,即大腿支架与小腿支架构成的角度;/髓为髋关节角度,即 躯干支架与大腿支架构成的角度;所述Z前后为以躯干垂直地面为基准,躯干前后倾斜的角 度,前倾为正,后倾为负;Z:s&为以躯干垂直地面为基准,躯干左右倾斜的角度,左倾为正, 右倾为负;G为用户体重;FC为去除拐杖自身重力,左右拐杖触地端所受总压力;FP为左右脚 底总压力;Fpl为左脚单独压力;Fpr为右脚单独压力。
[0010] 为进一步实现本发明目的,优选地,所述控制模块分析处理传感器采集到的数据 是在用户使用腕表选择“站立”运动模式后进行。
[0011] 优选地,当用户使用腕表选择了“站立”运动模式后,若身体姿态不满足站立触发 条件,控制模块向语音模块发出消息,后者提醒用户调整姿态,直至控制模块检测到用户满 足站立触发条件;用户根据语音提示中的具体操作指引调整身体姿态;如C1未达要求(正常 情况下电源开启后膝部电机与髋部电机锁定,膝部角度Z膝=80° (±1°),髋部角度Z髋= 90° (± 1 °)),则通过语音模块提示用户“目前存在故障不宜站立”,然后尝试自动恢复,若自 动恢复不成功则需要请求维护人员进行修复,直到C1满足,才可再次进行站立;如C2未达要 求,则会提示“请使用拐杖向上向前支撑身体,使上半身稍微向前倾斜,并尽量避免向左或 向右倾侧身体”;如C3未达要求,则会提示“请使双脚触地,受力均匀,稍微往内挪放”;如C4 未达要求,则会提示“请使用拐杖”。
[0012] 优选地,所述传感器包括左腿髋部电机角度传感器、右腿髋部电机角度传感器、左 腿膝部电机角度传感器、右腿膝部电机角度传感器、左脚脚底压力传感器、右脚脚底压力传 感器和躯干倾角传感器;控制模块分别与左腿髋部电机角度传感器、右腿髋部电机角度传 感器、左腿膝部电机角度传感器、右腿膝部电机角度传感器、左脚脚底压力传感器、右脚脚 底压力传感器和躯干倾角传感器连接;所述控制模块还分别与左腿髋部电机、右腿髋部电 机、左腿膝部电机和右腿膝部电机连接。
[0013] 优选地,所述康复装置的躯干支架绑定在用户上身;大腿支架绑定在用户大腿上, 小腿支架绑定在用户小腿上;脚部支撑板设置在用户脚底;躯干支架与大腿支架通过髋部 电机连接;髋部电机的定子与躯干支架固定,髋部电机的转子与大腿支架固定;大腿支架与 小腿支架分别膝部电机的定子和转子连接;膝部电机连接着大腿支架与小腿支架并控制两 者相对角度运动;小腿支架与脚部支撑板活动连接。
[0014] 优选地,所述a0取值为30°/s2;所述V0取值为20°/s;所述al取值为65°/s2;所述vl 取值为25°/S()V〇为站立阶段一的髋部电机转速,aO为阶段一开始时加速以及结束时减速的 加速度绝对值,加速时加速度为a0,减速时加速度为_aO;vl为站立阶段二的髋、膝部电机转 速,al为阶段二开始时加速以及结束时减速的加速度绝对值,加速时加速度为al,减速时加 速度为_al。
[0015]相对于现有技术,本发明具有如下优点:
[0016] 1)触发方式双保险。若用户未通过腕表上的按钮操作选择“站立”模式,则其身体 动作不会触发外骨骼机械腿装置的站立动作;用户通过按钮操作选择“站立”模式后,腕表 中的无线射频模块与控制模块进行通信,通知后者用户选择了“站立”模式,后者随即根据 传感器组采集的数据,开始实时判别用户身体姿态是否满足触发条件。一旦控制模块检测 到用户身体姿态动作满足触发条件,则向电机组发出相应指令,控制电机组转动完成相应 动作,触发“站立”。用户须既通过腕表的按钮选择了 “站立”模式,同时身体姿态又满足了一 定触发条件,才会触发机械腿“站立”。这样即可避免单一触发方式的误触发风险,提高安全 系数。
[0017] 2)用户使用安全。控制模块通过传感器组对用户身体姿态的数据(包括躯干倾角、 脚底压力等)进行实时监控和分析,判断上述数据是否超出正常范围。当用户出现重心不稳 或摔倒等突发情况,控制模块会检测到上述数据超出正常范围,这时将立即采取应对措施, 确保用户安全。譬如,重心不稳时会控制机械腿停止动作或坐回座位上,摔倒时会通过语音 模块发出警报求助。
[0018] 3)本发明可以帮助患者初期进行站立训练,这样可以增强关节活动度和肌肉力, 同时也有利于逐步提高患者对外骨骼的适应性,为后期的行走动作打好基础。
附图说明
[0019] 图1是可穿戴仿生外骨骼机械腿康复装置的整体结构示意图;
[0020] 图2是图1中控制模块与相关部件的连接示意图;
[0021] 图3 (a)是从右前方观察的支架角度示意图;
[0022]图3⑹是从右方观察的支架角度示意图;
[0023]图4 (a)是从右方观察的躯干前倾角示意图;
[0024]图4⑹是从右方观察的躯干后倾角示意图;
[0025]图4 (c)是从前方观察的躯干左倾角与右倾角示意图;
[0026]图5是用户从坐姿向站姿变换的动作图解;
[0027]图6是康复装置从坐姿向站姿变换的控制流程图。
[0028]图中示出:躯千支架1、大腿支架2、小腿支架3、髋部电机4、髋部电机角度传感器5、 膝部电机6、膝部电机角度传感器7、脚底压力传感器8、躯干倾角传感器9、绑带10、控制模块 11、腕表12、拐杖13、触地压力传感器14、脚部支撑板15、左腿髋部电机角度传感器5_1、右腿 髋部电机角度传感器5_2、左腿膝部电机角度传感器乙1、右腿膝部电机角度传感器7_2、左 脚脚底压力传感器8_1、右脚脚底压力传感器8_2、左拐杖触地压力传感器14_1、右拐杖触地 压力传感器14_2、左腿髋部电机4_1、右腿髋部电机4_2、左腿膝部电机6_1和右腿膝部电机 6_2〇
[0029]具体实现方式
[0030]为更好地理解本发明,下面结合附图对本发明作进一步的说明,但实施方式不构 成对本发明保护范围的限定。
[0031]图1是可穿戴仿生外骨骼机械腿康复装置的整体机械结构示意图。如图1所示,外 骨骼机械腿康复装置主要包括躯千支架1、大腿支架2、小腿支架3、髋部电机4、髋部电机角 度传感器5、膝部电机6、膝部电机角度传感器7、脚底压力传感器8、躯干倾角传感器9、绑带 10、控制模块11、腕表12、拐杖13、触地压力传感器14、脚部支撑板15、语音提示模块16;其 中,髋部电机4包括左腿髋部电机4_1和右腿髋部电机4_2;髋部电机角度传感器5包括左腿 髋部电机角度传感器5_1和右腿髋部电机角度传感器5_2;膝部电机6包括左腿膝部电机6_1 和右腿膝部电机6_2;膝部电机角度传感器7包括左腿膝部电机角度传感器乙1和右腿膝部 电机角度传感器7_2;脚底压力传感器8包括左脚脚底压力传感器8 j和右脚脚底压力传感 器8_2;触地压力传感器14包括左拐杖触地压力传感器14_1和右拐杖触地压力传感器14_2; 拐杖13有两根,分别通过用户的左右手握住。控制模块11设置在用户的背部。
[0032]躯千支架1绑定在用户上身;大腿支架2绑定在用户大腿上,小腿支架3绑定在用户 小腿上;脚部支撑板15设置在用户脚底;所述的绑定通过绑带1〇绑定;躯干支架1与大腿支 架2通过髋部电机4连接;髋部电机4的定子与躯干支架1固定,髋部电机4的转子与大腿支架 2固定;当髋部电机4转动时,固定在定子上的躯干支架1与固定在转子上的大腿支架2被转 动的电机带动并产生相对角度运动;髋部电机4控制两者相对角度运动;大腿支架2与小腿 支架3分别膝部电机6的定子和转子连接;膝部电机6连接着大腿支架2与小腿支架3并控制 两者相对角度运动;小腿支架3与脚部支撑板15活动连接。
[0033] 左腿髋部电机角度传感器5_1和右腿髋部电机角度传感器5_2分别设置在左腿髋 部电机4 j和右腿髋部电机4_2上;左腿膝部电机角度传感器乙1和右腿膝部电机角度传感 器7_2分别设置左腿膝部电机6_1和右腿膝部电机6_上;左脚脚底压力传感器8 j和右脚脚 底压力传感器8_2分别设置在左右两脚部支撑板15上;左拐杖触地压力传感器14 j和右拐 杖触地压力传感器14_2分别设置在左右两拐杖13下端。躯干倾斜传感器9安装在躯干支架1 上。
[0034] 如图2所示,控制模块11分别与左腿髋部电机角度传感器5_1、右腿髋部电机角度 传感器5_2、左腿膝部电机角度传感器7_1、右腿膝部电机角度传感器7_2、左脚脚底压力传 感器8_1、右脚脚底压力传感器8_2、躯干倾斜传感器9、左拐杖触地压力传感器14_1、右拐杖 触地压力传感器14_2、腕表12连接、左腿髋部电机4_1、右腿髋部电机4_2、左腿膝部电机6 j 和右腿膝部电机6_2连接。另外,腕表12用来手动选择运动模式;躯干倾角传感器9检测用户 躯干的倾斜角度;膝部电机角度传感器7用以检测膝部电机转角的转角;髋部电机角度传感 器5用以检测髋部电机转角;脚底压力传感器8检测脚底所受压力大小;拐杖13用于站立和 坐下时支撑身体,行走时保持平衡等;触地压力传感器14检测拐杖13所受压力大小。
[0035] 控制模块11可选用Freescale公司的i .MX 6系列应用处理器,与髋部电机4和膝部 电机6的通信采用USB进行,与各种传感器的通信采用CAN进行,与腕表的通信采用无线射频 进行。
[0036] 腕表12主要由无线射频模块和按钮组成,无线射频模块用于与控制模块11通信, 按钮用于选择“站立”、“坐下”和“行走”运动模式。若用户未通过按钮操作选择“站立”模式, 则其身体动作不触发外骨骼机械腿装置的站立动作;用户通过按钮操作选择“站立”模式 后,腕表12中的无线射频模块与控制模块11进行通信,通知后者用户选择了 “站立”模式,后 者随即根据传感器组采集的数据,开始实时判别用户身体姿态是否满足触发条件。一旦控 制模块11检测到用户身体姿态动作满足触发条件,则向电机组发出相应指令,控制电机组 转动完成相应动作,触发“站立”。
[0037] 本发明用到参数的简略符号及其含义定义如下:Z膝为膝关节角度,即大腿支架2 与小腿支架3构成的角度,其示意图见附图3 (a)与附图3⑹箭头所指的Z膝;Z髓为髋关节角 度,即躯干支架1与大腿支架2构成的角度,其示意图见附图3 (a)与附图3(b)箭头所指的 Z髓。用户不可通过施力改变Z膝和ZtS。这是因为开启机械腿电源后,膝部电机与髋部电机 均被锁定,用户施力不可使其转动,只有当控制模块11对电机发送触发指令时方可使其转 动。
[0038] Z前后为以躯干垂直地面为基准,躯千前后倾斜的角度,前倾为正,后倾为负,其示 意图分别见附图4 (a)与附图4⑹;为以躯干垂直地面为基准,躯干左右倾斜的角度,其 示意图见附图4 (c),左倾为正,右倾为负。用户可通过拐杖辅助改变/前后和
[0039] G为用户体重;Fc为左右拐杖触地端所受总压力(去除拐杖自身重力);FP为左右脚 底总压力;Fa为左脚单独压力;FPR为右脚单独压力。用户可通过拐杖辅助改变FC、FPL和Fpr。 [0040] vO为站立阶段一的髋部电机转速,a〇为阶段一开始时加速以及结束时减速的加速 度绝对值,加速时加速度为aO,减速时加速度为_a0; vl为站立阶段二的髋、膝部电机转速, al为阶段二开始时加速以及结束时减速的加速度绝对值,加速时加速度为al,减速时加速 度为-al。
[0041]图5是用户从坐状态向平行站立状态变换的动作图解,如图5所示,用户先通过腕 表选择“站立”运动模式,再调整身体姿态触发“站立”。用户从姿态1 (触发状态)开始:双脚 触地并稍微往内挪放,拐杖触地并向上向前支撑身体,使躯干前倾。然后用户经过站立阶段 一(髋部电机角度减小,膝部电机角度基本不变),实现姿态2 (中间态一)。最后经过站立阶 段二(膝部电机和髋部电机角度同时增大),依序实现姿态3 (中间态二)以及姿态4 (结束态/ 平行站立姿态)。
[0042]下面对各个姿态的参数作出规定,各数值均为经验值:
[0043] 姿态 1: Z髋=90。(±1。),Z膝=80。(±1。); Z前g=+5。〜+15°,Zfc&=-5。〜+5°;Fp +Fc= (10%〜30%)G,|Fpl-Fpr|/Fp = 0〜10%;Fc= (5%〜25%)G。
[0044] 姿态2: Z髋=80。(± 1。),Z膝=80。(± 1。); Z前后= + 10。〜+25。,Z姑=- 7.5。〜+ 7.5°;Fp+Fc= (15%〜35%)G,|Fpl-Fpr|/Fp = 0〜20%;FC= (5%〜30%)G。
[0045] 姿态3: Z髋=120。(± 1。),Z膝=120。(± 1。); Z前后=+10。〜+20。,Z*e=-7.5。〜+ 7.5°;Fp+Fc二(90%〜100%)G,|FpL-FpR|/Fpr=0〜20%;Fc= (5%〜55%)G。
[0046] 姿态4:/髋=170。(±1。),/膝=170。(±1。);/前后=-2.5。〜+7.5。,/姑=-7.5° 〜+7_5〇;Fp+Fc= (90%〜100%)G,|Fpl-Fpr|/Fp = 0〜20%;Fc= (5%〜55%)G〇
[0047]为了满足触发条件,用户需要调整身体动作姿态来上述参数数值,譬如使用拐杖 向上向前支撑身体,改变躯干前后倾角Z前后和拐杖触地压力Fc,或左右倾侧身体,改变躯干 左右倾角和脚底压力值Fpl和Fpr。
[0048]本发明提供的一种可穿戴仿生外骨骼机械腿康复装置的站立模式控制方法。所述 模式控制可以帮助患者初期进行站立训练,这样可以增强关节活动度和肌肉力,同时也有 利于逐步提高患者对外骨骼机械腿康复装置的适应性,为后期的行走动作打好基础。
[0049] 本发明站立过程基于如下假设:
[0050] 1.椅子高度略低于用户小腿垂直于地面时膝盖的高度。
[0051] 2 •站立过程的v0、vl、a0、al以及各姿态的Zf|、Z膝、Z前后、Z*&、F(;、Fpl和Fpr等参数 的数值在日常使用前需由用户通过亲身试验测得,并通过将控制模块11连接至PC再使用配 套界面式软件进行设置。试验的做法为先将上述参数的值设置为经验值,进行站立,然后根 据站立过程中用户的表现对参数进行多次微调,直至得出最佳的参数组合。
[0052]图6是装置从坐姿向站姿变换的控制流程图。如图6所示,可穿戴仿生外骨骼机械 腿康复装置的站立模式控制方法包括如下步骤:
[0053] 1)用户用腕表I2选择“站立”的运动模式,控制模块11通过采集到的信号来判断用 户姿态是否同时满足条件C1、C2、C3和C4;其中C1为Z膝=80° (±1°),Z髋=9〇° (±1°),C2为 Z前后=+5。〜+15。,/姑=-5。〜+5。,C3为Fp+Fc= (10% 〜30%) G,|Fpl-Fpr | /FP = 0〜10%, C4为Fc= (5%〜25%)G。各个条件的含义为:Cl:正常坐姿时膝关节约为8〇°,髋关节约为 90° ;C2:用拐杖向上向前支撑身体,使上半身稍微向前倾,并且身体没有过于向左或向右倾 侧;C3:双脚触地,受力均句,稍微往内挪放;C4:正在使用拐杖支撑身体。
[0054] 2)步骤1)四个条件同时满足即称为“触发状态”。用户不满足“触发状态”,有以下 两种情况:①控制模块11检测到C1未达要求(正常情况下电源开启后膝部电机与髋部电机 锁定,膝部角度Z膝=80° (±1°),髋部角度Z髋=90° (±1°)),则通过语音模块16提示用户 “目前存在故障不宜站立”,然后尝试自动恢复,若自动恢复不成功则需要请求维护人员进 行修复,直到C1满足,才可再次进行站立;②控制模块11检测到C2、C3或C4未达要求,则通过 语音模块16对用户进行语音提示,直至用户满足“触发状态”,此时用户可根据语音提示中 的操作指引来调整身体姿态。如C2未达要求,则会提示“请使用拐杖向上向前支撑身体,使 上半身稍微向前倾斜,并尽量避免向左或向右倾侧身体”;如C3未达要求,则会提示“请使双 脚触地,受力均匀,稍微往内挪放”;如C4未达要求,则会提示“请使用拐杖”。
[0055] 3)当满足“触发状态”时,控制模块11即向髋部电机4和膝部电机6发出指令触发其 转动,实现站立动作。站立动作分两个阶段,分别如下。阶段一:膝部电机6不转动,髋部电机 4开始以加速度a0 = 30°/s2从静止匀加速至速度V〇 = 20°/s,然后以恒定速度vO转动,躯干 支架1与大腿支架2之间角度ZsM小,带动用户躯干与大腿产生相对角度运动,直至控制模 块11检测到将要达到ZtS=80°,控制髋部电机以加速度-aO二_20°/s2匀减速至静止,实现 姿态2。阶段二:髋部电机4、膝部电机6开始同时以加速度al=65°/s2从静止匀加速至速度 vl = 25°/S,然后以恒定速度vl转动。躯干支架1与大腿支架2之间角度Z髓增大,带动用户躯 干与大腿产生相对角度运动;同时,大腿支架2与小腿支架3之间角度Z膝增大,带动用户大 腿与小腿产生相对角度运动。经过姿态3,直至控制模块11检测到将要达到Z髋=170°,/膝 = 170°,控制模块控制髋部电机、膝部电机同时以加速度-al = -65°/s2勾减速至静止,最终 实现姿态4 (即站立结束态/平行站立状态)。
[0056]站立过程中,控制模块11在上述步骤3)中除了会实时检测电机角度,判断其是否 达到阈值以停止电机转动之外,同时还会持续监控脚底压力值,躯干倾角值以及电机转角 值,判断其是否在正常范围内。以下是站立过程中各姿态之间转换时参数的正常范围:
[0057] 姿态 1—>姿态2:Z髋=80。〜90。(±1。),Z膝=80。(±1。)前后=+5。〜+25。,/站 = -7.5。〜+7.5%Fp+Fc= (10%〜35%)G,|Fpl_Fpr|/Fp = 0〜20%;Fc= (5%〜30%)G。
[0058] 姿态2—>姿态3: Z髋=80。〜120。(±1。),Z膝=80。〜120。(±1。)前后=+10。〜+ 25%Z*6=-7.5°〜+7.5°;Fp+Fc=(15%〜100%)G,|FPl-Fpr|/Fp = 0〜20%;Fc=(5%〜 55%)G。
[0059] 姿态3—>姿态4: Z髓=120。〜170。(±1。),Z膝=120。〜170。(±1。); Z前后=-2.5。 〜+20°,Zfc6=-7.5°〜+7.5°;FP+Fc=(90%〜100%)G,|FpL-FPR|/FP = 0〜20%;Fc=(5%〜 55%)G〇
[0060] 如果压力值、躯干倾角值或电机转角值等参数超出上述正常范围达到ls,即判别 为“异常状态”,控制模块11将对用户执行保护措施,直至收到进一步的指令以解除“异常状 态”。这些保护措施包括但不限于:用户重心不稳时,控制电机停止转动,或反向转动使用户 重新变回坐姿;用户摔倒时,控制语音模块16发出警报以请求他人救援。
[0061] 上述站立控制方法有如下优点:1、触发方式双保险(腕表按键操作+传感器组检测 用户身体姿态)。若用户未通过腕表12上的按钮操作选择“站立”模式,则其身体动作不会触 发外骨骼机械腿装置的站立动作;用户通过按钮操作选择“站立”模式后,腕表12中的无线 射频模块与控制模块11进行通信,通知后者用户选择了 “站立,,模式,后者随即根据传感器 组采集的数据,开始实时判别用户身体姿态是否满足触发条件。一旦控制模块i i检测到用 户身体姿态动作满足触发条件,则向电机组发出相应指令,控制电机组转动完成相应动作, 触发“站立”。也就是说,用户必须既通过腕表12的按钮选择了 “站立”模式,同时身体姿态又 满足了 一定触发条件,才会触发机械腿“站立”。这样即可避免单一触发方式的误触发风险, 提高安全系数。2、控制模块11通过传感器组对用户身体姿态的数据(包括躯干倾角、脚底压 力等)进行实时监控和分析,判断上述数据是否超出正常范围。当用户出现重心不稳或摔倒 等突发情况,控制模块11会检测到上述数据超出正常范围,这时将立即采取应对措施,确保 用户安全。譬如,重心不稳时会控制机械腿停止动作或坐回座位上,摔倒时会通过语音模块 16发出警报求助。
[0062]上述实施方式仅用于说明本发明,而并非对本发明的限制,有关技术领域的普通 技术人员,在不脱离本发明的精神和范围的情况下,还可以做出各种变化和变型,因此所有 等同的技术方案也属于本发明的范畴,本发明的保护范围应由权利要求限定。
Claims (6)
1. 可穿戴仿生外骨骼机械腿康复装置的站立模式控制方法,其特征在于包括如下步 骤: 1) 站立触发条件判断:控制模块分析处理传感器采集到的数据,判断是否同时满足以 下条件:C1: Z膝=80。± 1。,Z髓二90。± 1。,C2: Z前后=+5。〜+15。,Z姑=-5。〜+5。,C3:Fp+Fc =(10%〜30%)G,|Fpl-Fpr|/Fp = 0〜10%,C4:Fc= (5%〜25%)G;若同时满足条件C1、C2、 C3和C4,则满足站立触发条件;若未满足条件Cl,控制模块将尝试自动恢复,如自动恢复不 成功则需要请求维护人员进行修复;若未满足条件C2、C3或C4,则通过语音模块引导用户调 整姿态以满足上述条件,并持续检测传感器数据,直至用户姿态满足触发条件; 2) 触发站立动作:若控制模块检测到用户满足站立的触发条件,控制模块随即向髋部 电机和膝部电机发出指令,膝部电机不转动,髋部电机开始以加速度a0从静止匀加速至速 度vO,并以速度v〇匀速转动,/體减小,带动用户躯干与大腿产生相对角度运动,直至控制模 块检测到将要达到2髓=80°,控制髋部电机以加速度-aO匀减速至静止;然后髋部电机、膝 部电机同时以加速度al从静止匀加速至速度vl,并以速度vl匀速转动;Z體增大,带动用户 躯干与大腿产生相对角度运动;同时,Z膝增大,带动用户大腿与小腿产生相对角度运动,直 至控制模块检测到将要达到ZtS=17〇°,Z膝=170°,控制模块控制髋部电机、膝部电机同时 以加速度_ al匀减速至静止,实现平行站立状态; 所述Z髓为躯干支架与大腿支架之间角度;所述Z膝为大腿支架与小腿支架之间角度; 所述Z前后为以躯干垂直地面为基准,躯干前后倾斜的角度,前倾为正,后倾为负;为以 躯干垂直地面为基准,躯干左右倾斜的角度,左倾为正,右倾为负;G为用户体重;Fc为去除 拐杖自身重力后,左右拐杖触地端所受总压力;FP为左右脚底总压力;Fpl为左脚单独压力; Fpr为右脚单独压力。
2. 根据权利要求1所述的可穿戴仿生外骨骼机械腿康复装置的站立模式控制方法,其 特征在于,所述控制模块对传感器采集到的数据的分析处理是在用户使用腕表选择“站立” 运动模式后进行。
3. 根据权利要求2所述的可穿戴仿生外骨骼机械腿康复装置的站立模式控制方法,其 特征在于,正常情况下电源开启后膝部电机与髋部电机锁定,当用户使用腕表选择了“站 立”运动模式后,身体姿态不满足站立触发条件具体有以下两种情况:①控制模块检测到C1 未达要求,则通过语音模块提示用户“目前存在故障不宜站立”,然后尝试自动恢复,若自动 恢复不成功则需要请求维护人员进行修复,直到C1满足,才可再次进行站立;②控制模块检 测到C2、C3或C4未达要求,则向语音模块发出消息,后者提醒用户调整姿态,直至控制模块 检测到用户满足站立触发条件;用户根据语音提示中的具体操作指引调整身体姿态;如C2 未达要求,则会提示“请使用拐杖向上向前支撑身体,使上半身稍微向前倾斜,并尽量避免 向左或向右倾侧身体”;如C3未达要求,则会提示“请使双脚触地,受力均匀,稍微往内挪 放”;如C4未达要求,则会提示“请使用拐杖”。
4. 根据权利要求1所述的可穿戴仿生外骨骼机械腿康复装置的站立模式控制方法,其 特征在于,所述传感器包括左腿髋部电机角度传感器、右腿髋部电机角度传感器、左腿膝部 电机角度传感器、右腿膝部电机角度传感器、左脚脚底压力传感器、右脚脚底压力传感器和 躯干倾角传感器;控制模块分别与左腿髋部电机角度传感器、右腿髋部电机角度传感器、左 腿膝部电机角度传感器、右腿膝部电机角度传感器、左脚脚底压力传感器、右脚脚底压力传 感器和躯干倾角传感器连接;所述控制模块还分别与左腿髋部电机、右腿髋部电机、左腿膝 部电机和右腿膝部电机连接。
5. 根据权利要求1所述的可穿戴仿生外骨骼机械腿康复装置的站立模式控制方法,其 特征在于,所述康复装置的躯干支架绑定在用户上身;大腿支架绑定在用户大腿上,小腿支 架绑定在用户小腿上;脚部支撑板设置在用户脚底;躯干支架与大腿支架通过髋部电机连 接;髋部电机的定子与躯干支架固定,髋部电机的转子与大腿支架固定;大腿支架与小腿支 架分别膝部电机的定子和转子连接;膝部电机连接着大腿支架与小腿支架并控制两者相对 角度运动;小腿支架与脚部支撑板活动连接。
6. 根据权利要求1所述的可穿戴仿生外骨骼机械腿康复装置的站立模式控制方法,其 特征在于,所述aO取值为3〇7s2;所述v〇取值为2〇7s;所述al取值为657s2;所述vl取值为 25°/s〇
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510765556.4A CN105455819B (zh) | 2015-11-10 | 2015-11-10 | 可穿戴仿生外骨骼机械腿康复装置的站立模式控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510765556.4A CN105455819B (zh) | 2015-11-10 | 2015-11-10 | 可穿戴仿生外骨骼机械腿康复装置的站立模式控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105455819A CN105455819A (zh) | 2016-04-06 |
CN105455819B true CN105455819B (zh) | 2018-10-09 |
Family
ID=55594332
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510765556.4A Active CN105455819B (zh) | 2015-11-10 | 2015-11-10 | 可穿戴仿生外骨骼机械腿康复装置的站立模式控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105455819B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP6775151B2 (ja) * | 2016-09-02 | 2020-10-28 | パナソニックIpマネジメント株式会社 | 起立動作支援装置、起立動作支援方法およびプログラム |
CN111604890B (zh) * | 2019-12-30 | 2021-05-25 | 合肥工业大学 | 一种适用于外骨骼机器人的运动控制方法 |
CN111281738A (zh) * | 2020-01-20 | 2020-06-16 | 深圳市丞辉威世智能科技有限公司 | 动作状态转换方法、装置、设备及可读存储介质 |
CN111297530A (zh) * | 2020-01-20 | 2020-06-19 | 深圳市丞辉威世智能科技有限公司 | 肢体辅助训练方法、设备、控制终端及可读存储介质 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103200909A (zh) * | 2010-09-27 | 2013-07-10 | 范德比尔特大学 | 行动辅助设备 |
CN103932868A (zh) * | 2014-04-21 | 2014-07-23 | 清华大学 | 一种截瘫助行动力外骨骼的控制方法 |
CN104302251A (zh) * | 2012-03-22 | 2015-01-21 | 埃克苏仿生公司 | 用于下肢体矫正器的人机界面 |
CN104434432A (zh) * | 2013-09-20 | 2015-03-25 | 株式会社东芝 | 起立辅助装置和方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR20120071555A (ko) * | 2010-12-23 | 2012-07-03 | 한국전자통신연구원 | 재활 로봇 제어 장치 |
-
2015
- 2015-11-10 CN CN201510765556.4A patent/CN105455819B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103200909A (zh) * | 2010-09-27 | 2013-07-10 | 范德比尔特大学 | 行动辅助设备 |
CN104302251A (zh) * | 2012-03-22 | 2015-01-21 | 埃克苏仿生公司 | 用于下肢体矫正器的人机界面 |
CN104434432A (zh) * | 2013-09-20 | 2015-03-25 | 株式会社东芝 | 起立辅助装置和方法 |
CN103932868A (zh) * | 2014-04-21 | 2014-07-23 | 清华大学 | 一种截瘫助行动力外骨骼的控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN105455819A (zh) | 2016-04-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105455819B (zh) | 可穿戴仿生外骨骼机械腿康复装置的站立模式控制方法 | |
CN105456000B (zh) | 一种可穿戴仿生外骨骼机械腿康复装置的行走控制方法 | |
CN105326627B (zh) | 基于躯干重心偏移的康复装置行走触发控制方法 | |
CN105411813A (zh) | 一种可穿戴仿生外骨骼机械腿康复装置 | |
CN106137489B (zh) | 交互式外骨骼膝关节机器系统 | |
KR100795195B1 (ko) | 편마비 환자의 보행훈련기구 | |
JP4487054B2 (ja) | 下肢機能訓練装置 | |
US8348875B2 (en) | Locomotion assisting device and method | |
CN109199800B (zh) | 康复机器人及其摔倒检测与防护方法 | |
JP2011115323A (ja) | 歩行介助ロボット | |
CN109758342A (zh) | 外骨骼机器人及其控制方法 | |
CN104398347A (zh) | 一种新型轮椅式电动步行训练装置及控制方法 | |
CN105326625B (zh) | 可穿戴仿生外骨骼机械腿康复装置的坐下模式控制方法 | |
CN106511031B (zh) | 一种下肢多功能辅助康复仪 | |
CN105342808B (zh) | 基于脚部压力传感器的康复装置的行走触发控制方法 | |
CN207950125U (zh) | 助行走康复训练器 | |
CN110368266A (zh) | 二自由度悬吊式姿势矫正减重步行训练器 | |
CN205586203U (zh) | 可穿戴仿生外骨骼机械腿康复装置 | |
CN107811820A (zh) | 一种引导下肢外骨骼助力机器人行走的智能拐杖 | |
CN110681121B (zh) | 一种骨科髋关节活动度锻炼用助行器 | |
CN110840712A (zh) | 一种基于人机交互的下肢康复机器人系统 | |
CN105287164B (zh) | 一种基于躯干晃动的康复装置行走速度控制方法 | |
CN110123587A (zh) | 一种腿部康复器械及单腿辅助训练装置 | |
Tuite et al. | Design of Individual Balance Control Device Utilized during the Sit-to-Stand Task | |
CN215916380U (zh) | 一种腿部快速康复系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
C06 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
C10 | Entry into substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |