CN110812127A - 下肢外骨骼控制方法及装置 - Google Patents

下肢外骨骼控制方法及装置 Download PDF

Info

Publication number
CN110812127A
CN110812127A CN201910981432.8A CN201910981432A CN110812127A CN 110812127 A CN110812127 A CN 110812127A CN 201910981432 A CN201910981432 A CN 201910981432A CN 110812127 A CN110812127 A CN 110812127A
Authority
CN
China
Prior art keywords
motion state
control
user
mode
joint
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
Application number
CN201910981432.8A
Other languages
English (en)
Other versions
CN110812127B (zh
Inventor
吴诚
叶晶
陈功
张旭
胡广
郭登极
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shenzhen Step Robot Technology Co Ltd
Original Assignee
Shenzhen Step Robot Technology Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Shenzhen Step Robot Technology Co Ltd filed Critical Shenzhen Step Robot Technology Co Ltd
Priority to CN201910981432.8A priority Critical patent/CN110812127B/zh
Publication of CN110812127A publication Critical patent/CN110812127A/zh
Application granted granted Critical
Publication of CN110812127B publication Critical patent/CN110812127B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61HPHYSICAL 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/00Appliances for aiding patients or disabled persons to walk about
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B5/00Measuring for diagnostic purposes; Identification of persons
    • A61B5/103Detecting, measuring or recording devices for testing the shape, pattern, colour, size or movement of the body or parts thereof, for diagnostic purposes
    • A61B5/1036Measuring load distribution, e.g. podologic studies
    • A61B5/1038Measuring plantar pressure during gait
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61BDIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B5/00Measuring for diagnostic purposes; Identification of persons
    • A61B5/68Arrangements of detecting, measuring or recording means, e.g. sensors, in relation to patient
    • A61B5/6801Arrangements of detecting, measuring or recording means, e.g. sensors, in relation to patient specially adapted to be attached to or worn on the body surface
    • A61B5/6802Sensor mounted on worn items
    • A61B5/6803Head-worn items, e.g. helmets, masks, headphones or goggles
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61HPHYSICAL 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/00Appliances for aiding patients or disabled persons to walk about
    • A61H2003/007Appliances for aiding patients or disabled persons to walk about secured to the patient, e.g. with belts
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61HPHYSICAL 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/00Characteristics of apparatus not provided for in the preceding codes
    • A61H2201/12Driving means
    • A61H2201/1253Driving means driven by a human being, e.g. hand driven
    • A61H2201/1261Driving means driven by a human being, e.g. hand driven combined with active exercising of the patient
    • A61H2201/1269Passive exercise driven by movement of healthy limbs
    • A61H2201/1276Passive exercise driven by movement of healthy limbs by the other leg or arm
    • AHUMAN NECESSITIES
    • A61MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61HPHYSICAL 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/00Devices for specific parts of the body
    • A61H2205/10Leg

Abstract

本发明公开了下肢外骨骼控制方法及装置。涉及机器人控制领域,其中,方法通过获取足底压力传感器采集的用户数据,用户数据包括:健侧脚足跟压力数值、患侧脚足跟压力数值、健侧脚足尖压力数值,根据用户数据判断用户意图得到用户运动状态,然后根据运动状态选择对应的控制模式,最后根据不同的控制模式发送控制信号到驱动器驱动电机进行外骨骼控制。通过运动意图识别,可针对不同运动状态提供不同的控制模式,针对不同运动状态给穿戴者提供不同的助力模式,从而实现根据用户步态实现健侧腿带动患侧腿,而且行走速度可由用户健侧腿运动状态自主调节,能够激发用户的训练主动性,以及消除人机不匹配导致的安全隐患,具有更好的康复效果及安全性。

Description

下肢外骨骼控制方法及装置
技术领域
本发明涉及机器人控制领域,尤其是一种下肢外骨骼控制方法及装置。
背景技术
随着世界各国相继进入老龄化国家,脑卒中用户越来越多。通常脑卒中用户都残留各种各样的后遗症,包括偏瘫、语言不利、神志障碍、面瘫、大小便失禁等,其中偏瘫居首位,脑卒中治疗周期长,给用户本人、家庭以及社会带来极大地经济负担和心理压力,相关康复治疗设备的研发备受关注。国内外在康复训练机器人领域做了大量的研究,也有一些可用于肢体康复训练的产品,例如Rewalk是一个由以色列制造商ReWalk机械公司设计制造的外骨骼系统,主要用途是协助下肢瘫痪的病人能够再次站立行走,但是该外骨骼只能以恒定步态进行被动行走,又例如,中国的大艾机器人的下肢外骨骼康复机器人“艾动”及“艾康”能够进行下肢康复训练,但是与Rewalk相似只能以恒定步态进行被动行走。因此需要提出一种能够根据用户步态实现健侧腿带动患侧腿,提高康复训练效果的下肢外骨骼主动控制方法。
发明内容
本发明旨在至少在一定程度上解决相关技术中的技术问题之一。为此,本发明的目的是提供一种能够根据用户步态实现健侧腿带动患侧腿,提高康复训练效果的下肢外骨骼主动控制方法。
本发明所采用的技术方案是:
第一方面,本发明提供一种下肢外骨骼控制方法,包括:
获取足底压力传感器采集的用户数据,所述用户数据包括:健侧脚足跟压力数值、患侧脚足跟压力数值、健侧脚足尖压力数值;
根据所述用户数据判断用户意图得到用户运动状态,所述用户运动状态包括:第一运动状态、第二运动状态、第三运动状态和第四运动状态;
根据所述运动状态选择对应的控制模式,所述控制模式包括:助力模式和随动模式;
根据不同的控制模式发送控制信号到驱动器驱动电机进行所述外骨骼控制。
进一步地,判断用户意图具体为:
设定起始状态为第一运动状态;
当状态持续时间大于第一阈值,且所述健侧脚足跟压力数据小于第二阈值时,切换当前用户运动状态为第二运动状态;
当状态持续时间大于第三阈值,且所述健侧脚足跟压力数据大于第四阈值时,切换当前用户运动状态为第三运动状态;
当状态持续时间大于第五阈值,且所述健侧脚足尖压力数据大于第六阈值时,切换当前用户运动状态为第四运动状态;
当状态持续时间大于第七阈值,且所述患侧脚足跟压力数据大于第八阈值时,切换当前用户运动状态为第一运动状态。
进一步地,患侧腿始终选择所述助力模式;当处于所述第二运动状态时,健侧腿选择所述随动模式,当处于其他用户运动状态时,所述健侧腿选择所述助力模式。
进一步地,所述随动模式为力矩PID控制模式,具体为:
根据关节期望力矩、关节实际力矩和进行重力补偿得到的关节补偿力矩计算力矩误差;
结合所述力矩误差和PID控制系数计算得到驱动器控制量;
利用所述驱动器控制量驱动电机进行所述外骨骼控制。
进一步地,所述助力模式为阻抗控制模式,具体为:
根据关节转动期望角度和关节实际转动角度计算关节转动角度误差;
根据所述关节转动角度误差进行阻抗控制,计算得到关节期望力矩;
根据关节期望力矩、关节实际力矩和进行重力补偿得到的关节补偿力矩计算力矩误差;
结合所述力矩误差和PID控制系数计算得到驱动器控制量;
利用所述驱动器控制量驱动电机进行所述外骨骼控制。
进一步地,所述随动模式下所述关节期望力矩设置为零。
进一步地,所述重力补偿具体为:根据关节转动角度以及系统补偿系数计算得到关节补偿力矩。
第二方面,本发明还提供一种下肢外骨骼控制装置,包括:
获取用户数据模块:用于获取足底压力传感器采集的用户数据,所述用户数据包括:健侧脚足跟压力数值、患侧脚足跟压力数值、健侧脚足尖压力数值;
判断用户意图模块:用于根据所述用户数据判断用户意图得到用户运动状态,所述用户运动状态包括:第一运动状态、第二运动状态、第三运动状态和第四运动状态;
选择控制模式模块:用于根据所述运动状态选择对应的控制模式,所述控制模式包括:助力模式和随动模式;
外骨骼控制模块:用于根据不同的控制模式发送控制信号到驱动器驱动电机进行所述外骨骼控制。
第三方面,本发明还提供一种下肢外骨骼,利用如第一方面任一项所述的一种下肢外骨骼控制方法进行控制。
第四方面,本发明还提供一种下肢外骨骼控制设备,包括:
至少一个处理器;以及,与所述至少一个处理器通信连接的存储器;
其中,所述处理器通过调用所述存储器中存储的计算机程序,用于执行如第一方面任一项所述的方法。
本发明的有益效果是:
本发明通过获取足底压力传感器采集的用户数据,用户数据包括:健侧脚足跟压力数值、患侧脚足跟压力数值、健侧脚足尖压力数值,根据用户数据判断用户意图得到包括第一运动状态、第二运动状态、第三运动状态和第四运动状态在内的用户运动状态,然后根据运动状态选择对应的控制模式,其中,控制模式包括:助力模式和随动模式,最后根据不同的控制模式发送控制信号到驱动器驱动电机进行外骨骼控制。通过运动意图识别,可针对不同运动状态提供不同的控制模式,针对不同运动状态给穿戴者提供不同的助力模式,从而实现根据用户步态实现健侧腿带动患侧腿,而且行走速度可由用户健侧腿运动状态自主调节,能够激发用户的训练主动性,以及消除人机不匹配导致的安全隐患,具有更好的康复效果及安全性,可广泛应用于外骨骼助力领域。
附图说明
图1是本发明中下肢外骨骼控制方法的一具体实施例的实现流程图;
图2是本发明中下肢外骨骼控制方法的一具体实施例的用户运动状态切换示意图;
图3是本发明中下肢外骨骼控制方法的一具体实施例的重力补偿示意图;
图4是本发明中下肢外骨骼控制方法的一具体实施例的系统结构示意图;
图5是本发明中下肢外骨骼控制方法的一具体实施例的控制流程示意图;
图6是本发明中下肢外骨骼控制装置的一具体实施例的结构框图。
具体实施方式
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对照附图说明本发明的具体实施方式。显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图,并获得其他的实施方式。
除非另有定义,本文所使用的所有的技术和科学术语与属于本发明的技术领域的技术人员通常理解的含义相同。本文中在本发明的说明书中所使用的术语只是为了描述具体的实施例的目的,不是旨在于限制本发明。
实施例一:
本发明实施例一提供一种下肢外骨骼控制方法,图1为本发明实施例提供的下肢外骨骼控制方法的实现流程图,如图1所示,该方法包括以下步骤:
S1:获取足底压力传感器采集的用户数据。
本实施例中,用户数据包括:健侧脚足跟压力数值、患侧脚足跟压力数值、健侧脚足尖压力数值,主要是根据用户步态实现健侧腿带动患侧腿训练,其行走速度可由用户健侧腿运动状态自主调节,不同行走速度下,足底压力传感器采集的用户数据不同,进一步地,足底压力传感器可以安装在外骨骼的足底。
S2:根据用户数据判断用户意图得到用户运动状态,所述用户运动状态包括:第一运动状态、第二运动状态、第三运动状态和第四运动状态;
S3:根据所述运动状态选择对应的控制模式,所述控制模式包括:助力模式和随动模式,具体的,患侧腿始终选择助力模式,当处于第二运动状态时,健侧腿选择随动模式,当处于其他用户运动状态时,健侧腿选择助力模式。
S4:根据不同的控制模式发送控制信号到驱动器驱动电机进行外骨骼控制。
如图2所示,为本实施例中用户运动状态切换示意图,即判断用户意图得到用户运动状态,从图中可以看出,设定起始状态为第一运动状态(即双脚触地患侧在前状态),当状态持续时间大于第一阈值f1,且健侧脚足跟压力数据小于第二阈值f2时,切换当前用户运动状态为第二运动状态(即健侧腿摆动相状态);当状态持续时间大于第三阈值f3,且健侧脚足跟压力数据大于第四阈值f4时,切换当前用户运动状态为第三运动状态(即双脚触地健侧在前状态);当状态持续时间大于第五阈值f5,且健侧脚足尖压力数据大于第六阈值f6时,切换当前用户运动状态为第四运动状态(即患侧腿摆动相状态);当状态持续时间大于第七阈值f7,且患侧脚足跟压力数据大于第八阈值f8时,切换当前用户运动状态为第一运动状态(即双脚触地患侧在前状态),即完成一个周期循环。
本实施例中,第一阈值~第八阈值均是根据实际动作采集获取的值,能够反应用户处于不同用户运动状态,根据采集的值判断用户运动状态,进一步地,第三阈值f3和第七阈值f7可选的值为1.5s,第一阈值f1和第五阈值f5可选的值为0.1s-0.2s之间的值,即满足压力大小条件的情况下,当状态持续时间大于1.5s时,从第二运动状态切换到第三运动状态或从第四运动状态切换到第一运动状态,当状态持续时间大于在0.1s-0.2s之间选取的阈值时,从第一运动状态切换到第二运动状态或从第三运动状态切换到第四运动状态,进一步地,第二阈值f2、第四阈值f4、第六阈值f6、第八阈值f8可选的值为2800。上述仅做取值示意,不做限定,凡是能够通过上述意图识别过程识别出用户运动状态的判断数值,均能作为本实施例的阈值取值。
步骤S3中,控制模式包括:助力模式和随动模式,具体的两种控制模式如下所述。
1)随动模式为力矩PID控制模式:
S311:根据关节期望力矩、关节实际力矩和进行重力补偿得到的关节补偿力矩计算力矩误差,表示为:
eT=Td-Tact+Tg (1)
其中,Td表示关节期望力矩,通过阻抗控制计算得到,Tact表示关节实际力矩,通过惯性传感器测量得到,Tg表示关节补偿力矩,通过重力补偿公式计算得到,eT表示力矩误差。
S312:结合力矩误差和PID控制系数计算得到驱动器控制量,表示为:
Figure BDA0002235314400000051
其中,∫eT·dt表示力矩误差的积分,表示力矩误差的微分,kp、ki、kd表示PID控制系数,分别为PID控制的比例、积分、微分系数,均可通过实验数据拟合得到,u表示驱动器控制量。
S313:利用驱动器控制量驱动电机进行外骨骼控制。
并且,随动模式下关节期望力矩Td设置为零。
2)助力模式为阻抗控制模式:
S321:根据关节转动期望角度和关节实际转动角度计算关节转动角度误差,表示为:
eq=qd-qact (3)
其中,qd表示关节转动期望角度,可通过程序实时规划生成,qact表示关节实际转动角度,通过惯性传感器测量得到,eq表示关节转动角度误差。
S322:根据关节转动角度误差进行阻抗控制,计算得到关节期望力矩,表示为:
Figure BDA0002235314400000061
其中,Td表示关节期望力矩,
Figure BDA0002235314400000062
表示关节转动角度误差的微分,ai表示阻抗控制刚度系数,bi表示阻抗控制阻尼系数,阻抗控制刚度系数和阻抗控制阻尼系数可以通过实验数据拟合得到。
S323:根据关节期望力矩、关节实际力矩和进行重力补偿得到的关节补偿力矩计算力矩误差,计算同公式(1)。
S324:结合力矩误差和PID控制系数计算得到驱动器控制量,计算同公式(2)。
S325:利用驱动器控制量驱动电机进行外骨骼控制。
如图3所示,为本实施例重力补偿示意图,如图所示,重力补偿具体为:根据关节转动角度以及系统补偿系数计算得到关节补偿力矩,例如对摆动侧腿进行重力补偿,包括膝关节补偿和髋关节补偿,即重力补偿力矩Tg相应的包括膝关节补偿力矩和髋关节补偿力矩,公示表示为:
Tknee=kknee·sin(θkh) (5)
Thip=khip1·sinθh+khip2·sin(θkh) (6)
其中,Tknee表示膝关节补偿力矩,Thip表示髋关节补偿力矩,θk表示膝关节转动角度,θh表示髋关节转动角度,kknee、khip1、khip2分别表示系统辨识系数,该系数通过实验数据拟合得到。
如图4所示,为本实施例的系统结构示意图,包括足底压力传感器01、编码器02、主控板03、驱动器04及电机05,足底压力传感器01实时采集用户数据,编码器02用于进行阻抗控制和重力补偿过程中关节角度和关节力矩的获取,主控板03获取采集的数据并判断用户意图,进行用户运动状态切换,同时对应匹配不同的控制模式(随动模式和助力模式),患侧腿始终选择助力模式,当处于第二运动状态时,健侧腿选择随动模式,当处于其他用户运动状态时,健侧腿选择助力模式,并将不同控制模式下的控制信号(驱动器控制量)发送给驱动器04,以驱动电机05运动实现外骨骼的闭环控制。
如图5所示,为本实施例控制流程示意图,首先采集用户数据,进行用户运动意图判断,如果当前处于第二运动状态时,健侧腿选择随动模式,进入随动模式,即根据关节期望力矩Td(处于随动模式时,该值为零)、关节实际力矩Tact和进行重力补偿得到的关节补偿力矩Tg计算力矩误差eT,结合力矩误差eT和PID控制系数进行PID控制,计算得到驱动器控制量u,根据驱动器控制量u驱动电机进行人机交互,即实现对外骨骼的控制。
否则,患侧腿和健侧腿均选择助力模式,进入助力模式,即根据关节转动期望角度qd和关节实际转动角度qact计算关节转动角度误差eq,然后进行阻抗控制,即计算得到关节期望力矩Td,结合关节期望力矩Td、关节实际力矩Tact和进行重力补偿得到的关节补偿力矩Tg计算力矩误差eT,结合力矩误差eT和PID控制系数进行PID控制,计算得到驱动器控制量u,根据驱动器控制量u驱动电机进行人机交互,即实现对外骨骼的控制。
本实施例通过运动意图识别,可针对不同运动状态提供不同的控制模式,针对不同运动状态给穿戴者提供不同的助力模式,从而实现根据用户步态实现健侧腿带动患侧腿,而且行走速度可由用户健侧腿运动状态自主调节,能够激发用户的训练主动性,以及消除人机不匹配导致的安全隐患,具有更好的康复效果及安全性。
实施例二:
如图6所示,为本实施例提供的一种下肢外骨骼控制装置结构框图,用于执行如实施例一所述的一种下肢外骨骼控制方法,包括:
获取用户数据模块10:用于获取足底压力传感器采集的用户数据,用户数据包括:健侧脚足跟压力数值、患侧脚足跟压力数值、健侧脚足尖压力数值;
判断用户意图模块20:用于根据用户数据判断用户意图得到用户运动状态,用户运动状态包括:第一运动状态、第二运动状态、第三运动状态和第四运动状态;
选择控制模式模块30:用于根据运动状态选择对应的控制模式,控制模式包括:助力模式和随动模式;
外骨骼控制模块40:用于根据不同的控制模式发送控制信号到驱动器驱动电机进行外骨骼控制。
实施例三:
一种下肢外骨骼,只要能够利用如实施例一任一项所述的一种下肢外骨骼控制方法进行控制,即属于本实施例的保护范围。
另外,一种下肢外骨骼控制设备,包括:至少一个处理器;以及,与至少一个处理器通信连接的存储器;其中,处理器通过调用存储器中存储的计算机程序,用于执行如实施例一任一项所述的方法。
本发明通过获取足底压力传感器采集的用户数据,用户数据包括:健侧脚足跟压力数值、患侧脚足跟压力数值、健侧脚足尖压力数值,根据用户数据判断用户意图得到包括第一运动状态、第二运动状态、第三运动状态和第四运动状态在内的用户运动状态,然后根据运动状态选择对应的控制模式,其中,控制模式包括:助力模式和随动模式,最后根据不同的控制模式发送控制信号到驱动器驱动电机进行外骨骼控制,可广泛应用于外骨骼助力领域。
以上各实施例仅用以说明本发明的技术方案,而非对其限制,尽管参照前述各实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的范围,其均应涵盖在本发明的权利要求和说明书的范围当中。

Claims (10)

1.一种下肢外骨骼控制方法,其特征在于,包括:
获取足底压力传感器采集的用户数据,所述用户数据包括:健侧脚足跟压力数值、患侧脚足跟压力数值、健侧脚足尖压力数值;
根据所述用户数据判断用户意图得到用户运动状态,所述用户运动状态包括:第一运动状态、第二运动状态、第三运动状态和第四运动状态;
根据所述运动状态选择对应的控制模式,所述控制模式包括:助力模式和随动模式;
根据不同的控制模式发送控制信号到驱动器驱动电机进行所述外骨骼控制。
2.根据权利要求1所述的一种下肢外骨骼控制方法,其特征在于,判断用户意图具体为:
设定起始状态为第一运动状态;
当状态持续时间大于第一阈值,且所述健侧脚足跟压力数据小于第二阈值时,切换当前用户运动状态为第二运动状态;
当状态持续时间大于第三阈值,且所述健侧脚足跟压力数据大于第四阈值时,切换当前用户运动状态为第三运动状态;
当状态持续时间大于第五阈值,且所述健侧脚足尖压力数据大于第六阈值时,切换当前用户运动状态为第四运动状态;
当状态持续时间大于第七阈值,且所述患侧脚足跟压力数据大于第八阈值时,切换当前用户运动状态为第一运动状态。
3.根据权利要求1所述的一种下肢外骨骼控制方法,其特征在于,患侧腿始终选择所述助力模式;当处于所述第二运动状态时,健侧腿选择所述随动模式,当处于其他用户运动状态时,所述健侧腿选择所述助力模式。
4.根据权利要求1所述的一种下肢外骨骼控制方法,其特征在于,所述随动模式为力矩PID控制模式,具体为:
根据关节期望力矩、关节实际力矩和进行重力补偿得到的关节补偿力矩计算力矩误差;
结合所述力矩误差和PID控制系数计算得到驱动器控制量;
利用所述驱动器控制量驱动电机进行所述外骨骼控制。
5.根据权利要求1所述的一种下肢外骨骼控制方法,其特征在于,所述助力模式为阻抗控制模式,具体为:
根据关节转动期望角度和关节实际转动角度计算关节转动角度误差;
根据所述关节转动角度误差进行阻抗控制,计算得到关节期望力矩;
根据关节期望力矩、关节实际力矩和进行重力补偿得到的关节补偿力矩计算力矩误差;
结合所述力矩误差和PID控制系数计算得到驱动器控制量;
利用所述驱动器控制量驱动电机进行所述外骨骼控制。
6.根据权利要求4所述的一种下肢外骨骼控制方法,其特征在于,所述随动模式下所述关节期望力矩设置为零。
7.根据权利要求4至6任一项所述的一种下肢外骨骼控制方法,其特征在于,所述重力补偿具体为:根据关节转动角度以及系统补偿系数计算得到关节补偿力矩。
8.一种下肢外骨骼控制装置,其特征在于,包括:
获取用户数据模块:用于获取足底压力传感器采集的用户数据,所述用户数据包括:健侧脚足跟压力数值、患侧脚足跟压力数值、健侧脚足尖压力数值;
判断用户意图模块:用于根据所述用户数据判断用户意图得到用户运动状态,所述用户运动状态包括:第一运动状态、第二运动状态、第三运动状态和第四运动状态;
选择控制模式模块:用于根据所述运动状态选择对应的控制模式,所述控制模式包括:助力模式和随动模式;
外骨骼控制模块:用于根据不同的控制模式发送控制信号到驱动器驱动电机进行所述外骨骼控制。
9.一种下肢外骨骼,其特征在于,利用如权利要求1至7任一项所述的一种下肢外骨骼控制方法进行控制。
10.一种下肢外骨骼控制设备,其特征在于,包括:
至少一个处理器;以及,与所述至少一个处理器通信连接的存储器;
其中,所述处理器通过调用所述存储器中存储的计算机程序,用于执行如权利要求1至7任一项所述的方法。
CN201910981432.8A 2019-10-16 2019-10-16 下肢外骨骼控制方法及装置 Active CN110812127B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910981432.8A CN110812127B (zh) 2019-10-16 2019-10-16 下肢外骨骼控制方法及装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910981432.8A CN110812127B (zh) 2019-10-16 2019-10-16 下肢外骨骼控制方法及装置

Publications (2)

Publication Number Publication Date
CN110812127A true CN110812127A (zh) 2020-02-21
CN110812127B CN110812127B (zh) 2022-01-04

Family

ID=69549544

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910981432.8A Active CN110812127B (zh) 2019-10-16 2019-10-16 下肢外骨骼控制方法及装置

Country Status (1)

Country Link
CN (1) CN110812127B (zh)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112515657A (zh) * 2020-12-02 2021-03-19 吉林大学 一种基于下肢外骨骼神经网络控制的足底压力分析方法
CN113069315A (zh) * 2021-03-24 2021-07-06 上海傅利叶智能科技有限公司 机器人提供助力的方法、装置和康复机器人
CN113855472A (zh) * 2021-08-25 2021-12-31 上海傅利叶智能科技有限公司 用于控制外骨骼机器人的方法、装置和外骨骼机器人
WO2022012491A1 (en) * 2020-07-13 2022-01-20 Angelexo Scientific Co., Ltd Single-lower-limb rehabilitation exoskeleton apparatus and control method
WO2022027914A1 (zh) * 2020-08-07 2022-02-10 深圳市优必选科技股份有限公司 仿人机器人步态规划方法、装置和仿人机器人
CN116922396A (zh) * 2023-09-07 2023-10-24 贵州航天控制技术有限公司 一种外骨骼系统的助力控制方法

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2010148760A (ja) * 2008-12-26 2010-07-08 Toyota Motor Corp 歩行補助装置
CN103431929A (zh) * 2013-08-29 2013-12-11 电子科技大学 一种力量增强型动力外骨骼行走步态感知方法及装置
CN103536424A (zh) * 2013-10-26 2014-01-29 河北工业大学 一种步态康复训练机器人的控制方法
CN103860357A (zh) * 2014-02-25 2014-06-18 北京航空航天大学 一种适用于外骨骼辅助支撑机器人的具有踝关节参数测量的足部装置
CN105798881A (zh) * 2016-04-29 2016-07-27 武汉商学院 助力外骨骼装配体
CN106420280A (zh) * 2016-12-02 2017-02-22 华中科技大学 一种减轻下肢关节负载及测量支撑力的外骨骼装置
CN109223453A (zh) * 2018-09-28 2019-01-18 北京精密机电控制设备研究所 一种基于规律行走步态学习的助力外骨骼装置
CN109549821A (zh) * 2018-12-30 2019-04-02 南京航空航天大学 基于肌电信号和惯导信号融合的外骨骼机器人助力控制系统及方法

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2010148760A (ja) * 2008-12-26 2010-07-08 Toyota Motor Corp 歩行補助装置
CN103431929A (zh) * 2013-08-29 2013-12-11 电子科技大学 一种力量增强型动力外骨骼行走步态感知方法及装置
CN103536424A (zh) * 2013-10-26 2014-01-29 河北工业大学 一种步态康复训练机器人的控制方法
CN103860357A (zh) * 2014-02-25 2014-06-18 北京航空航天大学 一种适用于外骨骼辅助支撑机器人的具有踝关节参数测量的足部装置
CN105798881A (zh) * 2016-04-29 2016-07-27 武汉商学院 助力外骨骼装配体
CN106420280A (zh) * 2016-12-02 2017-02-22 华中科技大学 一种减轻下肢关节负载及测量支撑力的外骨骼装置
CN109223453A (zh) * 2018-09-28 2019-01-18 北京精密机电控制设备研究所 一种基于规律行走步态学习的助力外骨骼装置
CN109549821A (zh) * 2018-12-30 2019-04-02 南京航空航天大学 基于肌电信号和惯导信号融合的外骨骼机器人助力控制系统及方法

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2022012491A1 (en) * 2020-07-13 2022-01-20 Angelexo Scientific Co., Ltd Single-lower-limb rehabilitation exoskeleton apparatus and control method
WO2022027914A1 (zh) * 2020-08-07 2022-02-10 深圳市优必选科技股份有限公司 仿人机器人步态规划方法、装置和仿人机器人
CN112515657A (zh) * 2020-12-02 2021-03-19 吉林大学 一种基于下肢外骨骼神经网络控制的足底压力分析方法
CN113069315A (zh) * 2021-03-24 2021-07-06 上海傅利叶智能科技有限公司 机器人提供助力的方法、装置和康复机器人
CN113069315B (zh) * 2021-03-24 2024-02-20 上海傅利叶智能科技有限公司 机器人提供助力的方法、装置和康复机器人
CN113855472A (zh) * 2021-08-25 2021-12-31 上海傅利叶智能科技有限公司 用于控制外骨骼机器人的方法、装置和外骨骼机器人
CN113855472B (zh) * 2021-08-25 2023-11-28 上海傅利叶智能科技有限公司 用于控制外骨骼机器人的方法、装置和外骨骼机器人
CN116922396A (zh) * 2023-09-07 2023-10-24 贵州航天控制技术有限公司 一种外骨骼系统的助力控制方法
CN116922396B (zh) * 2023-09-07 2023-11-17 贵州航天控制技术有限公司 一种外骨骼系统的助力控制方法

Also Published As

Publication number Publication date
CN110812127B (zh) 2022-01-04

Similar Documents

Publication Publication Date Title
CN110812127B (zh) 下肢外骨骼控制方法及装置
CN105963100B (zh) 按患者运动所需辅助的下肢康复机器人自适应控制方法
CN107753241B (zh) 一种下肢康复治疗智能外骨骼机器人的控制方法
CN109195565B (zh) 步行动作辅助装置
US10123932B2 (en) Motion assist device and motion assist method
CN103040586A (zh) 用于下肢运动训练的外骨骼机器人及其运动控制方法
CN105796286B (zh) 使用气囊传感器的下肢外骨骼机器人控制方法
CN106112985B (zh) 下肢助行机器的外骨骼混合控制系统及方法
CN109223453B (zh) 一种基于规律行走步态学习的助力外骨骼装置
CN110834329B (zh) 外骨骼控制方法及装置
CN111805511B (zh) 一种腿杆长度主动可调的下肢外骨骼系统及其控制方法
CN111067543A (zh) 一种卧式踏步式康复训练机器人的人机交互系统
CN112025682B (zh) 基于肌肉协同理论的柔性外骨骼机器人控制方法及系统
CN112405504B (zh) 外骨骼机器人
CN111898487A (zh) 一种柔性外骨骼系统的人体运动模式实时识别方法
CN110507322A (zh) 一种基于虚拟诱导肌电定量状态评估系统及方法
Martínez et al. A single-joint implementation of flow control: Knee joint walking assistance for individuals with mobility impairment
CN111358667B (zh) 基于关节应力的下肢外骨骼人机交互运动控制的方法
Long et al. Development and validation of a robotic system combining mobile wheelchair and lower extremity exoskeleton
CN201267596Y (zh) 下肢步态矫正器控制装置
CN114903750A (zh) 一种用于截瘫患者的下肢外骨骼控制系统及下肢外骨骼控制方法
CN110292508A (zh) 一种外骨骼康复机器人控制系统
Chen et al. Step length adaptation for walking assistance
WO2023044996A1 (zh) 一种基于步态识别的步行辅助装置控制方法
CN114903747A (zh) 踝关节康复训练装置

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant