CN114948586B - 一种下肢康复机器人的人机***运动学参数辨识及控制方法 - Google Patents

一种下肢康复机器人的人机***运动学参数辨识及控制方法 Download PDF

Info

Publication number
CN114948586B
CN114948586B CN202210470535.XA CN202210470535A CN114948586B CN 114948586 B CN114948586 B CN 114948586B CN 202210470535 A CN202210470535 A CN 202210470535A CN 114948586 B CN114948586 B CN 114948586B
Authority
CN
China
Prior art keywords
lower limb
rehabilitation robot
user
robot
human
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
Application number
CN202210470535.XA
Other languages
English (en)
Other versions
CN114948586A (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.)
Beijing University of Posts and Telecommunications
Original Assignee
Beijing University of Posts and Telecommunications
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 Beijing University of Posts and Telecommunications filed Critical Beijing University of Posts and Telecommunications
Priority to CN202210470535.XA priority Critical patent/CN114948586B/zh
Publication of CN114948586A publication Critical patent/CN114948586A/zh
Application granted granted Critical
Publication of CN114948586B publication Critical patent/CN114948586B/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
    • A61H1/00Apparatus for passive exercising; Vibrating apparatus; Chiropractic devices, e.g. body impacting devices, external devices for briefly extending or aligning unbroken bones
    • A61H1/02Stretching or bending or torsioning apparatus for exercising
    • A61H1/0237Stretching or bending or torsioning apparatus for exercising for the lower limbs
    • 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/11Measuring movement of the entire body or parts thereof, e.g. head or hand tremor, mobility of a limb
    • A61B5/1116Determining posture transitions
    • 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/50Control means thereof
    • 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/50Control means thereof
    • A61H2201/5058Sensors or detectors
    • A61H2201/5069Angle sensors
    • 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
    • A61H2230/00Measuring physical parameters of the user
    • A61H2230/62Posture
    • A61H2230/625Posture used as a control parameter for the apparatus

Landscapes

  • Health & Medical Sciences (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Animal Behavior & Ethology (AREA)
  • Veterinary Medicine (AREA)
  • Public Health (AREA)
  • General Health & Medical Sciences (AREA)
  • Physiology (AREA)
  • Pathology (AREA)
  • Physical Education & Sports Medicine (AREA)
  • Pain & Pain Management (AREA)
  • Epidemiology (AREA)
  • Dentistry (AREA)
  • Oral & Maxillofacial Surgery (AREA)
  • Physics & Mathematics (AREA)
  • Biophysics (AREA)
  • Rehabilitation Therapy (AREA)
  • Engineering & Computer Science (AREA)
  • Biomedical Technology (AREA)
  • Heart & Thoracic Surgery (AREA)
  • Medical Informatics (AREA)
  • Molecular Biology (AREA)
  • Surgery (AREA)
  • Rehabilitation Tools (AREA)

Abstract

本发明提供了一种下肢康复机器人的人机***运动学参数辨识及控制方法,实现了下肢康复机器人使用过程中对使用者下肢参数的自动测量和对使用者下肢状态的控制,包括:利用固定在下肢的倾角传感器读取下肢姿态并控制机器人带动使用者下肢运动,在运动过程中实时采集数据进行人机运动学参数的辨识计算;建立关节空间和训练空间的映射关系;根据建立好的映射关系对将预设好的人体下肢运动轨迹映射为下肢康复机器人的运动轨迹,通过对下肢康复机器人进行位置控制带动使用者下肢进行康复训练,最后通过无模型控制方法控制人体下肢达到指定位置,消除映射关系不准确带来的影响。本发明实现了下肢康复机器人使用过程中对人体下肢姿态的准确控制。

Description

一种下肢康复机器人的人机***运动学参数辨识及控制方法
技术领域
本发明涉及一种下肢康复机器人的人机***运动学参数辨识及控制方法,用于实现下肢康复机器人使用过程中对人机***运动学参数的自动识别和对使用者下肢姿态的控制。
背景技术
21世纪是人口老龄化的时代,人口老龄化带来的最显著影响就是由于身体衰老而出现的肢体运动障碍,肢体运动障碍已经成为老年人必须面对的一大问题。康复训练机器人作为一种新型机器人,近年来吸引着越来越多研究人员的目光。康复训练机器人可以帮助患者完成指定运动功能的恢复训练与传统依赖于治疗师经验的康复训练相比,康复训练机器人可以在节省治疗师时间的同时,帮助不同患者执行对应康复训练并对患者实时状态进行评估。近年来的研究表明,在康复训练机器人的帮助下,患者对应运动机能可以得到很好的恢复。
目前的下肢康复机器人大多是通过控制机器人末端位置带动下肢进行运动,在此过程中并不能控制下肢的具体状态,一旦末端轨迹规划不合理,则可能对肢体造成损伤。因此,对人机***运动学参数进行辨识、建立起训练空间与关节空间的映射关系并以此对下肢状态进行控制具有十分重要的现实意义。
发明内容
针对上述现有技术的不足,本发明的目的在于提供一种下肢康复机器人的人机***运动学参数辨识及控制方法,通过采集人体下肢的状态对人机***运动学参数进行辨识,建立关节空间和训练空间的映射,实现对人体下肢状态的准确控制,以提高康复效果。
为了实现上述目的,本发明提供一种下肢康复机器人的人机***运动学参数辨识及控制方法,所述人机***为使用者髋关节位置固定,使用者足跟与下肢康复机器人末端固定的***,所述人机***运动学参数辨识方法辨识的参数包括人体下肢长度和人体与下肢康复机器人相对位置;所述运动控制方法将人体下肢规划的运动轨迹态映射为下肢康复机器人的运动轨迹,并利用速度和位置伺服控制康复机器人运动;
所述误差补偿方法在下肢康复机器人运动到指定位姿后,读取使用者下肢实际位姿,使用无模型控制方法来消除因映射关系不准确带来的误差,使使用者下肢实际位姿收敛于期望位姿。
所述的下肢康复机器人的人机***运动学参数辨识及控制方法包括如下步骤:
S1.使用者佩戴下肢姿态检测传感器;
S2.控制下肢康复机器人牵引使用者下肢运动,采集机器人及使用者下肢实时位姿数据;
S3.根据S2中采集的数据,人机***运动学参数辨识方法对人体下肢长度和人体与下肢康复机器人相对位置进行辨识;
S4.依据S3中的辨识结果建立人体下肢运动和下肢康复机器人运动之间的映射关系;
S5.根据人体下肢规划的运动轨迹,使用运动控制方法控制康复机器人运动,从而带动使用者下肢沿规划的运动轨迹运动;
S6.依据人体下肢规划的运动轨迹,对实时测量到的下肢姿态使用误差补偿方法进行补偿,使使用者下肢实际位姿收敛至期望位姿,以消除映射误差带来的影响。
所述的人机***运动学参数辨识方法,其特征在于通过控制下肢康复机器人运动牵引使用者下肢运动至数个特定位姿,并使用下肢姿态检测传感器实时检测人体下肢的姿态,得到多个时刻使用者大腿与水平方向所成角度θ,小腿与水平方向所成角度α,建立起使用者下肢末端GR和使用者关节角度的映射关系f1:GR=f1(θ,α)。
同时根据已有的康复机器人末端GH和机器人关节角度θR的映射关系f2:GH=f2H)。
根据机器人滑块与人体下肢末端铰接即GR与GH相重合的关系,建立起康复机器人关节空间和训练空间的映射关系f3:θR=f3(θ,α)。
对采集得到的康复机器人和使用者的关节角度根据上述映射关系进行求解即可得到使用者大腿长度、小腿长度以及使用者与下肢康复机器人的相对位置。
通过采用上述技术方案,本发明具有如下有益效果:
本发明提供了一种下肢康复机器人的人机***运动学参数辨识及控制方法,实现了下肢康复机器人使用过程中对使用者下肢参数的自动测量和对使用者下肢状态的控制,包括:利用固定在下肢的倾角传感器读取下肢姿态并控制机器人带动人体下肢达到预定的数个姿态,根据目标姿态下机器人的姿态数据进行人机***运动学参数的辨识计算;建立关节空间和训练空间的映射关系;根据建立好的映射关系对人体下肢姿态进行控制并通过无模型方法对位置误差进行补偿。本发明实现了下肢康复机器人使用过程中对人体下肢姿态的控制,可以有效避免康复过程中造成的损伤并提高康复效果。
附图说明
为了更清楚地说明本发明实施例的技术方案,下面将对实施例中所需要的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其它的附图。
图1是本发明的流程图。
图2是人机***运动学参数辨识示意图。
图3是运动控制方法。
图4是误差补偿方法。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
在本发明使用的术语是仅仅出于描述特定实施例的目的,而非旨在限制本公开。在本公开和所附权利要求书中所使用的单数形式的“一种”、“所述”和“该”也旨在包括多数形式,除非上下文清楚地表示其他含义。还应当理解,本文中使用的术语“和/或”是指并包含一个或多个相关联的列出项目的任何或所有可能组合。
本文将以发明专利:ZL201910810162.4中的多功能训练轮椅为例说明本发明的实施方法。
如图2所示,1、2分别为固定在使用者大腿和小腿上的传感器、3为多功能训练轮椅坐垫、4为腿部挡板、5为滑块和踏板的连接体。
使用者坐在下肢康复机器人坐垫OA上,使用者髋关节I固定,足跟G与康复机器人滑块相铰接。
利用固定在腿部挡板AD上的倾角传感器读取下肢康复机器人腿部挡板与竖直面所成的角度θ1
利用固定在丝杠上的编码器测量滑块沿腿部挡板方向的位移DG,该长度记为l4
根据θ1和l4即可确定机器人滑块即使用者足跟G的实时位置。
利用固定在人体大腿IH和小腿HG的倾角传感器1和2读取大腿和小腿的实时倾角,如图二所示。
控制康复机器人运动牵引使用者下肢运动的过程中,实时记录使用者大腿与水平方向所成角度θ,小腿与水平方向所成角度α以及在此下肢姿态下足跟G位置(Gx,Gy),利用几何关系建立方程。
Figure GDA0004137418650000051
其中l1为坐标系原点O到使用者髋关节I的距离,l2和l3分别为人体大腿IH和小腿HG的长度。利用不同位置下建立的多组方程对所需运动需参数进行求解,将所得的结果取平均值来减小误差。
以下称康复机器人的滑块位移l4和腿部挡板AD与竖直面所成的角度θ1为关节空间θR,大腿和水平面的夹角θ和小腿与水平面间的夹角α为训练空间θH,GH为人体下肢末端的位置,GR为机器人滑块的位置。
建立起机器人滑块和关节空间的映射关系:
GR=f1R)
建立起人体下肢末端和训练空间的映射关系
GH=f2H)
根据机器人滑块与人体下肢末端铰接即GR与GH相重合的关系,建立起康复机器人关节空间和训练空间的映射关系。
θH=f2 -1(f1R))=f3R)
其中,f3为从关节空间到训练空间的映射关系。
该映射关系为训练空间到关节空间位置级的映射关系,求导后即可得到速度级的映射关系,至此,期望的人体下肢姿态或运动即可根据此映射关系映射到关节空间。
将人体下肢规划的运动轨迹映射到关节空间,得到下肢康复机器人的期望运动轨迹。
将下肢康复机器人的期望轨迹分解至各个关节,将关节的期望位置与关节的实际位置作差得到关节的位置误差,将其经过比例环节得到期望速度V′,通过实时采集关节的速度得到各关节的实际速度V,将期望速度和实际速度作差得到各个关节的速度误差VE
将关节的速度误差经过比例积分环节得到调节系数μ,将该调节系数给到下肢康复机器人驱动器,驱动器根据传递来的调节系数进行驱动,控制康复机器人运动,牵引使用者下肢进行康复运动。
该部分的控制框图如图3所示,首先将人体下肢规划的运动轨迹映射为下肢康复机器人的期望运动轨迹,接下来通过位置环和速度环两环控制各个关节,使其达到目标角度,使下肢康复机器人到达期望姿态。
在下肢康复机器人达到期望姿态后,测量此时使用者下肢位姿,并利用误差补偿方法补偿因映射关系不准确而产生的实际下肢姿态和期望下肢姿态间的误差,使使用者下肢实际位姿收敛至期望位姿。
误差补偿方法如图4所示,在完成对下肢康复机器人控制的基础上,使用无模型控制方法对使用者下肢姿态进行控制,进一步提高控制的精度。
虽然以上描述了本发明的具体实施方式,但是本领域的技术人员应当理解,这仅是举例说明,本发明的保护范围是由所附权利要求书限定的。本领域的技术人员在不背离本发明的原理和实质的前提下,可以对这些实施方式做出多种变更或修改,但这些变更和修改均落入本发明的保护范围。
本说明书中未作详细描述的内容属于本领域技术人员的公知技术。

Claims (1)

1.一种下肢康复机器人的人机***运动学参数辨识方法,其特征在于所述人机***运动学参数辨识方法辨识的参数包括人体下肢长度和人体与下肢康复机器人相对位置;所述的下肢康复机器人的人机***运动学参数辨识方法包括如下步骤,其中下肢康复机器人包括固定在使用者大腿和小腿上的传感器,下肢康复机器人坐垫、腿部挡板以及滑块和踏板:
使用者坐在下肢康复机器人坐垫上,使用者髋关节固定,足跟与康复机器人滑块相铰接;利用固定在腿部挡板上的倾角传感器读取下肢康复机器人腿部挡板与竖直面所成的角度θ1;利用固定在丝杠上的编码器测量滑块沿腿部挡板方向的位移l4;根据θ1和l4即可确定机器人滑块即使用者足跟的实时位置;利用固定在人体大腿IH和小腿HG的倾角传感器1和2实时记录使用者大腿与水平方向所成角度θ,小腿与水平方向所成角度α以及在此下肢姿态下足跟位置(Gx,Gy),利用几何关系建立方程:
Figure FDA0004137418640000011
其中l1为坐标系原点O到使用者髋关节I的距离,l2和l3分别为人体大腿IH和小腿HG的长度;根据如上方程组,利用不同位置下建立的多组方程对所需运动需参数进行求解,将所得的结果取平均值来减小误差;康复机器人的滑块位移l4和腿部挡板AD与竖直面所成的角度θ1为关节空间θR,大腿和水平面的夹角θ和小腿与水平面间的夹角α为训练空间θH,GH为人体下肢末端的位置,GR为机器人滑块的位置,可建立起机器人滑块位置和关节空间的映射关系f1
GR=f1R)
可建立起人体下肢末端位置和训练空间的映射关系f2
GH=f2H)
根据机器人滑块与人体下肢末端铰接即GR与GH相重合的关系,建立起康复机器人关节空间和训练空间的映射关系:
θH=f2 -1(f1R))=f3R)
式中f3即为从关节空间到训练空间的映射关系。
CN202210470535.XA 2022-04-28 2022-04-28 一种下肢康复机器人的人机***运动学参数辨识及控制方法 Active CN114948586B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210470535.XA CN114948586B (zh) 2022-04-28 2022-04-28 一种下肢康复机器人的人机***运动学参数辨识及控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210470535.XA CN114948586B (zh) 2022-04-28 2022-04-28 一种下肢康复机器人的人机***运动学参数辨识及控制方法

Publications (2)

Publication Number Publication Date
CN114948586A CN114948586A (zh) 2022-08-30
CN114948586B true CN114948586B (zh) 2023-04-28

Family

ID=82978879

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210470535.XA Active CN114948586B (zh) 2022-04-28 2022-04-28 一种下肢康复机器人的人机***运动学参数辨识及控制方法

Country Status (1)

Country Link
CN (1) CN114948586B (zh)

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106777421A (zh) * 2015-11-20 2017-05-31 哈尔滨工大天才智能科技有限公司 一种机器人模型建立方法
CN108056898A (zh) * 2017-12-21 2018-05-22 东南大学 基于下肢连杆模型和力觉信息的虚拟场景交互式康复训练机器人及其控制方法
CN108785997A (zh) * 2018-05-30 2018-11-13 燕山大学 一种基于变导纳的下肢康复机器人柔顺控制方法
CN110613561A (zh) * 2019-08-29 2019-12-27 北京邮电大学 一种多功能训练轮椅
CN110739040A (zh) * 2019-08-29 2020-01-31 北京邮电大学 一种上下肢康复评定训练***
CN111759672A (zh) * 2020-07-30 2020-10-13 中国科学院合肥物质科学研究院 一种基于下肢康复机器人的下肢康复镜像训练方法
CN113189865A (zh) * 2021-01-27 2021-07-30 上海电气智能康复医疗科技有限公司 基于动力学参数辨识的康复机器人控制方法、***、设备及介质

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
TWI354550B (en) * 2008-05-09 2011-12-21 Univ Nat Taiwan Rehabilitating and training device and controlling

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106777421A (zh) * 2015-11-20 2017-05-31 哈尔滨工大天才智能科技有限公司 一种机器人模型建立方法
CN108056898A (zh) * 2017-12-21 2018-05-22 东南大学 基于下肢连杆模型和力觉信息的虚拟场景交互式康复训练机器人及其控制方法
CN108785997A (zh) * 2018-05-30 2018-11-13 燕山大学 一种基于变导纳的下肢康复机器人柔顺控制方法
CN110613561A (zh) * 2019-08-29 2019-12-27 北京邮电大学 一种多功能训练轮椅
CN110739040A (zh) * 2019-08-29 2020-01-31 北京邮电大学 一种上下肢康复评定训练***
CN111759672A (zh) * 2020-07-30 2020-10-13 中国科学院合肥物质科学研究院 一种基于下肢康复机器人的下肢康复镜像训练方法
CN113189865A (zh) * 2021-01-27 2021-07-30 上海电气智能康复医疗科技有限公司 基于动力学参数辨识的康复机器人控制方法、***、设备及介质

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
张延恒等.移动式康复训练机器人及下肢康复运动分析.华中科技大学学报( 自然科学版).2021,第49卷(第3期),第6-11页. *
范泽峰 ; 李娟 ; 李伟达 ; 孙立宁 ; .多连杆式下肢康复训练机器人结构优化与仿真.机械传动.2015,(第11期),第67-71页. *

Also Published As

Publication number Publication date
CN114948586A (zh) 2022-08-30

Similar Documents

Publication Publication Date Title
CN108785997B (zh) 一种基于变导纳的下肢康复机器人柔顺控制方法
WO2021243918A1 (zh) 上肢功能评估装置与方法及上肢康复训练***与方法
CN109549821B (zh) 基于肌电和惯导信号融合的外骨骼机器人助力控制***及方法
CN111604890B (zh) 一种适用于外骨骼机器人的运动控制方法
CN109394476B (zh) 脑肌信息自动意图识别与上肢智能控制方法及***
CN108309689B (zh) 一种基于外骨骼机器人的渐进式康复训练方法
CN108970014B (zh) 一种适用于多个关节的进阶式康复机器人及其康复训练方法
CN112220650B (zh) 一种外骨骼机器人对侧训练用在线步态生成控制***
CN111390877B (zh) 一种外骨骼装置及外骨骼变导纳控制方法
CN113977602A (zh) 一种力反馈末端夹持器导纳控制方法
CN106074073B (zh) 一种下肢康复机器人的控制***及康复训练策略
CN208591274U (zh) 一种用于下肢康复治疗的智能医疗机器人
CN109692104B (zh) 医疗康复外骨骼交互式同步控制***及方法
CN109199783A (zh) 一种利用sEMG来控制踝关节康复设备刚度的控制方法
CN112842824B (zh) 一种用于下肢康复恢复的训练方法
CN111759672A (zh) 一种基于下肢康复机器人的下肢康复镜像训练方法
Guidali et al. Estimating the patient's contribution during robot-assisted therapy
CN109223453A (zh) 一种基于规律行走步态学习的助力外骨骼装置
Li et al. A human joint torque estimation method for elbow exoskeleton control
CN112472531A (zh) 面向医疗复健和助力行走的下肢外骨骼机器人步态平稳算法
CN110400618B (zh) 一种基于人体运动结构特征的三维步态生成方法
CN114948586B (zh) 一种下肢康复机器人的人机***运动学参数辨识及控制方法
CN113197754B (zh) 一种上肢外骨骼康复机器人***及方法
CN114432663A (zh) 一种六自由度上肢康复机器人及其重力补偿方法
CN110265112B (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