CN111904795B - 一种结合轨迹规划的康复机器人变阻抗控制方法 - Google Patents
一种结合轨迹规划的康复机器人变阻抗控制方法 Download PDFInfo
- Publication number
- CN111904795B CN111904795B CN202010888789.4A CN202010888789A CN111904795B CN 111904795 B CN111904795 B CN 111904795B CN 202010888789 A CN202010888789 A CN 202010888789A CN 111904795 B CN111904795 B CN 111904795B
- Authority
- CN
- China
- Prior art keywords
- motion
- damping
- variable impedance
- rehabilitation robot
- trajectory
- 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
- 238000000034 method Methods 0.000 title claims abstract description 54
- 238000013016 damping Methods 0.000 claims abstract description 48
- 238000012549 training Methods 0.000 claims abstract description 36
- 241000282414 Homo sapiens Species 0.000 claims abstract description 19
- 230000006378 damage Effects 0.000 claims abstract description 12
- 208000027418 Wounds and injury Diseases 0.000 claims abstract description 7
- 208000014674 injury Diseases 0.000 claims abstract description 7
- 239000012636 effector Substances 0.000 claims description 17
- 230000008569 process Effects 0.000 claims description 14
- 230000008859 change Effects 0.000 claims description 10
- 230000001133 acceleration Effects 0.000 claims description 7
- 230000036461 convulsion Effects 0.000 claims description 6
- 208000025978 Athletic injury Diseases 0.000 claims description 2
- 238000012360 testing method Methods 0.000 claims description 2
- 230000006735 deficit Effects 0.000 claims 1
- 230000002452 interceptive effect Effects 0.000 abstract description 7
- 230000008447 perception Effects 0.000 abstract description 5
- 230000002829 reductive effect Effects 0.000 abstract description 4
- 238000013461 design Methods 0.000 abstract description 3
- 230000006870 function Effects 0.000 description 26
- 230000003993 interaction Effects 0.000 description 10
- 239000011159 matrix material Substances 0.000 description 7
- 238000005457 optimization Methods 0.000 description 7
- 210000003169 central nervous system Anatomy 0.000 description 4
- 238000011217 control strategy Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 210000001364 upper extremity Anatomy 0.000 description 3
- 238000013459 approach Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 2
- 230000009133 cooperative interaction Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 238000012935 Averaging Methods 0.000 description 1
- 206010023230 Joint stiffness Diseases 0.000 description 1
- 241000940612 Medina Species 0.000 description 1
- 230000003044 adaptive effect Effects 0.000 description 1
- 150000001875 compounds Chemical class 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000000670 limiting effect Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000036961 partial effect Effects 0.000 description 1
- 230000036962 time dependent Effects 0.000 description 1
Images
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/0274—Stretching or bending or torsioning apparatus for exercising for the upper limbs
-
- 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/0218—Drawing-out devices
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/11—Complex mathematical operations for solving equations, e.g. nonlinear equations, general mathematical optimization problems
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/15—Correlation function computation including computation of convolution operations
-
- G—PHYSICS
- G16—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR SPECIFIC APPLICATION FIELDS
- G16H—HEALTHCARE INFORMATICS, i.e. INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR THE HANDLING OR PROCESSING OF MEDICAL OR HEALTHCARE DATA
- G16H20/00—ICT specially adapted for therapies or health-improving plans, e.g. for handling prescriptions, for steering therapy or for monitoring patient compliance
- G16H20/30—ICT specially adapted for therapies or health-improving plans, e.g. for handling prescriptions, for steering therapy or for monitoring patient compliance relating to physical therapies or activities, e.g. physiotherapy, acupressure or exercising
-
- G—PHYSICS
- G16—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR SPECIFIC APPLICATION FIELDS
- G16H—HEALTHCARE INFORMATICS, i.e. INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR THE HANDLING OR PROCESSING OF MEDICAL OR HEALTHCARE DATA
- G16H40/00—ICT specially adapted for the management or administration of healthcare resources or facilities; ICT specially adapted for the management or operation of medical equipment or devices
- G16H40/60—ICT specially adapted for the management or administration of healthcare resources or facilities; ICT specially adapted for the management or operation of medical equipment or devices for the operation of medical equipment or devices
-
- 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/1657—Movement of interface, i.e. force application means
- A61H2201/1659—Free spatial automatic movement of interface within a working area, e.g. Robot
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Pure & Applied Mathematics (AREA)
- Public Health (AREA)
- Data Mining & Analysis (AREA)
- General Health & Medical Sciences (AREA)
- Epidemiology (AREA)
- Theoretical Computer Science (AREA)
- Computational Mathematics (AREA)
- Life Sciences & Earth Sciences (AREA)
- Physical Education & Sports Medicine (AREA)
- Algebra (AREA)
- Rehabilitation Therapy (AREA)
- General Engineering & Computer Science (AREA)
- Software Systems (AREA)
- Databases & Information Systems (AREA)
- Medical Informatics (AREA)
- Primary Health Care (AREA)
- Veterinary Medicine (AREA)
- Biomedical Technology (AREA)
- Animal Behavior & Ethology (AREA)
- Pain & Pain Management (AREA)
- Operations Research (AREA)
- General Business, Economics & Management (AREA)
- Biophysics (AREA)
- Business, Economics & Management (AREA)
- Computing Systems (AREA)
- Manipulator (AREA)
- Rehabilitation Tools (AREA)
Abstract
本发明提供了一种结合轨迹规划的康复机器人变阻抗控制方法,一方面,实时根据交互任务中的跟踪误差、用户的感知位置与终点距离差,动态地调整康复机器人变阻抗控制器中的阻尼值和刚度值,有效地提高了变阻抗控制器的性能表现,同时充分考虑了用户在交互任务中的运动状态和运动意图,简化了变阻抗控制器设计的复杂性,提高了变阻抗控制器的适用性;另一方面,将符合人体运动原理的轨迹规划引入到康复机器人的控制中,不仅有助于获得平滑的运动轨迹,减少运动冲击,而且可以针对不同的运动损伤患者个性化调整,提高了顺应性和适用性,更有利于实际训练康复。
Description
技术领域
本发明涉及康复机器人控制技术领域,更具体的,涉及一种结合轨迹规划的康复机器人变阻抗控制方法。
背景技术
由于人类的行为是不可预测的,这要求康复机器人在辅助患者完成康复训练时,能够动态地适应人机交互行为。人类拥有非常有效的运动控制***和生物执行器,能安全、高效、灵活地处理交互任务。人类在运动过程中的重要特征包括可变的阻抗参数和平滑的运动轨迹,这在人类的运动控制中占据重要地位。因此,若机器人的控制方法采用这种类人的控制方式,将获得更好的人机交互性能。机器人在确定或不确定的环境下完成人机交互任务时,采用变阻抗控制可以保证机器人的快速响应,满足顺应性要求,确保运动的灵活性。同时,参考人类的运动轨迹,使用轨迹规划生成合适、平滑的类人轨迹,将其作为机器人控制的输入,可以提高用户的感知舒适度,使康复训练变得更有效、安全,而且可以减少对机器人的冲击。
常见的机器人阻抗控制策略,多采用固定阻抗参数,在康复机器人领域这些控制方法在人机交互任务中具有一定弊端。当***因未知干扰而迅速变化时,固定参数式的阻抗控制器难以达到预期的性能。此外,在复杂环境或复杂任务情况下进行人机协作任务时,基于固定阻抗参数的控制***可能会变得不稳定,增大人机协作的难度。实际的康复训练对机器人的柔顺性、平稳性、安全性和灵活性有更高的性能要求,这需要实现机器人的变阻抗控制。具有可变阻抗的机器人能够在执行交互任务时动态地调整其机械结构的阻抗参数,如阻尼、刚度和惯性,以便能够动态调整行为。目前许多研究人员已经在机器人领域应用变阻抗控制策略,其中大多数是利用交互任务中测得的运动学或者动力学信息改变阻抗参数。Ficuciello等人根据机器人末端执行器在操作空间下的实际速度改变机器人的阻尼值,且速度以指数形式变化。Stegall等人根据末端执行器的实时位置跟踪误差动态调整阻尼值的大小。Hsieh等人利用交互任务中用户施加的力来改变自适应控制中的阻尼参数。需要注意的是,动力学信号中可能存在高频噪声干扰,从而影响阻抗值的变化。也有一些文献直接使用按固定规律变化的阻抗值,如Dong等人使用以给定正弦曲线变化的期望阻尼和刚度值。总的来说,现在多数变阻抗控制参数整定方式虽然能够保证一定的柔顺度和控制精度,但只适应于速度较低的场合,不适应于轻型机器人,如绳牵引康复机器人,不能体现用户的运动状态,易受机器人结构和应用环境的影响,而且参数整定复杂,不利于实际应用。
可以料想,与人类表现相似的机器人更适应人机交互任务,因此了解人类在运动过程中的阻抗变化尤为重要。这可以帮助获得阻抗参数的变化范围,并且应用到人机交互中的人类运动行为建模中,可以获得更加柔顺的机器人控制。Erden等人在运动过程中引入外力扰动,使用一个质量-阻尼弹簧模型拟合人体手臂的运动响应,获得了手臂的阻抗均值,同时实验结果表明阻抗参数与外力和手臂的感知位置有关。Medina等人证明手臂的惯性值可在小范围内变化,而阻尼值变化范围较大,且关节刚度和阻尼值有正相关关系。综合考虑上述的人类手臂阻抗变化规律,我们发现现有机器人的变阻抗控制策略除了应用环境受限,同时也没有体现出人体的运动感知位置和实时运动状态的变化。我们假设当手臂靠近目标点时,也即根据手臂的感知位置,手臂的阻抗增大以保证稳定且准确地到达目标点。此外,人类的中枢神经***会趋向于以减小跟踪误差为目标来控制手臂进行跟踪任务。在设计康复机器人的变阻抗控制策略时,考虑人体运动阻抗规律,设计类人的变阻抗控制器,将提高人机交互的柔顺性和舒适性。
康复机器人使用平滑的运动轨迹作为训练***的输入,可以提高用户的舒适度,因此,轨迹规划也至关重要。轨迹规划是用于末端执行器或关节的合理且优化的运动路径。目前,经常使用的轨迹规划方法,一是采取多项式等函数对选定的路径节点进行插值,使其满足特定的位置、速度或者加速度的显式约束;一种是数值法,即考虑一些优化指标来建立目标函数,然后计算目标函数的最大值或最小值来获取最优轨迹。Ben等人在轨迹节点之间利用二分法查找最优速度,以最小化运动时间为目标,获得线性多轴任意阶平滑轨迹。就数值法而言,最早Flash等人使用加加速度的平方的积分作为目标函数,成功地建立了人体手臂的平滑运动轨迹,称为最小化冲击轨迹。后来大多数机器人的轨迹规划方法都是在此基础上的进一步发展。Rafeal等人在不改变最小化冲击轨迹的目标函数的情况下,使用变分法获得最优轨迹。Gasparetto等人在最小化冲击轨迹的目标函数的基础上增加运动时间相关项,来进一步优化运动时间。Aurelio等人基于区间分析、分支定界方法,以最小化最大加加速度为目标,使用三次样条曲线拟合最优轨迹。
最近的研究有涉及人类中枢神经***如何控制产生平滑的运动轨迹。Ozgur等人考虑双层优化问题探讨中枢神经***的控制方式,使用不同的代价函数模型,包括分别使用加加速度项、速度项作为目标函数模型,相关结果证明中枢神经***使用多个内部模型来控制完成到达运动。目前,机器人常用的一种平滑轨迹是最小化冲击轨迹,许多涉及到目标函数的方法都是在最小化冲击轨迹上进行完善或调整。而且,许多机器人轨迹规划方法的目标函数较单一,不如多重内部模型控制效果好。对于康复训练任务中的目标轨迹,目前多数方法没有考虑到不同患者的运动损伤程度,没有把康复训练目标,也即健康人的运动轨迹,列入参考范围。
发明内容
本发明为克服现有的轨迹规划方法存在目标函数较单一,不如多重内部模型控制效果好的技术缺陷,提供一种结合轨迹规划的康复机器人变阻抗控制方法。
为解决上述技术问题,本发明的技术方案如下:
一种结合轨迹规划的康复机器人变阻抗控制方法,包括以下步骤:
S1:采集健康人的运动数据作为参考轨迹模板,为不同运动损伤的用户制定目标轨迹,选定目标轨迹规划目标函数中的参数,最小化目标函数,最小化目标函数具体表示为:
式中,T为运动时间,xr0为参考轨迹模板,xr,分别代表目标轨迹的位置、速度、加速度,γ为常数,用于调节目标轨迹与参考轨迹模板相似程度,λ也是常数,用于调节目标轨迹的速度值,γ和λ使获得的目标轨迹适用于不同运动损伤的患者和不同的训练类型;
S2:用户根据获得的目标轨迹进行康复训练,实时采集用户的运动学信号;
S3:根据用户距离终点的实时位置差值和实时跟踪误差调节阻尼参数;
S4:根据步骤S3获得的阻尼参数,整定实时刚度参数;
S5:将得到的阻尼和刚度值作为康复机器人的阻抗控制器参数,获得相应电机的驱动控制量,完成康复机器人的变阻抗控制。
其中,在所述步骤S1中,所述参考轨迹模板的获取过程具体为:
为不同运动损伤的用户指定合适的运动难度,包括考虑用户训练轨迹的长度和运动时间,测得多组设定路径长度下健康人的最适训练时间,同时测量用户健侧的运动数据;在获取足够多的运动数据后,将运动数据在运动时间和运动长度上进行取均值、归一化,然后整合至用户个性化训练任务的运动时间和长度,获得参考轨迹模板。
其中,在所述步骤S1中,所述制定目标轨迹过程具体为:
用户先进行训练任务测试,根据运动情况评估用户运动损伤程度,再结合训练任务的类型,选择合理的目标函数中的常数γ和λ,代入参考轨迹模板中,获取最优化目标函数。
其中,在所述步骤S3中,所述阻尼参数具体表示为:
式中,Δx=|x-xf|为笛卡尔空间内实际位置距离期望轨迹终点处的距离差,xf是期望运动轨迹的终点,e=|x-xr|为跟踪误差,也即笛卡尔空间内实时实际位置与期望轨迹位置的绝对差值,x是机器人末端执行器的实际位置,xr是平滑的、优化的期望运动轨迹,Kx是与Δx相关的常数,用于调节人体实际感知位置因素在阻尼变化中所占的比例,x0,Kx0用于具体调节感知位置项阻尼曲线的变化趋势,Ke是与e有关的常数,用于调节跟踪误差因素在阻尼变化中所占的比例,e0,Ke0用于具体调节跟踪误差项阻尼曲线的变化趋势。
其中,所述阻尼参数调整方法具体为:
将用户距离终点的位置差值和跟踪误差作为调整阻尼的变量,并且将两者以非线性变化的形式实时改变阻尼值,使得训练过程中跟踪误差越大,阻尼值越小,离终点的位置差值越近,阻尼值越大。
其中,所述步骤S4具体为:根据刚度与阻尼存在正相关关系的特性,给定正相关系数β,代入K=βB,完成实时刚度参数的整定。
其中,在所述步骤S5中,需要现将阻尼参数、刚度参数通过康复机器人***的动力学模型转换成相应的电机控制量。
其中,在采集健康人的运动数据前,为不同运动损伤的用户指定平滑的期望训练轨迹,用于确定参考轨迹模板及运动约束。
其中,所述运动约束包括速度约束和加速度约束。
与现有技术相比,本发明技术方案的有益效果是:
本发明提供了一种结合轨迹规划的康复机器人变阻抗控制方法,一方面,实时根据交互任务中的跟踪误差、用户的感知位置与终点距离差,动态地调整康复机器人变阻抗控制器中的阻尼值和刚度值,有效地提高了变阻抗控制器的性能表现,同时充分考虑了用户在交互任务中的运动状态和运动意图,简化了变阻抗控制器设计的复杂性,提高了变阻抗控制器的适用性;另一方面,将符合人体运动原理的轨迹规划引入到康复机器人的控制中,不仅有助于获得平滑的运动轨迹,减少运动冲击,而且可以针对不同的运动损伤患者个性化调整,提高了顺应性和适用性,更有利于实际训练康复。
附图说明
图1为本发明所述方法流程示意图;
图2为本发明一实施例提供的结合轨迹规划的康复机器人变阻抗控制方法的原理图;
图3为本发明一实施例提供的绳牵引康复机器人的主体框架图。
具体实施方式
附图仅用于示例性说明,不能理解为对本专利的限制;
为了更好说明本实施例,附图某些部件会有省略、放大或缩小,并不代表实际产品的尺寸;
对于本领域技术人员来说,附图中某些公知结构及其说明可能省略是可以理解的。
下面结合附图和实施例对本发明的技术方案做进一步的说明。
实施例1
如图1、图2所示,本发明实施例提供了一种结合轨迹规划的康复机器人变阻抗控制方法,具体包括以下步骤:
在进行康复训练任务之前,测量健康人在一定运动时间内的,运动足够长度的上肢运动数据,同时,保证每组运动在起始点和终点满足设定的运动约束,如起始点和终点处的速度和加速度均为零,测量多组数据,取平均,之后在运动时间和运动长度上将数据归一化,然后扩充到整个康复训练任务中的运动时间和运动长度,即可获得参考轨迹模板;
由于每个用户的运动情况不同,根据用户运动损伤的程度,选择合理的目标函数中的常数γ,λ,如希望训练轨迹接近健康轨迹,运动损伤程度较低,则可以分别选择较高的γ,λ。以一维轨迹为例,计算最小化目标函数:
获得个性化的、平滑的最优期望训练轨迹xr。
对于n自由度机器人在操作空间的动力学方程可表示为:
其中,X,分别为操作空间广义位置坐标、速度、加速度。Rn为n维实数集,n为正整数。M(X),G(X)分别是***的惯性矩阵、离心力和柯氏系数矩阵以及重力矩阵,F,Ff分别是控制***的输入控制力和外力(包括摩擦力和干扰)。
在康复机器人的变阻抗控制器的设计中,期望的阻抗动力学方程可表示为:
将获得的期望训练轨迹输入到具有变阻抗控制的康复机器人***中,用户进行上肢康复训练任务,并且在任务过程中实时采集用户上肢的运动学信号,作为反馈,实时调节康复机器人的阻抗参数,获得新的阻尼、刚度参数:
K(t)=βB(t) (5)
将获得的实时阻尼、刚度参数输入到机器人控制***中,作为机器人***中电机的控制量,进一步控制相应的电机工作,带动用户完成相应的协同交互任务。
本实施例提供了一种结合轨迹规划的康复机器人变阻抗控制方法,不仅可以通过轨迹规划为不同的患者个性化制定合适的目标训练轨迹,以健康人的运动数据作为轨迹规划的模板,制定出最优的平滑轨迹,保证人机交互任务中用户的舒适性和安全性,还通过考虑人机交互任务中用户的感知位置和跟踪误差,实时调节控制器的阻抗参数,实现类人的变阻抗控制,提高***的顺应性和稳定性。
实施例2
更具体的,下面将对实施例1中步骤:将获得的实时阻尼、刚度参数输入到机器人***中,作为机器人***中电机的控制量,进一步控制相应的电机工作,带动用户完成相应的协同交互任务,进行具体阐述:
以3根绳子的绳牵引康复机器人为例,下面具体进行绳牵引康复机器人***的动力学分析。如图3所示,该机器人***坐标系的原点定义为该机器人框架几何结构在地面处某条边框的中点,框架中每个滑轮的等效位置可以预先测量获得,此外,将末端执行器等效为一个点,可以通过运动捕捉***采集末端执行器上的标记来获得末端执行器的坐标位置。而且,在本实施例中,假定末端执行器始终是在机器人的工作空间内运动,且末端执行器具有一定重量能够保持每根绳子上的张力大于零。因此,每根绳子的长度,也即末端执行器和滑轮之间的距离,可以用以下公式计算得到:
式中,(x,y,z)表示末端执行器的笛卡尔坐标位置,i表示1至绳子总数目的整数值,(xi,yi,zi)表示与第i根绳子相连接的滑轮的坐标位置。
通过测量,每个滑轮的具体坐标为:
式中,a是|OA|的长度,b是|AB|的长度,c是|AC|的长度。因此,可以获得每根绳子的实时长度:
将每根绳子的长度分别对时间进行求导,可以得到:
因此,末端执行器在笛卡尔空间内的控制量u与每根绳子上的驱动力矩τ之间的关系是:
[ux,uy,uz]=-JTτ (11)
本实施例采用变阻抗控制器跟踪期望的训练轨迹,末端执行器在操作空间下的控制量u表述如下:
式中,
其中,e为末端执行器的位置跟踪误差,m为末端执行器的质量,bx,by,bz分别为三个维度上控制器时变的阻尼系数,分别是根据三个维度的运动学信息,然后利用上述阻尼参数整定方法获得,kx,ky,kz分别为三个维度上控制器时变的刚度系数,分别是根据三个维度上的阻尼值利用上述刚度参数整定方法获得的。
因此,每根绳子的驱动力τ可以计算得到为:
最终得到的绳子的驱动力也就是电机的控制量,从而实现将获得的实时阻尼、刚度参数输入到机器人***中,作为机器人***中电机的控制量,进一步控制相应的电机工作。
实施例3
更具体的,下面将对实施例1中步骤:计算最小化目标函数,以一维轨迹为例具体阐述根据目标函数求解最优轨迹:
以无约束优化目标函数为例具体阐述优化过程:
对于任何一个函数r(t),在时间段0≤t≤T,目标函数可以表示为:
在此处,
假设存在一个极值,此时,r(t)是下列Euler-Poisson方程的解:
方程(18)的解满足:
得到方程(19)的隐式解具有以下形式:
r(t)=r0(t)+C1*exp(t*R(1))+C2*exp(t*R(2))+C3*exp(t*R(3))+C4*exp(t*R(4))+C5*exp(t*R(5))+C6*exp(t*R(6)) (20)
其中,R(i),i=1,2,…6分别是引入的方程z^6-λ*z-γ对z求解的6个根,Ci,i=1,2,…6分别是引入方程解的常数。
对于目标函数(15),也可以只采用某一部分作为优化目标,利用上述优化方法也可以获得最优解。
接下来举例阐述目标函数部分项I1(r)的优化过程:
根据方程(16),目标方程I1(r)可以重新表述为:
可以导出方程:
将方程(23)代入方程(24),可以得到方程的解满足以下形式:
r(6)(t)=γ(r(t)-r0(t)) (25)
因此,方程(25)的通解具有以下形式:
r(t)=r0(t)+C1*exp(θ*t)+C2*exp(-θ*t)+C3*exp(θ*t*(ε+1/2))+C4*exp(θ*t*(ε-1/2))+C5*exp(-θ*t*(ε+1/2))+C6*exp(-θ*t*(ε-1/2)) (26)
θ=γ^(1/6),ε=(3^(1/2)*k)/2 (27)
其中,k,Ci,i=1,2,…6分别是方程求解引入的常数。
因此,可以获得以健康人运动数据为模板,个性化的训练轨迹。这将提高用户康复训练过程中的舒适度和适用性,更有利于患者康复训练。
显然,本发明的上述实施例仅仅是为清楚地说明本发明所作的举例,而并非是对本发明的实施方式的限定。对于所属领域的普通技术人员来说,在上述说明的基础上还可以做出其它不同形式的变化或变动。这里无需也无法对所有的实施方式予以穷举。凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明权利要求的保护范围之内。
Claims (9)
1.一种结合轨迹规划的康复机器人变阻抗控制方法,其特征在于,包括以下步骤:
S1:采集健康人的运动数据作为参考轨迹模板,为不同运动损伤的用户制定目标轨迹,选定目标轨迹规划目标函数中的参数,最小化目标函数,最小化目标函数具体表示为:
式中,T为运动时间,xr0为参考轨迹模板,xr,分别代表目标轨迹的位置、速度、加加速度,γ为常数,用于调节目标轨迹与参考轨迹模板相似程度,λ也是常数,用于调节目标轨迹的速度值,γ和λ使获得的目标轨迹适用于不同运动损伤的患者和不同的训练类型;
S2:用户根据获得的目标轨迹进行康复训练,实时采集用户的运动学信号;
S3:根据用户距离终点的实时位置差值和实时跟踪误差调节阻尼参数;
S4:根据步骤S3获得的阻尼参数,整定实时刚度参数;
S5:将得到的阻尼和刚度值作为康复机器人的阻抗控制器参数,获得相应电机的驱动控制量,完成康复机器人的变阻抗控制。
2.根据权利要求1所述的一种结合轨迹规划的康复机器人变阻抗控制方法,其特征在于,在所述步骤S1中,所述参考轨迹模板的获取过程具体为:
为不同运动损伤的用户指定合适的运动难度,包括考虑用户训练轨迹的长度和运动时间,测得多组设定路径长度下健康人的最适训练时间,同时测量用户健侧的运动数据;在获取足够多的运动数据后,将运动数据在运动时间和运动长度上进行取均值、归一化,然后整合至用户个性化训练任务的运动时间和长度,获得参考轨迹模板。
3.根据权利要求1所述的一种结合轨迹规划的康复机器人变阻抗控制方法,其特征在于,在所述步骤S1中,所述制定目标轨迹过程具体为:
用户先进行训练任务测试,根据运动情况评估用户运动损伤程度,再结合训练任务的类型,选择合理的目标函数中的常数γ和λ,代入参考轨迹模板中,获取最优化目标函数。
4.根据权利要求1所述的一种结合轨迹规划的康复机器人变阻抗控制方法,其特征在于,在所述步骤S3中,所述阻尼参数具体表示为:
式中,Δx=|x-xf|为笛卡尔空间内实际位置距离期望轨迹终点处的距离差,xf是期望运动轨迹的终点,e=|x-xr|为跟踪误差,也即笛卡尔空间内实时实际位置与期望轨迹位置的绝对差值,x是机器人末端执行器的实际位置,xr是平滑的、优化的期望运动轨迹,Kx是与Δx相关的常数,用于调节人体实际感知位置因素在阻尼变化中所占的比例,x0,Kx0用于具体调节感知位置项阻尼曲线的变化趋势,Ke是与e有关的常数,用于调节跟踪误差因素在阻尼变化中所占的比例,e0,Ke0用于具体调节跟踪误差项阻尼曲线的变化趋势。
5.根据权利要求4所述的一种结合轨迹规划的康复机器人变阻抗控制方法,其特征在于,所述阻尼参数调整方法具体为:
将用户距离终点的位置差值和跟踪误差作为调整阻尼的变量,并且将两者以非线性变化的形式实时改变阻尼值,使得训练过程中跟踪误差越大,阻尼值越小,离终点的位置差值越近,阻尼值越大。
6.根据权利要求4所述的一种结合轨迹规划的康复机器人变阻抗控制方法,其特征在于,所述步骤S4具体为:根据刚度与阻尼存在正相关关系的特性,给定正相关系数β,代入K=βB,完成实时刚度参数的整定。
7.根据权利要求6所述的一种结合轨迹规划的康复机器人变阻抗控制方法,其特征在于,在所述步骤S5中,需要将阻尼参数、刚度参数通过康复机器人***的动力学模型转换成相应的电机控制量。
8.根据权利要求1-7任一项所述的一种结合轨迹规划的康复机器人变阻抗控制方法,其特征在于,在采集健康人的运动数据前,为不同运动损伤的用户指定平滑的期望训练轨迹,用于确定参考轨迹模板及运动约束。
9.根据权利要求8所述的一种结合轨迹规划的康复机器人变阻抗控制方法,其特征在于,所述运动约束包括速度约束和加速度约束。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010888789.4A CN111904795B (zh) | 2020-08-28 | 2020-08-28 | 一种结合轨迹规划的康复机器人变阻抗控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010888789.4A CN111904795B (zh) | 2020-08-28 | 2020-08-28 | 一种结合轨迹规划的康复机器人变阻抗控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111904795A CN111904795A (zh) | 2020-11-10 |
CN111904795B true CN111904795B (zh) | 2022-08-26 |
Family
ID=73266461
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010888789.4A Active CN111904795B (zh) | 2020-08-28 | 2020-08-28 | 一种结合轨迹规划的康复机器人变阻抗控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111904795B (zh) |
Families Citing this family (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112631128B (zh) * | 2020-11-27 | 2023-04-14 | 广东省科学院智能制造研究所 | 一种多模异构信息融合的机器人装配技能学习方法及*** |
CN112698567B (zh) * | 2020-12-29 | 2024-05-31 | 上海电气集团股份有限公司 | 一种康复设备控制方法、装置、设备及介质 |
CN113057850B (zh) * | 2021-03-11 | 2022-06-10 | 东南大学 | 基于概率运动原语和隐半马尔可夫的康复机器人控制方法 |
CN113081666B (zh) * | 2021-03-24 | 2023-05-12 | 上海傅利叶智能科技有限公司 | 康复机器人的虚拟限位的方法、装置和康复机器人 |
CN113609446A (zh) * | 2021-07-30 | 2021-11-05 | 北京果仁互动科技有限公司 | 一种运动参数确定方法和装置 |
CN113679568B (zh) * | 2021-09-01 | 2022-10-04 | 南京医科大学 | 机器人辅助脑卒中患者上肢多模态镜像康复训练评分*** |
CN113858201B (zh) * | 2021-09-29 | 2023-04-25 | 清华大学 | 用于柔性驱动机器人的自适应变阻抗控制方法、***与设备 |
CN114129399B (zh) * | 2021-11-30 | 2024-04-12 | 南京伟思医疗科技股份有限公司 | 一种外骨骼机器人被动训练用在线力矩生成器 |
CN114146363B (zh) * | 2021-12-14 | 2022-08-30 | 国家康复辅具研究中心 | 一种助行训练***及其一体化控制方法 |
CN114521939B (zh) * | 2022-04-24 | 2022-09-06 | 北京智愈医疗科技有限公司 | 一种自动水刀实现方法及*** |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108153153A (zh) * | 2017-12-19 | 2018-06-12 | 哈尔滨工程大学 | 一种学习变阻抗控制***及控制方法 |
CN108324503A (zh) * | 2018-03-16 | 2018-07-27 | 燕山大学 | 基于肌骨模型和阻抗控制的康复机器人自适应控制方法 |
CN108785997A (zh) * | 2018-05-30 | 2018-11-13 | 燕山大学 | 一种基于变导纳的下肢康复机器人柔顺控制方法 |
CN109091818A (zh) * | 2017-09-15 | 2018-12-28 | 中山大学 | 基于导纳控制的绳牵引上肢康复机器人的训练方法及*** |
CN109718059A (zh) * | 2019-03-11 | 2019-05-07 | 燕山大学 | 手部康复机器人自适应控制方法及装置 |
CN110355761A (zh) * | 2019-07-15 | 2019-10-22 | 武汉理工大学 | 一种基于关节刚度和肌肉疲劳的康复机器人控制方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US9198821B2 (en) * | 2011-09-28 | 2015-12-01 | Northeastern University | Lower extremity exoskeleton for gait retraining |
US10806657B2 (en) * | 2015-09-23 | 2020-10-20 | Universitè Catholique De Louvain | Rehabilitation system and method |
-
2020
- 2020-08-28 CN CN202010888789.4A patent/CN111904795B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109091818A (zh) * | 2017-09-15 | 2018-12-28 | 中山大学 | 基于导纳控制的绳牵引上肢康复机器人的训练方法及*** |
CN108153153A (zh) * | 2017-12-19 | 2018-06-12 | 哈尔滨工程大学 | 一种学习变阻抗控制***及控制方法 |
CN108324503A (zh) * | 2018-03-16 | 2018-07-27 | 燕山大学 | 基于肌骨模型和阻抗控制的康复机器人自适应控制方法 |
CN108785997A (zh) * | 2018-05-30 | 2018-11-13 | 燕山大学 | 一种基于变导纳的下肢康复机器人柔顺控制方法 |
CN109718059A (zh) * | 2019-03-11 | 2019-05-07 | 燕山大学 | 手部康复机器人自适应控制方法及装置 |
CN110355761A (zh) * | 2019-07-15 | 2019-10-22 | 武汉理工大学 | 一种基于关节刚度和肌肉疲劳的康复机器人控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111904795A (zh) | 2020-11-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111904795B (zh) | 一种结合轨迹规划的康复机器人变阻抗控制方法 | |
US9221172B2 (en) | Constraining robotic manipulators with redundant degrees of freedom | |
CN104589304A (zh) | 机器人控制装置以及机器人 | |
Duchaine et al. | Computationally efficient predictive robot control | |
CN112247962B (zh) | 面向上肢穿戴机器人的人机博弈控制方法及*** | |
CN112601863B (zh) | 工程机械和评价装置 | |
Wu et al. | Development and hybrid force/position control of a compliant rescue manipulator | |
WO2020118730A1 (zh) | 机器人柔顺性控制方法、装置、设备及存储介质 | |
Roveda et al. | Fuzzy impedance control for enhancing capabilities of humans in onerous tasks execution | |
Bian et al. | An extended DMP framework for robot learning and improving variable stiffness manipulation | |
Turner et al. | Development and testing of a telemanipulation system with arm and hand motion | |
JP3369351B2 (ja) | 多関節マニピュレータの弾性設定方法および制御装置 | |
Wampler | Multiprocessor control of a telemanipulator with optical proximity sensors | |
JP2000148210A (ja) | ゲイン算出装置 | |
CN115755592B (zh) | 调整三自由度外骨骼运动状态的多模态控制方法及外骨骼 | |
KR20120048106A (ko) | 로봇의 동작 제어 시스템 및 동작 제어 방법 | |
JP3105694B2 (ja) | マニピュレータ制御方法 | |
WO2023165174A1 (zh) | 构建机器人的控制器的方法、机器人的运动控制方法、装置以及机器人 | |
CN112998698B (zh) | 一种基于精确抓握动力学的感知运动功能评估*** | |
Bian et al. | Improving stability in physical human–robot interaction by estimating human hand stiffness and a vibration index | |
JP2022054043A (ja) | ロボットの制御パラメーターに関する表示を行う方法、プログラム、および情報処理装置 | |
CN111158238B (zh) | 一种基于粒子群算法的力反馈设备动力学参数估计算法 | |
Zhou et al. | Dynamic modeling and vibration suppression for double flexible manipulator with a tip payload | |
JP5829103B2 (ja) | ロボットハンド | |
Luo et al. | An assist-as-needed controller for robotic rehabilitation therapy based on rbf network |
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 |