CN105342808A - 基于脚部压力传感器的康复装置的行走触发控制方法 - Google Patents
基于脚部压力传感器的康复装置的行走触发控制方法 Download PDFInfo
- Publication number
- CN105342808A CN105342808A CN201510834977.8A CN201510834977A CN105342808A CN 105342808 A CN105342808 A CN 105342808A CN 201510834977 A CN201510834977 A CN 201510834977A CN 105342808 A CN105342808 A CN 105342808A
- Authority
- CN
- China
- Prior art keywords
- motor
- hip
- user
- lower limb
- trunk
- 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.)
- Granted
Links
Classifications
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H1/00—Apparatus for passive exercising; Vibrating apparatus ; Chiropractic devices, e.g. body impacting devices, external devices for briefly extending or aligning unbroken bones
- A61H1/02—Stretching or bending or torsioning apparatus for exercising
- A61H1/0237—Stretching or bending or torsioning apparatus for exercising for the lower limbs
- A61H1/0255—Both knee and hip of a patient, e.g. in supine or sitting position, the feet being moved in a plane substantially parallel to the body-symmetrical-plane
- A61H1/0262—Walking movement; Appliances for aiding disabled persons to walk
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H3/00—Appliances for aiding patients or disabled persons to walk about
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H3/00—Appliances for aiding patients or disabled persons to walk about
- A61H2003/005—Appliances for aiding patients or disabled persons to walk about with knee, leg or stump rests
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H3/00—Appliances for aiding patients or disabled persons to walk about
- A61H2003/007—Appliances for aiding patients or disabled persons to walk about secured to the patient, e.g. with belts
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
- A61H2201/16—Physical interface with patient
- A61H2201/1602—Physical interface with patient kind of interface, e.g. head rest, knee support or lumbar support
- A61H2201/164—Feet or leg, e.g. pedal
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
- A61H2201/16—Physical interface with patient
- A61H2201/1602—Physical interface with patient kind of interface, e.g. head rest, knee support or lumbar support
- A61H2201/165—Wearable interfaces
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
- A61H2201/50—Control means thereof
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
- A61H2201/50—Control means thereof
- A61H2201/5058—Sensors or detectors
- A61H2201/5069—Angle sensors
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
- A61H2201/50—Control means thereof
- A61H2201/5058—Sensors or detectors
- A61H2201/5071—Pressure sensors
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H2205/00—Devices for specific parts of the body
- A61H2205/10—Leg
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H2230/00—Measuring physical parameters of the user
- A61H2230/62—Posture
- A61H2230/625—Posture used as a control parameter for the apparatus
Abstract
本发明公开了基于脚部压力传感器的康复装置的行走触发控制方法,包括1)平行站立姿态的判断;2)行走触发条件的判断:控制模块分析处理传感器采集到的数据,判断是否同时满足条件C5、C6、C8,则满足先迈右腿的触发条件;若同时满足条件C5、C7、C9,则满足先迈左腿的触发条件;3)行走触发控制;4)控制模块继续检测判断躯干倾角、脚底压力和拐杖压力传感器的数据,进入步态维持状态;本发明在行走触发控制中,采用躯干倾角传感器,电机转角传感器,脚底压力传感器和拐杖触地压力传感器等多个传感器协同配合,实时检测用户的姿态,实现用户从平行站立状态到行走状态的转换。
Description
技术领域
本发明涉及一种康复装置的行走触发控制方法,特别是涉及一种基于脚部压力传感器的可穿戴仿生外骨骼机械腿康复装置的行走触发控制方法,属于康复工程技术领域。
背景技术
近年来,由于经济技术的快速发展,交通运输工具越来越多,据相关调查数据显示,中国的交通事故率是发达国家的8倍,因交通事故而造成神经中枢损伤或者肢体损伤的人数一直呈上升趋势。同时,随着人民生活水平的提高,目前患心脑血管疾病或神经系统疾病的人越来越多,而且在年龄上也呈现年轻化趋势,这类患者多数伴有偏瘫症状。对完全瘫痪的患者而言,纯粹的药物治疗和手术治疗无法使患者彻底康复,因此,需要借助康复工程的手段去改善或代替瘫痪病人失去的功能。可穿戴仿生外骨骼机械腿康复装置,穿戴在使用者下肢及腰背部,为操作者提供诸如助力、保护、身体支撑等功能,同时又融合了传感、控制、信息获取、移动计算等机器人技术,使得该康复装置能在用户的控制下完成一定的功能和任务,是典型人机一体化系统。这种行走助力装置可以减少截瘫病人长期卧床或者坐轮椅引起的压疮和肌肉萎缩等疾病,帮助他们站立和行走,提高其生活质量,并减轻患者家庭和社会的经济负担,研究开发更符合用户体验的更安全可靠的可穿戴式康复机器人外骨骼助力装置具有十分重要的实际意义。
发明内容
本发明提供了一种基于脚部压力传感器的可穿戴仿生外骨骼机械腿康复装置的行走触发控制方法,使其从平行站立姿态向持续行走姿态转换。
本发明目的通过如下技术方案实现:
基于脚部压力传感器的康复装置的行走触发控制方法,包括如下步骤:
1)平行站立姿态的判断:控制模块分析处理传感器采集到的数据,判断是否同时满足以下4个条件:C1:C3:|Fpl‐Fpr|/Fp<10%;C4:FC>0,|FCl‐Fcr|/FC<5%;若控制模块检测到传感器数据同时满足条件C1、C2、C3、C4,则用户处于平行站立姿态;若不满足上述4个条件中的任一条件,则不是平行站立姿态;
2)行走触发条件的判断:控制模块分析处理传感器采集到的数据,判断是否满足以下条件:C5:C6:FPl>>FPr或C7:FPl<<FPr;C8:FC>0,FCl>Fcr或C9:FC>0,FCl<Fcr;若同时满足条件C5、C6、C8,则满足先迈右腿的触发条件;若同时满足条件C5、C7、C9,则满足先迈左腿的触发条件;若未同时满足条件C5、C6、C8或未同时满足条件C5、C7、C9,控制模块持续检测传感器数据,判断用户姿态;
3)行走触发控制:若控制模块检测到用户满足迈右腿的触发条件,控制模块向右髋电机和右膝电机发出指令,执行迈右腿动作:髋部电机开始以加速度a0从静止匀加速至速度v0,然后以速度v0转动,带动用户躯干与大腿产生相对角度运动,使躯干支架与大腿支架之间角度∠右髋减小;同时膝部电机开始以加速度a1从静止匀加速至速度v1,然后以速度v1转动,带动大腿与小腿产生相对角度运动,使大腿支架与小腿支架之间的角度∠右膝减小,直至控制模块检测到控制膝部电机以加速度-a1匀减速至静止;髋部电机持续转动,直至控制模块检测到控制膝部电机反向转动,以加速度a1匀加速至速度至v1,然后以速度v1转动,带动大腿与小腿产生相对角度运动,使大腿支架与小腿支架之间的角度∠右膝增大;控制模块持续检测∠右髋,直至检测到控制髋部电机以加速度-a0匀减速至静止;膝部电机持续以速度v1转动,直至控制模块检测到控制膝部电机以加速度-a1匀减速至静止,迈步动作结束,用户进入右脚前左脚后姿态;
若控制模块检测到用户满足迈左腿的触发条件,控制模块向左髋电机和左膝电机发出指令,执行迈左腿动作,直至动作结束,进入左脚前右脚后状态;执行迈左腿动作与迈右腿动作相同为左右腿互换,控制方式相同;
4)控制模块继续检测判断躯干倾角、脚底压力和拐杖压力传感器的数据,进入步态维持状态;
所述∠前后为躯干前后倾角;所述∠左右为躯干左右倾角;FPl为左脚单独压力;FPr为右脚单独压力;FCl为左拐杖压力;FCr.为右拐杖压力;FC为去除拐杖自身重力后的两拐杖压力和;∠膝为大腿支架与小腿支架之间的夹角;∠髋为大腿支架与躯干支架之间的夹角;∠左膝为左膝关节角度;∠右膝为右膝关节角度;∠左髋为左髋关节角度;∠右髋为右髋关节角度。
为进一步实现本发明目的,优选地,所述∠前后为以躯干垂直地面为基准,躯干前后倾斜的角度,前倾为正,后倾为负。所述∠左右为以躯干垂直地面为基准,躯干左右倾斜的角度;左倾为正,右倾为负。
优选地,若初始状态不满足平行站立姿态的条件,控制中心向语音模块发出消息,提醒用户调整姿态,直至检测到用户为平行站立姿态;用户根据语音提示中的具体操作指引调整身体姿态;若条件C1未满足,语音模块提示用户“请保持躯干直立,不要向左右倾斜或向前后倾斜”;若条件C2未满足,语音模块提示用户“请保持双腿直立,调整左髋左膝或右髋右膝关节角度”;若条件C3未满足,语音模块示用户“请使双脚均匀受力”;若条件C4未满足,语音模块提示用户“请使用拐杖,并使两拐杖均匀受力”。
a0为髋部电机开始转动的加速度,‐a0为髋部电机结束转动的加速度,a1为膝部电机开始转动的加速度,‐a1为膝部电机结束转动的加速度,v0为髋部电机的转动速度,v1为膝部电机的转动速度,a0、a1、v0、v1的数值均由测量下肢健全者行走过程中的关节转速所得,且与可穿戴仿生外骨骼机械腿康复装置所使用的电机参数有关。优选地,所述a0的取值为a1的取值为v0的取值为v1的取值为
优选地,所述控制模块分别与左腿髋部电机角度传感器、右腿髋部电机角度传感器、左腿膝部电机角度传感器、右腿膝部电机角度传感器、左脚脚底压力传感器、右脚脚底压力传感器、左腿髋部电机、躯干倾角传感器、右腿髋部电机、左腿膝部电机和右腿膝部电机连接。
优选地,所述康复装置的躯干支架绑定在用户上身;大腿支架绑定在用户大腿上,小腿支架绑定在用户小腿上;脚部支撑板设置在用户脚底;躯干支架与大腿支架通过髋部电机连接;髋部电机的定子与躯干支架固定,髋部电机的转子与大腿支架固定;大腿支架与小腿支架分别膝部电机的定子和转子连接;膝部电机连接着大腿支架与小腿支架并控制两者相对角度运动;小腿支架与脚部支撑板活动连接。
相对于现有技术,本发明具有如下优点:
1)本发明采用了脚底压力传感器、拐杖触地压力传感器、躯干倾角传感器和电机转角传感器同时检测用户姿态数据,实现多传感器协同触发控制。当控制模块检测到每个传感器的数据均满足条件时,才对电机组发出指令,否则就提醒用户调整姿态。这种多传感器协同工作的方式,有效避免单一触发方式的误触发风险,保障了用户的安全。
2)本发明在对用户从平行站立姿态到步行姿态的转换控制的过程中,采用躯干前倾,脚底压力对比和拐杖压力对比三个判断条件,增加了触发控制的可靠性和安全性。
3)当用户重心不稳时,控制电机停止转动;当用户摔倒时,控制语音模块发出警报以请求他人救援,本发明控制方法灵活、安全。
附图说明
图1是可穿戴仿生外骨骼机械腿康复装置整体机械结构图;
图2是可穿戴仿生外骨骼机械腿康复装置核心功能模块框图;
图3(a)是从右前方观察的支架角度示意图;
图3(b)是从右方观察的支架角度示意图;
图4(a)是从右方观察的躯干前倾角示意图;
图4(b)是从右方观察的躯干后倾角示意图;
图4(c)是从前方观察的躯干左倾角与右倾角示意图;
图5是迈步动作分解图。
图6是基于脚部压力传感器的可穿戴仿生外骨骼机械腿康复装置的行走触发控制方法的流程图。
图中示出:躯干支架1、大腿支架2、小腿支架3、髋部电机4、髋部电机角度传感器5、膝部电机6、膝部电机角度传感器7、脚底压力传感器8、躯干倾角传感器9、绑带10、控制模块11、腕表12、拐杖13、触地压力传感器14、脚部支撑板15、语音模块16、左腿髋部电机角度传感器5_1、右腿髋部电机角度传感器5_2、左腿膝部电机角度传感器7_1、右腿膝部电机角度传感器7_2、左脚脚底压力传感器8_1、右脚脚底压力传感器8_2、左拐杖触地压力传感器14_1、右拐杖触地压力传感器14_2、左腿髋部电机4_1、右腿髋部电机4_2、左腿膝部电机6_1和右腿膝部电机6_2。
具体实施方式
以下结合附图对本发明做进一步的说明,但实施方式不构成对本发明保护范围的限定。
图1是可穿戴仿生外骨骼机械腿康复装置的整体机械结构示意图。如图1所示,外骨骼机械腿康复装置主要包括躯干支架1、大腿支架2、小腿支架3、髋部电机4、髋部电机角度传感器5、膝部电机6、膝部电机角度传感器7、脚底压力传感器8、躯干倾角传感器9、控制模块11、腕表12、拐杖13、触地压力传感器14、脚部支撑板15、语音提示模块16;其中,髋部电机4包括左腿髋部电机4_1和右腿髋部电机4_2;髋部电机角度传感器5包括左腿髋部电机角度传感器5_1和右腿髋部电机角度传感器5_2;膝部电机6包括左腿膝部电机6_1和右腿膝部电机6_2;膝部电机角度传感器7包括左腿膝部电机角度传感器7_1和右腿膝部电机角度传感器7_2;脚底压力传感器8包括左脚脚底压力传感器8_1和右脚脚底压力传感器8_2;触地压力传感器14包括左拐杖触地压力传感器14_1和右拐杖触地压力传感器14_2;拐杖13有两根,分别通过用户的左右手握住。控制模块11设置在用户的背部。
躯干支架1绑定在用户上身;大腿支架2绑定在用户大腿上,小腿支架3绑定在用户小腿上;脚部支撑板15设置在用户脚底;所述的绑定通过绑带10绑定;躯干支架1与大腿支架2通过髋部电机4连接;髋部电机4的定子与躯干支架1固定,髋部电机4的转子与大腿支架2固定;当髋部电机4转动时,固定在定子上的躯干支架1与固定在转子上的大腿支架2被转动的电机带动并产生相对角度运动;髋部电机4控制两者相对角度运动;大腿支架2与小腿支架3分别膝部电机6的定子和转子连接;膝部电机6连接着大腿支架2与小腿支架3并控制两者相对角度运动;小腿支架3与脚部支撑板15活动连接。
左腿髋部电机角度传感器5_1和右腿髋部电机角度传感器5_2分别设置在左腿髋部电机4_1和右腿髋部电机4_2上;左腿膝部电机角度传感器7_1和右腿膝部电机角度传感器7_2分别设置左腿膝部电机6_1和右腿膝部电机6_上;左脚脚底压力传感器8_1和右脚脚底压力传感器8_2分别设置在左右两脚部支撑板15上;左拐杖触地压力传感器14_1和右拐杖触地压力传感器14_2分别设置在左右两拐杖13下端。躯干倾斜传感器9安装在躯干支架1上。
如图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_1和右腿膝部电机6_2连接。腕表12用来手动选择运动模式;躯干倾角传感器9检测用户躯干的倾斜角度;膝部电机角度传感器7用以检测膝部电机转角的转角;髋部电机角度传感器5用以检测髋部电机转角;脚底压力传感器8检测脚底所受压力大小;拐杖13用于支撑身体,行走时保持平衡等;触地压力传感器14检测拐杖13所受压力大小。
控制模块11可选用Freescale公司的i.MX6系列应用处理器,与髋部电机4和膝部电机6的通信采用USB进行,与各种传感器的通信采用CAN进行,与腕表的通信采用无线射频进行。腕表12主要由无线射频模块和按钮组成,无线射频模块用于与控制模块11通信,按钮用于选择“站立”、“坐下”和“行走”运动模式。
为说明本方法实施的具体过程,在具体实例中作出如下定义:
1.定义躯干倾角,前、左为正,后、右为负。躯干前后倾角为∠前后,其示意图分别见附图4(a)与附图4(b),从用户的左方或右方观察,以躯干垂直地面为基准,躯干前后倾斜的角度。躯干左右倾角为∠左右,如图4(c)所示,以躯干垂直地面为基准,躯干左右倾斜的角度。用户可通过拐杖辅助改变∠前后和∠左右。
2.定义P表示脚底压力传感器,C表示拐杖触地压力传感器。脚底总压力记为FP,左脚单独压力FPl,右脚单独压力FPr。拐杖压力(已去除拐杖自身重力)记为FC,左拐杖压力FCl,右拐杖压力FCr.。
3.定义膝关节角度记为∠膝为大腿支架2与小腿支架3之间的夹角(图3(a)和图3(b)),左膝关节角度记为∠左膝,右膝关节角度记为∠右膝,结合正常行走状态,为保证用户的安全,我们限定行走过程中膝关节角度的范围为髋关节角度记为∠髋为大腿支架2与躯干支架1之间的夹角左髋关节角度记为∠左髋,右髋关节角度记为∠右髋。
4.定义行走过程中髋部电机转速为v0,a0为其开始转动的加速度,‐a0为其结束转动的加速度;膝部电机转速为v1,a1为其开始转动的加速度,‐a1为其结束转动的加速度。a0,a1,v0,v1均由测量下肢健全者行走过程中的关节转速所得,且与可穿戴仿生外骨骼机械腿康复装置所使用的电机参数有关。本实例中a0的范围为a1的范围为v0的范围为v1的范围为
5.定义用户体重为G。
6.实例中阈值均为经验值,需由用户亲身试验得出具体数值。
根据以上定义结合行走触发控制流程图6,一种仿生外骨骼机械腿康复装置的行走触发控制方法步骤如下:
1)平行站立姿态的判断。平行站立姿态的判断即控制模块11分析处理传感器采集到的数据,判断是否同时满足以下4个条件:C1:即躯干保持直立,没有向前后左右倾斜;C2:即双腿直立,髋关节和膝关节角度都约为C3:|Fpl‐Fpr|/Fp<10%,即两脚底压力近似相等;C4:FC>0,|FCl‐Fcr|/FC<5%,即正在使用拐杖且两拐杖触地且压力相等;若控制模块11检测到传感器数据满足条件C1、C2、C3、C4则用户处于平行站立姿态。若不满足上述4个条件中的任一条件,则不是平行站立姿态。为保证用户的安全,若初始状态不满足平行站立姿态的条件,控制模块11向语音模块16发出消息,提醒用户调整姿态,直至检测到用户为平行站立姿态。用户可根据语音提示中的具体操作指引调整身体姿态。若条件C1未满足,则会提示用户“请保持躯干直立,不要向左右倾斜或向前后倾斜”;若条件C2未满足,则提示用户“请保持双腿直立,调整左髋左膝或右髋右膝关节角度”。若条件C3未满足,则提示用户“请使双脚均匀受力”;若条件C4未满足,则提示用户“请使用拐杖,并使两拐杖均匀受力”。
2)行走触发条件的判断。行走触发条件的判断即控制模块11分析处理传感器采集到的数据,判断是否满足以下条件:C5:即躯干向前倾斜的角度超过阈值,躯干左右倾斜角度在安全范围内;C6:FPl>>FPr或C7:FPl<<FPr,即两脚底压力差超过阈值,若两脚底压力值满足(Fpl‐Fpr)/Fp>80%,则认为FPl>>FPr;若(Fpr‐Fpl)/Fp>80%,则认为FPl<<FPr;C8:FC>0,FCl>Fcr或C9:FC>0,FCl<Fcr,即两拐杖触地压力传感器的压力值不为0,且两拐杖触地压力差超过阈值,若两拐杖压力满足(FCl‐Fcr)/FC>40%,则认为FCl>Fcr;若两拐杖压力满足(Fcr‐FCl)/FC>40%,则认为Fcr>FCl。若同时满足条件C5、C6、C8,则满足先迈右腿的触发条件;若同时满足条件C5、C7、C9,则满足先迈左腿的触发条件。若用户先迈右腿,但未同时满足条件C5、C6、C8,控制模块11向语音模块16发出消息,提醒用户调整姿态,直至检测到用户满足迈右腿的条件。用户可根据语音提示中的具体操作指引调整身体姿态,若条件C5未满足,则会提示用户“请将躯干向前倾斜”;若条件C6未满足,则会提示用户“请将身体重心集中到身体左边,使左脚受力大于右脚受力”;若条件C8未满足,则会提示用户“请使用拐杖,并增大左拐杖压力,减小右拐杖压力”。若用户先迈左腿,但未同时满足条件C5、C7、C9,控制模块11向语音模块16发出消息,提醒用户调整姿态,直至检测到用户满足迈左腿的条件。用户可根据语音提示中的具体操作指引调整身体姿态,若条件C5未满足,则会提示用户“请将躯干向前倾斜”;若条件C7未满足,则会提示用户“请将身体重心集中到身体右边,使右脚压力大于左脚压力”;若条件C9未满足,则会提示用户“请使用拐杖,并增大右拐杖压力,减小左拐杖压力”。若用户不执行迈腿动作,则保持平行站立状态,控制模块11持续检测传感器数据,判断用户姿态。在用户使用该装置初期,我们会对用户做培训,防止用户误触发。
3)行走触发控制。若控制模块11检测到用户同时满足条件C5、C6、C8,则表明用户满足迈右腿的触发条件,控制模块11向右髋电机4_2和右膝电机6_2发出指令,执行迈右腿动作,如图5所示迈腿动作经过三个阶段。阶段一:髋部电机4_2开始以加速度a0从静止匀加速至速度v0,然后以恒定速度v0转动,带动用户躯干与大腿产生相对角度运动,使躯干支架1与大腿支架2之间角度∠右髋减小;同时膝部电机6_2开始以加速度a1从静止匀加速至速度v1(行走过程中设置v1=2v0),然后以恒定速度v1转动,带动大腿与小腿产生相对角度运动,使大腿支架2与小腿支架3之间的角度∠右膝减小,直至控制模块11检测到控制膝部电机6_2以加速度-a1匀减速至静止,实现姿态1:同时满足条件C5、C10:Fpr=(0~3%)G,Fpl=(60%~80%)G、C11:FC=(20%~40%)G、C12: 阶段二:髋部电机持续4_2转动,直至控制模块11检测到 控制膝部电机6_2反向转动,以加速度a1匀加速至速度至v1,然后以恒定速度v1转动,带动大腿与小腿产生相对角度运动,使大腿支架2与小腿支架3之间的角度∠右膝增大,实现姿态2:同时满足条件C1、C10、C11、C13:阶段三:控制模11块持续检测∠右髋,直至检测到控制髋部电机4_2以加速度-a0匀减速至静止。膝部电机持续以恒定速度v1转动,直至控制模块11检测到 (这里预留了的安全缓冲区),控制膝部电机6_2以加速度-a1匀减速至静止,迈步动作结束,用户进入右脚前左脚后即姿态3,同时满足条件C1、C3、C4和C14: 若控制模块检测到用户同时满足条件C5、C7、C9,则表明用户满足迈左腿的触发条件,控制模块向左髋电机4_1和左膝电机6_1发出指令,执行迈左腿动作(与迈右腿动作相同),直至动作结束,进入左脚前右脚后状态即同时满足条件C1、C3、C4和C15: 控制模块11继续检测判断躯干倾角、脚底压力和拐杖压力传感器的数据,进入步态维持状态。
行走过程中,控制模块11在迈步动作执行中除了会实时检测电机角度,判断其是否达到阈值以停止电机转动之外,同时还会持续监控各个传感器的值是否在正常范围。迈左脚动作:脚底压力值范围Fpl=(0~5%)G,Fpr=(60%~80%)G,拐杖触地压力值范围FC>0,|Fcr‐FCl|/FC=40%~60%,躯干倾角值范围迈右脚动作中脚底压力值范围Fpr=(0~5%)G,Fpl=(60%~80%)G,拐杖触地压力值范围FC>0,|FCl‐Fcr|/FC=40%~60%,躯干倾角值范围如果压力值、躯干倾角值等参数超出上述正常范围达到1s,即判别为“异常状态”,控制模块11将对用户执行保护措施,直至收到进一步的指令以解除“异常状态”。这些保护措施包括但不限于:用户重心不稳时,控制电机停止转动;用户摔倒时,控制语音模块16发出警报以请求他人救援。
本文所述行走触发控制方法有如下优点:本发明采用了脚底压力传感器、拐杖触地压力传感器、躯干倾角传感器和电机转角传感器同时检测用户姿态数据,实现多传感器协同触发控制。当控制模块11检测到每个传感器的数据均满足条件时,才对电机组发出指令,否则就提醒用户调整姿态。这种多传感器协同工作的方式,有效避免单一触发方式的误触发风险,保障了用户的安全。
以上实施方法仅供说明本发明之用,而非对本发明的限制,有关技术领域的技术人员,在不脱离本发明的精神和范围的情况下,还可以作出各种变换或变型,因此所有等同的技术方案也应该属于本发明的范畴,应由各权利要求所限定。
Claims (6)
1.基于脚部压力传感器的康复装置的行走触发控制方法,其特征在于包括如下步骤:
1)平行站立姿态的判断:控制模块分析处理传感器采集到的数据,判断是否同时满足以下4个条件:C3:|Fpl‐Fpr|/Fp<10%;C4:FC>0,|FCl‐Fcr|/FC<5%;若控制模块检测到传感器数据同时满足条件C1、C2、C3、C4,则用户处于平行站立姿态;若不满足上述4个条件中的任一条件,则不是平行站立姿态;
2)行走触发条件的判断:控制模块分析处理传感器采集到的数据,判断是否满足以下条件:C6:FPl>>FPr或C7:FPl<<FPr;C8:FC>0,FCl>Fcr或C9:FC>0,FCl<Fcr;若同时满足条件C5、C6、C8,则满足先迈右腿的触发条件;若同时满足条件C5、C7、C9,则满足先迈左腿的触发条件;若未同时满足条件C5、C6、C8或未同时满足条件C5、C7、C9,控制模块持续检测传感器数据,判断用户姿态;
3)行走触发控制:若控制模块检测到用户满足迈右腿的触发条件,控制模块向右髋电机和右膝电机发出指令,执行迈右腿动作:髋部电机开始以加速度a0从静止匀加速至速度v0,然后以速度v0转动,带动用户躯干与大腿产生相对角度运动,使躯干支架与大腿支架之间角度∠右髋减小;同时膝部电机开始以加速度a1从静止匀加速至速度v1,然后以速度v1转动,带动大腿与小腿产生相对角度运动,使大腿支架与小腿支架之间的角度∠右膝减小,直至控制模块检测到控制膝部电机以加速度-a1匀减速至静止;髋部电机持续转动,直至控制模块检测到控制膝部电机反向转动,以加速度a1匀加速至速度至v1,然后以速度v1转动,带动大腿与小腿产生相对角度运动,使大腿支架与小腿支架之间的角度∠右膝增大;控制模块持续检测∠右髋,直至检测到控制髋部电机以加速度-a0匀减速至静止;膝部电机持续以速度v1转动,直至控制模块检测到控制膝部电机以加速度-a1匀减速至静止,迈步动作结束,用户进入右脚前左脚后姿态;
若控制模块检测到用户满足迈左腿的触发条件,控制模块向左髋电机和左膝电机发出指令,执行迈左腿动作,直至动作结束,进入左脚前右脚后状态;执行迈左腿动作与迈右腿动作相同为左右腿互换,控制方式相同;
4)控制模块继续检测判断躯干倾角、脚底压力和拐杖压力传感器的数据,进入步态维持状态;
所述∠前后为躯干前后倾角;所述∠左右为躯干左右倾角;FPl为左脚单独压力;FPr为右脚单独压力;FCl为左拐杖压力;FCr.为右拐杖压力;FC为去除拐杖自身重力后的两拐杖压力和;∠膝为大腿支架与小腿支架之间的夹角;∠髋为大腿支架与躯干支架之间的夹角;∠左膝为左膝关节角度;∠右膝为右膝关节角度;∠左髋为左髋关节角度;∠右髋为右髋关节角度。
2.根据权利要求1所述的基于脚部压力传感器的康复装置的行走触发控制方法,其特征在于,所述∠前后为以躯干垂直地面为基准,躯干前后倾斜的角度,前倾为正,后倾为负;所述∠左右为以躯干垂直地面为基准,躯干左右倾斜的角度;左倾为正,右倾为负。
3.根据权利要求1所述的基于脚部压力传感器的康复装置的行走触发控制方法,其特征在于,若初始状态不满足平行站立姿态的条件,控制中心向语音模块发出消息,提醒用户调整姿态,直至检测到用户为平行站立姿态;用户根据语音提示中的具体操作指引调整身体姿态;若条件C1未满足,语音模块提示用户“请保持躯干直立,不要向左右倾斜或向前后倾斜”;若条件C2未满足,语音模块提示用户“请保持双腿直立,调整左髋左膝或右髋右膝关节角度”;若条件C3未满足,语音模块示用户“请使双脚均匀受力”;若条件C4未满足,语音模块提示用户“请使用拐杖,并使两拐杖均匀受力”。
4.根据权利要求1所述的基于脚部压力传感器的康复装置的行走触发控制方法,其特征在于,所述a0的取值为a1的取值为v0的取值为v1的取值为
5.根据权利要求1所述的基于脚部压力传感器的康复装置的行走触发控制方法,其特征在于,所述控制模块分别与左腿髋部电机角度传感器、右腿髋部电机角度传感器、左腿膝部电机角度传感器、右腿膝部电机角度传感器、左脚脚底压力传感器、右脚脚底压力传感器、左腿髋部电机、躯干倾角传感器、右腿髋部电机、左腿膝部电机和右腿膝部电机连接。
6.根据权利要求1所述的基于脚部压力传感器的康复装置的行走触发控制方法,其特征在于,所述康复装置的躯干支架绑定在用户上身;大腿支架绑定在用户大腿上,小腿支架绑定在用户小腿上;脚部支撑板设置在用户脚底;躯干支架与大腿支架通过髋部电机连接;髋部电机的定子与躯干支架固定,髋部电机的转子与大腿支架固定;大腿支架与小腿支架分别膝部电机的定子和转子连接;膝部电机连接着大腿支架与小腿支架并控制两者相对角度运动;小腿支架与脚部支撑板活动连接。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510834977.8A CN105342808B (zh) | 2015-11-25 | 2015-11-25 | 基于脚部压力传感器的康复装置的行走触发控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510834977.8A CN105342808B (zh) | 2015-11-25 | 2015-11-25 | 基于脚部压力传感器的康复装置的行走触发控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105342808A true CN105342808A (zh) | 2016-02-24 |
CN105342808B CN105342808B (zh) | 2018-05-15 |
Family
ID=55318978
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510834977.8A Expired - Fee Related CN105342808B (zh) | 2015-11-25 | 2015-11-25 | 基于脚部压力传感器的康复装置的行走触发控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105342808B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106361542A (zh) * | 2016-10-24 | 2017-02-01 | 电光防爆科技(上海)有限公司 | 一种智能助行器控制器系统 |
CN107536613A (zh) * | 2016-06-29 | 2018-01-05 | 深圳光启合众科技有限公司 | 机器人及其人体下肢步态识别装置和方法 |
CN111481405A (zh) * | 2020-04-22 | 2020-08-04 | 北京海益同展信息科技有限公司 | 一种运动指令的触发方法、装置和外骨骼设备 |
CN113456434A (zh) * | 2020-03-30 | 2021-10-01 | 纬创资通股份有限公司 | 施力辅助设备及其控制方法 |
CN113925494A (zh) * | 2021-10-15 | 2022-01-14 | 深圳智游者科技有限公司 | 个人不良行走步态监测方法和装置 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20130123672A1 (en) * | 2008-10-13 | 2013-05-16 | Argo Medical Technologies Ltd. | Locomotion assisting device and method |
CN103200909A (zh) * | 2010-09-27 | 2013-07-10 | 范德比尔特大学 | 行动辅助设备 |
CN103932868A (zh) * | 2014-04-21 | 2014-07-23 | 清华大学 | 一种截瘫助行动力外骨骼的控制方法 |
CN104302251A (zh) * | 2012-03-22 | 2015-01-21 | 埃克苏仿生公司 | 用于下肢体矫正器的人机界面 |
CN104490563A (zh) * | 2014-12-25 | 2015-04-08 | 电子科技大学 | 一种基于气动肌肉的智能可穿戴下肢 |
-
2015
- 2015-11-25 CN CN201510834977.8A patent/CN105342808B/zh not_active Expired - Fee Related
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20130123672A1 (en) * | 2008-10-13 | 2013-05-16 | Argo Medical Technologies Ltd. | Locomotion assisting device and method |
CN103200909A (zh) * | 2010-09-27 | 2013-07-10 | 范德比尔特大学 | 行动辅助设备 |
CN104302251A (zh) * | 2012-03-22 | 2015-01-21 | 埃克苏仿生公司 | 用于下肢体矫正器的人机界面 |
CN103932868A (zh) * | 2014-04-21 | 2014-07-23 | 清华大学 | 一种截瘫助行动力外骨骼的控制方法 |
CN104490563A (zh) * | 2014-12-25 | 2015-04-08 | 电子科技大学 | 一种基于气动肌肉的智能可穿戴下肢 |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107536613A (zh) * | 2016-06-29 | 2018-01-05 | 深圳光启合众科技有限公司 | 机器人及其人体下肢步态识别装置和方法 |
CN107536613B (zh) * | 2016-06-29 | 2021-10-08 | 沭阳县成基实业有限公司 | 机器人及其人体下肢步态识别装置和方法 |
CN106361542A (zh) * | 2016-10-24 | 2017-02-01 | 电光防爆科技(上海)有限公司 | 一种智能助行器控制器系统 |
CN113456434A (zh) * | 2020-03-30 | 2021-10-01 | 纬创资通股份有限公司 | 施力辅助设备及其控制方法 |
CN113456434B (zh) * | 2020-03-30 | 2023-10-27 | 纬创资通股份有限公司 | 施力辅助设备及其控制方法 |
CN111481405A (zh) * | 2020-04-22 | 2020-08-04 | 北京海益同展信息科技有限公司 | 一种运动指令的触发方法、装置和外骨骼设备 |
CN113925494A (zh) * | 2021-10-15 | 2022-01-14 | 深圳智游者科技有限公司 | 个人不良行走步态监测方法和装置 |
Also Published As
Publication number | Publication date |
---|---|
CN105342808B (zh) | 2018-05-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105326627A (zh) | 基于躯干重心偏移的康复装置行走触发控制方法 | |
CN105456000B (zh) | 一种可穿戴仿生外骨骼机械腿康复装置的行走控制方法 | |
CN105342808A (zh) | 基于脚部压力传感器的康复装置的行走触发控制方法 | |
CN105411813A (zh) | 一种可穿戴仿生外骨骼机械腿康复装置 | |
EP2671559B1 (en) | Ambulation training device and ambulation training system | |
CN109195565B (zh) | 步行动作辅助装置 | |
CN106137489B (zh) | 交互式外骨骼膝关节机器系统 | |
CN109568089A (zh) | 一种随动式下肢步态训练康复机器人系统 | |
JP5507224B2 (ja) | 歩行介助ロボット | |
JP5706016B2 (ja) | 歩行介助ロボット | |
JP6175050B2 (ja) | 能動的ロボティック歩行訓練システム及び方法 | |
CN105455819A (zh) | 可穿戴仿生外骨骼机械腿康复装置的站立模式控制方法 | |
CN109758342A (zh) | 外骨骼机器人及其控制方法 | |
CN105456004A (zh) | 外骨骼式移动步行康复训练装置及方法 | |
CN106901949B (zh) | 全下肢外骨骼及其操作方法 | |
CN104490568A (zh) | 人体下肢外骨骼助行康复机器人 | |
CN104490563A (zh) | 一种基于气动肌肉的智能可穿戴下肢 | |
JP2023531830A (ja) | 片下肢のリハビリテーション外骨格装置及びその制御方法 | |
CN105662789B (zh) | 一种基于健全肢体运动监测、控制残肢运动的外骨骼系统 | |
CN105326625A (zh) | 可穿戴仿生外骨骼机械腿康复装置的坐下模式控制方法 | |
CN101947153A (zh) | 一种穿戴式智能足下垂矫正器及矫正方法 | |
US20240033159A1 (en) | Powered-knee exoskeleton system | |
CN105287164B (zh) | 一种基于躯干晃动的康复装置行走速度控制方法 | |
KR102162485B1 (ko) | 하지 보조로봇의 제어방법 | |
CN205412080U (zh) | 多功能健康运动组合装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20180515 Termination date: 20211125 |