CN109091818A - 基于导纳控制的绳牵引上肢康复机器人的训练方法及系统 - Google Patents
基于导纳控制的绳牵引上肢康复机器人的训练方法及系统 Download PDFInfo
- Publication number
- CN109091818A CN109091818A CN201710832598.4A CN201710832598A CN109091818A CN 109091818 A CN109091818 A CN 109091818A CN 201710832598 A CN201710832598 A CN 201710832598A CN 109091818 A CN109091818 A CN 109091818A
- Authority
- CN
- China
- Prior art keywords
- upper limb
- signal
- control
- user
- rope
- 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
- 210000001364 upper extremity Anatomy 0.000 title claims abstract description 98
- 238000012549 training Methods 0.000 title claims abstract description 77
- 238000000034 method Methods 0.000 title claims abstract description 38
- 230000033001 locomotion Effects 0.000 claims abstract description 74
- 230000035876 healing Effects 0.000 claims abstract description 37
- 230000002452 interceptive effect Effects 0.000 claims abstract description 34
- 230000003993 interaction Effects 0.000 claims abstract description 27
- 238000010586 diagram Methods 0.000 claims description 12
- 238000011084 recovery Methods 0.000 claims description 11
- 238000012360 testing method Methods 0.000 claims description 9
- 230000008054 signal transmission Effects 0.000 claims description 8
- 230000005611 electricity Effects 0.000 claims description 3
- 239000012636 effector Substances 0.000 description 8
- 206010008190 Cerebrovascular accident Diseases 0.000 description 5
- 208000006011 Stroke Diseases 0.000 description 5
- 230000007659 motor function Effects 0.000 description 5
- 230000008901 benefit Effects 0.000 description 4
- 230000002490 cerebral effect Effects 0.000 description 4
- 238000012512 characterization method Methods 0.000 description 4
- 230000000694 effects Effects 0.000 description 4
- 210000003141 lower extremity Anatomy 0.000 description 4
- 230000008569 process Effects 0.000 description 4
- 238000011217 control strategy Methods 0.000 description 3
- 201000010099 disease Diseases 0.000 description 3
- 208000037265 diseases, disorders, signs and symptoms Diseases 0.000 description 3
- 239000011159 matrix material Substances 0.000 description 3
- 230000003321 amplification Effects 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 2
- 238000002567 electromyography Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 210000003414 extremity Anatomy 0.000 description 2
- 230000006870 function Effects 0.000 description 2
- 230000036541 health Effects 0.000 description 2
- 238000011835 investigation Methods 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000003183 myoelectrical effect Effects 0.000 description 2
- 238000003199 nucleic acid amplification method Methods 0.000 description 2
- 230000008447 perception Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 241000208340 Araliaceae Species 0.000 description 1
- 208000012661 Dyskinesia Diseases 0.000 description 1
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 description 1
- 235000003140 Panax quinquefolius Nutrition 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 230000037147 athletic performance Effects 0.000 description 1
- 230000002354 daily effect Effects 0.000 description 1
- 238000013016 damping Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000007812 deficiency Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 230000009977 dual effect Effects 0.000 description 1
- 230000002708 enhancing effect Effects 0.000 description 1
- 230000003203 everyday effect Effects 0.000 description 1
- 230000005714 functional activity Effects 0.000 description 1
- 235000008434 ginseng Nutrition 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 238000000465 moulding Methods 0.000 description 1
- 230000001769 paralizing effect Effects 0.000 description 1
- 238000003909 pattern recognition Methods 0.000 description 1
- 238000000554 physical therapy Methods 0.000 description 1
- 208000037920 primary disease Diseases 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Classifications
-
- A—HUMAN NECESSITIES
- A63—SPORTS; GAMES; AMUSEMENTS
- A63B—APPARATUS FOR PHYSICAL TRAINING, GYMNASTICS, SWIMMING, CLIMBING, OR FENCING; BALL GAMES; TRAINING EQUIPMENT
- A63B23/00—Exercising apparatus specially adapted for particular parts of the body
- A63B23/035—Exercising apparatus specially adapted for particular parts of the body for limbs, i.e. upper or lower limbs, e.g. simultaneously
- A63B23/12—Exercising apparatus specially adapted for particular parts of the body for limbs, i.e. upper or lower limbs, e.g. simultaneously for upper limbs or related muscles, e.g. chest, upper back or shoulder muscles
-
- A—HUMAN NECESSITIES
- A63—SPORTS; GAMES; AMUSEMENTS
- A63B—APPARATUS FOR PHYSICAL TRAINING, GYMNASTICS, SWIMMING, CLIMBING, OR FENCING; BALL GAMES; TRAINING EQUIPMENT
- A63B21/00—Exercising apparatus for developing or strengthening the muscles or joints of the body by working against a counterforce, with or without measuring devices
- A63B21/00178—Exercising apparatus for developing or strengthening the muscles or joints of the body by working against a counterforce, with or without measuring devices for active exercising, the apparatus being also usable for passive exercising
-
- A—HUMAN NECESSITIES
- A63—SPORTS; GAMES; AMUSEMENTS
- A63B—APPARATUS FOR PHYSICAL TRAINING, GYMNASTICS, SWIMMING, CLIMBING, OR FENCING; BALL GAMES; TRAINING EQUIPMENT
- A63B21/00—Exercising apparatus for developing or strengthening the muscles or joints of the body by working against a counterforce, with or without measuring devices
- A63B21/00181—Exercising apparatus for developing or strengthening the muscles or joints of the body by working against a counterforce, with or without measuring devices comprising additional means assisting the user to overcome part of the resisting force, i.e. assisted-active exercising
-
- A—HUMAN NECESSITIES
- A63—SPORTS; GAMES; AMUSEMENTS
- A63B—APPARATUS FOR PHYSICAL TRAINING, GYMNASTICS, SWIMMING, CLIMBING, OR FENCING; BALL GAMES; TRAINING EQUIPMENT
- A63B24/00—Electric or electronic controls for exercising apparatus of preceding groups; Controlling or monitoring of exercises, sportive games, training or athletic performances
- A63B24/0087—Electric or electronic controls for exercising apparatus of groups A63B21/00 - A63B23/00, e.g. controlling load
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F3/00—Input arrangements for transferring data to be processed into a form capable of being handled by the computer; Output arrangements for transferring data from processing unit to output unit, e.g. interface arrangements
- G06F3/01—Input arrangements or combined input and output arrangements for interaction between user and computer
- G06F3/011—Arrangements for interaction with the human body, e.g. for user immersion in virtual reality
-
- A—HUMAN NECESSITIES
- A63—SPORTS; GAMES; AMUSEMENTS
- A63B—APPARATUS FOR PHYSICAL TRAINING, GYMNASTICS, SWIMMING, CLIMBING, OR FENCING; BALL GAMES; TRAINING EQUIPMENT
- A63B24/00—Electric or electronic controls for exercising apparatus of preceding groups; Controlling or monitoring of exercises, sportive games, training or athletic performances
- A63B24/0087—Electric or electronic controls for exercising apparatus of groups A63B21/00 - A63B23/00, e.g. controlling load
- A63B2024/0093—Electric or electronic controls for exercising apparatus of groups A63B21/00 - A63B23/00, e.g. controlling load the load of the exercise apparatus being controlled by performance parameters, e.g. distance or speed
-
- A—HUMAN NECESSITIES
- A63—SPORTS; GAMES; AMUSEMENTS
- A63B—APPARATUS FOR PHYSICAL TRAINING, GYMNASTICS, SWIMMING, CLIMBING, OR FENCING; BALL GAMES; TRAINING EQUIPMENT
- A63B2220/00—Measuring of physical parameters relating to sporting activity
- A63B2220/50—Force related parameters
- A63B2220/51—Force
Landscapes
- Health & Medical Sciences (AREA)
- Engineering & Computer Science (AREA)
- Orthopedic Medicine & Surgery (AREA)
- General Health & Medical Sciences (AREA)
- Physical Education & Sports Medicine (AREA)
- Biophysics (AREA)
- Life Sciences & Earth Sciences (AREA)
- General Engineering & Computer Science (AREA)
- Theoretical Computer Science (AREA)
- Human Computer Interaction (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Rehabilitation Tools (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种基于导纳控制的绳牵引上肢康复机器人的训练方法及系统，在用户进行上肢关节康复训练运动时，实时采集用户上肢施加在绳牵引康复机器人的交互力信号和上肢的运动学信号；通过导纳模型将所述交互力信号转变为期望运动轨迹的运动参数，按照所述期望运动轨迹的运动参数和所述上肢的运动学信号确定目标运动轨迹的运动参数；将确定的运动参数作为控制量，转换成绳牵引康复机器人的电机控制量，控制相应的电机输出，实现用户自主控制康复训练动作，提高了用户的主动参与性。
Description
技术领域
本发明涉及医疗康复技术领域，尤其涉及一种基于导纳控制的绳牵引上肢 康复机器人的训练方法及系统。
背景技术
脑卒中具有高发病率、高致残率和高死亡率的特点，是威胁人类健康的首 要疾病。据统计，我国每年的脑卒中患者达200万，发病率高达120/10万，而 且随着我国人口老龄化的日趋严重，脑卒中的发病率呈现出逐年上升的趋势。 75％的脑卒中幸存者存在不同程度的运动功能障碍，不同程度地丧失了劳动力或 者生活不能自理，而且其中25％的人在中风五年后仍不能自如的使用患侧肢体； 尤其是上肢功能因其日常动作的复杂性而常常比下肢的恢复缓慢。康复训练能 帮助患者恢复运动功能，提高日常行为能力。传统的康复方法主要是物理治疗 师的反复作业疗法，这种治疗方法受限于治疗师的精力，而且康复治疗还受到 医疗资源总量和分布、人才数量和服务能力等的制约。而随着机器人技术的发展，康复机器人能够辅助偏瘫患者完成康复训练，将物理治疗师从高强度的体 力劳动中解放出来，提高康复效率，为解决上述局限提供了切实可行的方法。
根据调查显示，目前国内外关于康复机器人的研究大多集中在刚性连杆组 成的末端牵引式康复机器人以及外骨骼式康复机器人。这类康复机器人往往存 在动作范围和活动关节受限、对控制方法和安全性的要求较高等缺陷。而绳牵 引康复机器人结构简单、安全性好、安装和佩戴方便、并能在接近正常人运动 空间进行康复训练。Cauraugh提出的感知运动整合理论认为如果患者能够主动 参与患侧肢体运动，并且通过感知进行自主调整，将有助于提升训练效果。因 此相对于精确控制，康复机器人的控制应以用户为中心，着重加强用户的主动 参与性，并应具有良好的人机交互性和柔顺性。根据调查显示，现在经常使用 的控制方法主要有比例-积分-微分(PID)控制、阻抗控制、导纳控制和肌电控 制。PID控制能够实现轨迹跟踪等被动康复训练，但是忽略了患者的主动参与性。 如加州理工大学的Emken等人主要采用比例微分(PD)控制方法辅助下肢进行 轨迹跟踪训练。阻抗控制能一定程度上改善用户的参与性，得到了广泛应用； 如美国哥伦比亚大学的Zanotto等人将其应用在了上肢康复机器人Sophia-3中， 用于辅助受试者在指定范围内完成康复训练运动。中国科学院的侯增广教授等 人在所设计的下肢康复装置iLeg中，利用PI控制器完成被动训练模式下的轨迹 跟踪，同时采用两个简化的阻抗控制器完成主动康复训练模式。导纳控制能够 根据受试者的运动意图确定目标轨迹，进一步增强了患者的主动参与性；如加拿大魁北克大学高等技术学院的Luna等人在ETS-MARSE上实现了基于导纳控 制的被动训练控制和主动训练控制，并通过实验验证了算法的有效性。肌电控 制根据用户的肌电信号判断用户的运动意图，患者的主动参与性较强；武汉理 工大学的艾青松教授将肌电信号进行模式识别，结合变阻抗控制策略应用于下 肢6自由度康复机器人；但是这种算法比较复杂，且有较大的个体差异性。
综上所述，尽管康复机器人的控制方法在康复训练轨迹跟踪的精确性和柔 顺性方面取得了不错的进展，但控制和执行多以机器人为中心，在进行康复训 练时采用沿预设轨迹上运动的模式，存在患者主动参与性不足的问题。针对中 风患者用户的上肢康复训练需求，对具有柔顺性、结构简单、安全性好等优势 的绳牵引康复机器人的研究较少，而且其相关的具有较好的用户主动参与性的 控制方法的实例也相对缺乏，尤其是导纳控制这一具有调试简单、易操作的控 制策略。
发明内容
本发明提出了一种基于导纳控制的绳牵引上肢康复机器人的训练方法及系 统，利用用户上肢与机器人的交互力，基于导纳控制策略，实现了用户主动控 制康复机器人动作的人机交互方法，从而增强了用户的主动参与性、提高了上 肢康复训练的效果。
为了达到上述目的，本发明提供了如下方案：
本发明提供一种基于导纳控制的绳牵引上肢康复机器人的训练方法，包括 以下步骤：
S1、在用户进行上肢关节康复训练运动时，实时采集用户上肢施加在绳牵 引康复机器人的交互力信号和上肢的运动学信号；
S2、通过导纳模型将所述交互力信号转变为期望运动轨迹的运动参数，按 照所述期望运动轨迹的运动参数和所述上肢的运动学信号确定目标运动轨迹的 运动参数；
S3、将确定的运动参数作为控制量，转换成绳牵引康复机器人的电机控制 量，控制相应的电机输出。
进一步的，针对运动过程中的抖动现象，需要确定是否将用户的运动意图 传递至训练系统，在所述步骤S1前，还包括步骤：在用户进行最大拉力测试时， 采集最大拉力信号，根据采集到的最大拉力信号预设阈值。在所述步骤S1之后、 步骤S2之前，还包括步骤：判断所述交互力信号是否大于所述阈值，若是，执 行步骤S2，若否，执行步骤S1。
优选的，上述判断所述交互力信号是否大于所述阈值的步骤，具体为：将 采集到的交互力信号进行滤波处理得到交互力幅值，判断所述交互力幅值是否 大于所述阈值。
进一步的，由于每位用户的运动功能情况不同，需要设定不同用户的个性 化训练强度配置，所述步骤S2包括：通过改变导纳控制环中交互力和期望运动 轨迹之间的放大增益的参数，调整交互力信号转变为运动参数的增益。
调整导纳控制环的放大增益，可以实现从被动训练(即用户上肢动作完全 由机器人引导完成)到主动训练(运动动作完全由用户的主动力进行控制)， 甚至到对抗训练(运动动作完全由用户的主动力进行控制，且康复机器人提供 一定程度的反向力)的训练难度等级的调节，这为康复训练的循序渐进及个性 化定制提供了一种可行的方法。
进一步的，步骤S3中，所述将确定的运动参数作为控制量，转换成绳牵引 康复机器人的电机控制量的步骤，具体为：
将确定的运动参数作为控制量，通过绳牵引康复机器人系统的动力学模型 转换成相应的电机控制量。
本发明还提供一种基于导纳控制的绳牵引上肢康复机器人的训练系统，包 括：
信号采集模块，用于在用户进行上肢关节康复训练运动时，实时采集用户 上肢施加在绳牵引康复机器人的交互力信号和上肢的运动学信号；
信号传输模块，用于将所述信号采集模块采集到的交互力信号和运动学信 号传输到主机控制模块；
主机控制模块，包括PC机、运动控制卡和电机驱动器，所述PC机用于通 过导纳模型将所述交互力信号转变为期望运动轨迹的运动参数，按照所述期望 运动轨迹的运动参数和所述上肢的运动学信号确定目标运动轨迹的运动参数； 所述运动控制卡用于将PC机确定的目标运动轨迹的运动参数作为控制量，转换 成绳牵引康复机器人的电机控制量，控制相应的电机输出；所述电机驱动器用 于按照运动控制卡控制的电机输出驱动对应的电机。
进一步的，所述主机控制模块还包括：
阈值判断单元，用于当用户进行最大拉力测试，采集最大拉力信号，根据 采集到的最大拉力信号预设阈值，判断所述交互力信号是否大于所述阈值，若 是，系统执行PC机、运动控制卡和电机驱动器的操作，若否，系统执行信号采 集模块的操作。
优选的，阈值判断单元，具体用于当用户进行最大拉力测试，采集最大拉 力信号，根据采集到的最大拉力信号预设阈值，将采集到的交互力信号进行滤 波处理得到交互力幅值，判断所述交互力幅值是否大于所述阈值，若是，系统 执行PC机、运动控制卡和电机驱动器的操作，若否，系统执行信号采集模块的 操作。
进一步的，所述主机控制模块还包括：
训练难度调节单元，通过改变导纳控制环中交互力和期望运动轨迹之间的 放大增益的参数，调整交互力信号转变为运动参数的增益。
进一步的，基于导纳控制的绳牵引上肢康复机器人的训练系统，所述主机 控制模块中的PC机还用于按照信号传输模块传输的所述运动学信号获得用户 实际完成的运动轨迹图；系统还包括主机交互模块，用于在交互界面上实时显 示所述PC机发送的运动轨迹图；
所述信号采集模块具体包括：运动信号采集单元，用于通过实时采集用户 上肢的三维坐标值，获取用户上肢的运动学信号；力信号采集单元，用于通过 力传感器采集用户上肢施加在绳牵引康复机器人的交互力信号。
本发明提供一种基于导纳控制的绳牵引上肢康复机器人的训练方法及系 统，将采集到的用户上肢施加在绳牵引康复机器人的交互力信号和用户上肢的 运动学信号经过处理后控制训练系统的电机输出，实现用户自主控制康复训练 动作，提高了用户的主动参与性。
附图说明
图1是本发明实施例提供的一种基于导纳控制的绳牵引上肢康复机器人的 训练方法的流程示意图；
图2是图1中步骤S1的流程示意图；
图3是本发明实施例提供的基于导纳控制的绳牵引上肢康复机器人的训练 方法的导纳控制的原理图；
图4是本发明实施例提供的另一种基于导纳控制的绳牵引上肢康复机器人 的训练方法的流程示意图；
图5是本发明实施例提供的基于导纳控制的绳牵引上肢康复机器人的训练 系统的结构示意图；
图6是本发明实施例提供的基于导纳控制的绳牵引上肢康复机器人的训练 系统的信号采集模块的结构示意图；
图7是本发明实施例提供的基于导纳控制的绳牵引上肢康复机器人的训练 系统的主机控制模块的结构示意图。
具体实施方式
下面将结合本发明的附图，对本发明实施例中的技术方案进行清楚、完整 地描述。显然，所描述的实施例仅仅是本发明的一部分实施例，并不是全部的 实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动 前提下所获得的所有其他实施例，都属于本发明保护的范围。
实施例一
参见图1，本发明实施例提供一种基于导纳控制的绳牵引上肢康复机器人的 训练方法，包括以下步骤：
S1、在用户进行上肢关节康复训练运动时，实时采集用户上肢施加在绳牵 引康复机器人的交互力信号和上肢的运动学信号；
用户进行康复训练运动，导纳控制不预设轨迹，目标运动轨迹只依靠采集 到的用户上肢施加在绳牵引康复机器人的交互力信号决定。
如图2所示，所述步骤S1具体包括步骤：
S11、将绳牵引康复机器人的末端执行器复位至指定起始位置，指导用户将 上肢放置在绳牵引康复机器人的末端执行器上，通过交互界面引导用户熟悉康 复训练动作；
S12、实时采集用户上肢的运动学信号；
运动学信号表征的是用户上肢的位置。
S13、通过安装在绳子上的力传感器实时采集用户上肢施加在绳牵引康复机 器人的交互力信号。
需要说明的是，步骤S12与步骤S13之间没有顺序上的限定。
S2、通过导纳模型将所述交互力信号转变为期望运动轨迹的运动参数，按 照所述期望运动轨迹的运动参数和所述上肢的运动学信号确定目标运动轨迹的 运动参数；
图3是绳牵引上肢康复机器人的训练方法的导纳控制的原理图。运动轨迹 的运动参数包括运动方向和运动距离，表征运动时的位置。运动轨迹是运动时 位置的集合。交互力信号能够转化为用户上肢自发运动的方向和距离，当施加 导纳控制时，不预设运动轨迹，通过导纳模型将所述交互力信号转变为期望运 动轨迹的运动参数，即表征期望位置，实时采集的上肢运动学信号表征的是实 际位置，通过期望位置和实际位置确定目标位置，通过目标位置控制操控绳牵 引上肢康复机器人。
在本实施例中，为了避免过大的交互力对用户造成影响，将绳索的运动速 度限制在预设的安全水平内。
S3、将确定的目标运动轨迹的运动参数作为控制量，转换成绳牵引康复机 器人的电机控制量，控制相应的电机输出。
绳牵引康复机器人具有低惯性、柔顺性和安全性的优点，每根绳子均由一 个电机进行控制。本实施例中绳子共有3根。
将步骤S2确定的目标运动轨迹的运动参数作为控制量，转化成绳牵引康复 机器人的电机控制量，进行各个电机的运转控制，控制相应的电机输出，实时 调整目标运动轨迹的运动方向和距离。
本实施例提供一种基于导纳控制的绳牵引上肢康复机器人的训练方法，采 用导纳控制方法进行控制的思路，可以实现由用户的主动力进行控制的训练策 略，有利于提高用户的主动参与性，增强康复训练的效果。
实施例二
本发明实施例提供的一种基于导纳控制的绳牵引上肢康复机器人的训练方 法，其步骤如图4所示：
S0、在用户进行最大拉力测试时，采集最大拉力信号，根据采集到的最大 拉力信号预设阈值；
在本步骤中，将最大拉力信号按百分比来取值，作为预设的阈值。该百分 比依据不同用户的运动功能情况制定。
S1、在用户进行上肢关节康复训练运动时，实时采集用户上肢施加在绳牵 引康复机器人的交互力信号和上肢的运动学信号；
本步骤与实施例一的步骤S1相同，也包括步骤S11、S12、S13。
S1/、判断所述交互力信号是否大于阈值，若是，执行步骤S2，若否，执行 步骤S1；
在本实施例中，判断过程为：将采集到的交互力信号进行滤波处理得到交 互力幅值，判断所述交互力幅值是否大于所述阈值。
S2、通过导纳模型将所述交互力信号转变为期望运动轨迹的运动参数，按 照所述期望运动轨迹的运动参数和所述上肢的运动学信号确定目标运动轨迹的 运动参数；
图3也是本实施例绳牵引上肢康复机器人的训练方法的导纳控制的原理图。 本实施例中，执行导纳控制时，通过改变导纳控制环中交互力和期望运动轨迹 之间的放大增益K，调整交互力信号转变为运动参数的增益，可以将上肢运动设 定不同程度的辅助力，辅助程度的设定可根据每位用户的运动功能情况由专业 的治疗师制定，从而实现训练难易程度的调节。导纳模型参数主要根据绳牵引 康复机器人系统进行调试确定，调试完成后改变放大增益K的大小即可调节所 需康复机器人的辅助程度。K＝0时，训练模式属于纯被动训练的预设轨迹运动 模式，此时需预设轨迹；K＝1是预设的难度适中的主动控制的模式(假设此时 运动1单位的距离需要1单位的交互力)；0<K<1时，运动1单位的距离需要 大于1单位的交互力，且随着K的增大所需的交互力越小，也即训练难度越小； K>1时，运动1单位的距离需要小于1单位的交互力，且随着K的增大需要的 交互力越小，也即训练难度越小。
S3、将确定的目标运动轨迹的运动参数作为控制量，转换成绳牵引康复机 器人的电机控制量，控制相应的电机输出；
在本实施例中，步骤S3具体为：
将确定的目标运动轨迹的运动参数作为控制量，通过绳牵引康复机器人系 统的动力学模型转换成相应的电机控制量。
S4、按照实时采集的用户上肢的运动学信号获得用户实际完成的运动轨迹 图，在交互界面中实时显示。
需要说明的是，步骤S4与步骤S1～S3之间没有顺序上的限定。
本实施例提供一种基于导纳控制的绳牵引上肢康复机器人的训练方法，不 但通过导纳控制实现由用户的主动力进行控制的训练策略，而且针对运动过程 中的抖动现象，能够通过预设阈值确定是否将用户的运动意图传递至康复机器 人进行运动辅助，还通过调整导纳控制环的增益，可以将上肢运动设定不同程 度的辅助力，辅助程度的设定可根据每位用户的运动功能情况由专业的治疗师 制定，从而实现训练难易程度的调节，实现不同用户的个性化训练强度配置和 不同强度下的训练过程，且提升了用户的交互体验。
下面将对实施例二中步骤S3：将确定的目标运动轨迹的运动参数作为控制 量，通过绳牵引康复机器人系统的动力学模型转换成相应的电机控制量，进行 详细阐述：
以3根绳子的绳牵引康复机器人系统为例，分析给出绳牵引康复机器人系 统的动力学模型。如图5所示，该机器人系统结构的笛卡尔坐标系的原点定义 在该点所在边的中点位置。假设末端执行器始终在可达的工作空间内运动，末 端执行器的位置可以实时采集得到，且每个绳子对应的滑轮的位置可以通过预 先测量得知，因此每段滑轮到末端执行器之间的绳长可以计算为：
式中，(x,y,z)表示末端执行器的空间坐标，i为1至绳子数目的整数值，(xi,yi,zi)为与某段绳子相应的滑轮的空间坐标。
通过测量，每个滑轮的空间坐标记为：
式中，a表示|OP1|边的长度，b表示|P1P2|边的长度，c表示|P1P3|边的长度。结 合式(1)和式(2)，每根绳子的绳长可以实时表述如下：
将每段绳长分别对时间进行求导可以得到：
与之间的关系可以通过雅克比矩阵联系起来。由上述可知，本实施例的绳牵引康复机器人系统的雅克比矩阵可以表述为：
因此，末端执行器在三个维度上的控制量u与绳子的驱动力τ之间的关系 可以表述如下：
[ux uy uz]T＝-JTτ (6)
如图3所示的导纳控制框图中导纳控制通过导纳模型产生期望的运动轨迹， 并通过位置控制器对产生的期望位置进行追踪。导纳模型描述了期望位置与人 机相互作用力之间的关系，本实施例的导纳模型采取基于阻抗控制的形式，其 传递函数可以表示为：
其中，F为交互力，X为期望位置，Mac、Dac、Kac分别为理想的惯性、阻尼、 刚度系数。
导纳控制的位置控制器的作用是对导纳模型所产生的期望轨迹进行追踪， 导纳控制的位置控制器可采用PID控制，因此末端执行器在三个维度上的控制 量u可以计算为：
其中，e为三维空间位置误差，Kp、Ki、Kd分别为比例项、积分项、微分项的系 数。
结合式(6)，绳子的驱动力τ最终可以表示为：
从式(9)中可以看到，雅克比矩阵J与确定的目标运动轨迹的运动参数相关， 绳子的驱动力即电机的驱动参数，从而实现步骤S3“将确定的目标运动轨迹的 运动参数作为控制量，通过绳牵引康复机器人系统的动力学模型转换成相应的 电机控制量”。
实施例三
本发明还提供一种基于导纳控制的绳牵引上肢康复机器人的训练系统，能 够实施上述实施例中的训练方法。
参见图5，是本发明提供的基于导纳控制的绳牵引上肢康复机器人的训练系 统的结构示意图。基于导纳控制的绳牵引上肢康复机器人的训练系统，包括信 号采集模块A、信号传输模块B、主机控制模块C和主机交互模块D。
本实施例的基于导纳控制的绳牵引上肢康复机器人的训练系统的各个模块 详细描述如下：
信号采集模块A，用于在用户进行上肢关节康复训练运动时，实时采集用 户上肢施加在绳牵引康复机器人的交互力信号和上肢的运动学信号；如图6所 示，信号采集模块A具体包括：
运动信号采集单元A1，用于实时采集用户上肢的三维坐标值，获取用户上 肢的运动学信号；
力信号采集单元A2，用于通过力传感器采集用户上肢与康复机器人之间的 交互力信号。
信号传输模块B，用于将所述信号采集模块采集到的交互力信号和运动学信 号传输到主机控制模块C；信号传输模块B具体可以是采集卡。
主机控制模块C，包括PC机、运动控制卡和电机驱动器，所述PC机用于 通过导纳模型将所述交互力信号转变为期望运动轨迹的运动参数，按照所述期 望运动轨迹的运动参数和所述上肢的运动学信号确定目标运动轨迹的运动参 数；所述运动控制卡用于将PC机确定的目标运动轨迹的运动参数作为控制量， 转换成绳牵引康复机器人的电机控制量，控制相应的电机输出；所述电机驱动 器用于按照运动控制卡控制的电机输出驱动对应的电机。
如图7所示，主机控制模块C还包括：
阈值判断单元C0，用于当用户进行最大拉力测试，采集最大拉力信号，根 据采集到的最大拉力信号预设阈值，判断所述交互力信号是否大于所述阈值， 若是，系统执行PC机、运动控制卡和电机驱动器的操作，若否，系统执行信号 采集模块的操作。
优选的，阈值判断单元C0具体用于当用户进行最大拉力测试，采集最大拉 力信号，根据采集到的最大拉力信号预设阈值，将采集到的交互力信号进行滤 波处理得到交互力幅值，判断所述交互力幅值是否大于所述阈值，若是，系统 执行PC机、运动控制卡和电机驱动器的操作，若否，系统执行信号采集模块的 操作。
主机控制模块C还包括：
训练难度调节单元C1，通过改变导纳控制环中交互力和期望运动轨迹之间 的放大增益的参数，调整交互力信号转变为运动参数的增益。
所述主机控制模块C中的PC机还用于按照信号传输模块B传输的所述运 动学信号获得用户实际完成的目标运动轨迹图，
主机交互模块D用于在交互界面上实时显示所述PC机发送的运动轨迹图。
本实施例提供一种基于导纳控制的绳牵引上肢康复机器人的训练系统，旨 在利用采集到的用户上肢施加在绳牵引康复机器人的交互力信号，进行主动控 制，与绳牵引康复机器人进行交互，达到用户自主控制康复训练动作的目的。 通过使用绳牵引上肢康复机器人和信号采集模块A，将交互力信号和运动学信 号通过信号传输模块B最终输入主机控制模块C，经过处理后，控制绳牵引上 肢康复机器人相关电机的转动，实现在不同用户主动参与程度下的康复训练。
以上所述是本发明的优选实施方式，应当指出，对于本技术领域的普通技 术人员来说，在不脱离本发明原理的前提下，还可以做出若干改进和润饰，这 些改进和润饰也视为本发明的保护范围。
Claims (10)
1.一种基于导纳控制的绳牵引上肢康复机器人的训练方法，其特征在于，包括步骤：
S1、在用户进行上肢关节康复训练运动时，实时采集用户上肢施加在绳牵引康复机器人的交互力信号和上肢的运动学信号；
S2、通过导纳模型将所述交互力信号转变为期望运动轨迹的运动参数，按照所述期望运动轨迹的运动参数和所述上肢的运动学信号确定目标运动轨迹的运动参数；
S3、将确定的运动参数作为控制量，转换成绳牵引康复机器人的电机控制量，控制相应的电机输出。
2.如权利要求1所述的基于导纳控制的绳牵引上肢康复机器人的训练方法，其特征在于，
在所述步骤S1前，还包括步骤：在用户进行最大拉力测试时，采集最大拉力信号，根据采集到的最大拉力信号预设阈值。
在所述步骤S1之后、步骤S2之前，还包括步骤：判断所述交互力信号是否大于所述阈值，若是，执行步骤S2，若否，执行步骤S1。
3.如权利要求2所述的基于导纳控制的绳牵引上肢康复机器人的训练方法，其特征在于，所述判断交互力信号是否大于所述阈值的步骤，具体为：
将采集到的交互力信号进行滤波处理得到交互力幅值，判断所述交互力幅值是否大于所述阈值。
4.如权利要求1至3中任一项所述的基于导纳控制的绳牵引上肢康复机器人的训练方法，其特征在于，所述步骤S2包括：通过改变导纳控制环中交互力和期望运动轨迹之间的放大增益的参数，调整交互力信号转变为运动参数的增益。
5.如权利要求4所述的基于导纳控制的绳牵引上肢康复机器人的训练方法，其特征在于，所述将确定的运动参数作为控制量，转换成绳牵引康复机器人的电机控制量的步骤，具体为：
将确定的运动参数作为控制量，通过绳牵引康复机器人系统的动力学模型转换成相应的电机控制量。
6.一种基于导纳控制的绳牵引上肢康复机器人的训练系统，其特征在于，包括：
信号采集模块，用于在用户进行上肢关节康复训练运动时，实时采集用户上肢施加在绳牵引康复机器人的交互力信号和上肢的运动学信号；
信号传输模块，用于将所述信号采集模块采集到的交互力信号和运动学信号传输到主机控制模块；
主机控制模块，包括PC机、运动控制卡和电机驱动器，所述PC机用于通过导纳模型将所述交互力信号转变为期望运动轨迹的运动参数，按照所述期望运动轨迹的运动参数和所述上肢的运动学信号确定目标运动轨迹的运动参数；所述运动控制卡用于将PC机确定的目标运动轨迹的运动参数作为控制量，转换成绳牵引康复机器人的电机控制量，控制相应的电机输出；所述电机驱动器用于按照运动控制卡控制的电机输出驱动对应的电机。
7.如权利要求6所述的基于导纳控制的绳牵引上肢康复机器人的训练系统，其特征在于，所述主机控制模块还包括：
阈值判断单元，用于当用户进行最大拉力测试时，采集最大拉力信号，根据采集到的最大拉力信号预设阈值，判断所述交互力信号是否大于所述阈值，若是，系统执行PC机、运动控制卡和电机驱动器的操作，若否，系统执行信号采集模块的操作。
8.如权利要求7所述的基于导纳控制的绳牵引上肢康复机器人的训练系统，其特征在于，
阈值判断单元，具体用于当用户进行最大拉力测试，采集最大拉力信号，根据采集到的最大拉力信号预设阈值，将采集到的交互力信号进行滤波处理得到交互力幅值，判断所述交互力幅值是否大于所述阈值，若是，系统执行PC机、运动控制卡和电机驱动器的操作，若否，系统执行信号采集模块的操作。
9.如权利要求6至8中任一项所述的基于导纳控制的绳牵引上肢康复机器人的训练系统，其特征在于，所述主机控制模块还包括：
训练难度调节单元，通过改变导纳控制环中交互力和期望运动轨迹之间的放大增益的参数，调整交互力信号转变为运动参数的增益。
10.如权利要求9所述的基于导纳控制的绳牵引上肢康复机器人的训练系统，其特征在于，
所述PC机还用于按照信号传输模块传输的所述运动学信号获得用户实际完成的运动轨迹图；
系统还包括主机交互模块，用于在交互界面上实时显示所述PC机发送的运动轨迹图；
所述信号采集模块具体包括：运动信号采集单元，用于实时采集用户上肢的三维坐标值，获取用户上肢的运动学信号；力信号采集单元，用于通过力传感器采集用户上肢施加在绳牵引康复机器人的交互力信号。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710832598.4A CN109091818B (zh) | 2017-09-15 | 2017-09-15 | 基于导纳控制的绳牵引上肢康复机器人的训练方法及系统 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201710832598.4A CN109091818B (zh) | 2017-09-15 | 2017-09-15 | 基于导纳控制的绳牵引上肢康复机器人的训练方法及系统 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN109091818A true CN109091818A (zh) | 2018-12-28 |
| CN109091818B CN109091818B (zh) | 2020-08-21 |
Family
ID=64796436
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201710832598.4A Active CN109091818B (zh) | 2017-09-15 | 2017-09-15 | 基于导纳控制的绳牵引上肢康复机器人的训练方法及系统 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN109091818B (zh) |
Cited By (12)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN109925675A (zh) * | 2019-01-15 | 2019-06-25 | 河南翔宇医疗设备股份有限公司 | 智能磨砂板触摸屏视觉同步方法、装置、系统及移动终端 |
| CN111243706A (zh) * | 2020-01-19 | 2020-06-05 | 东南大学 | 基于变阻抗演示学习的上肢康复机器人训练任务生成方法 |
| CN111281743A (zh) * | 2020-02-29 | 2020-06-16 | 西北工业大学 | 一种上肢康复外骨骼机器人自适应柔顺控制方法 |
| CN111904795A (zh) * | 2020-08-28 | 2020-11-10 | 中山大学 | 一种结合轨迹规划的康复机器人变阻抗控制方法 |
| CN112086166A (zh) * | 2020-09-18 | 2020-12-15 | 常州市中医医院 | 一种骨科患者皮肤牵引护理方法与系统 |
| CN112171670A (zh) * | 2020-09-22 | 2021-01-05 | 北京石油化工学院 | 一种康复机器人等张运动控制方法及系统 |
| CN113520802A (zh) * | 2021-08-24 | 2021-10-22 | 上海卓道医疗科技有限公司 | 肢体康复训练设备以及控制方法 |
| CN114055461A (zh) * | 2021-08-20 | 2022-02-18 | 华中科技大学 | 基于肌电接口的机器人力位同步遥操作控制方法及装置 |
| CN114089757A (zh) * | 2021-11-17 | 2022-02-25 | 北京石油化工学院 | 一种上下肢协调主动康复机器人控制方法及装置 |
| CN114147687A (zh) * | 2021-12-02 | 2022-03-08 | 中国科学技术大学 | 用于下肢外骨骼实时人机主导切换协同控制的方法与系统 |
| CN114569410A (zh) * | 2022-05-06 | 2022-06-03 | 卓道医疗科技(浙江)有限公司 | 康复机器人训练模式的控制方法、装置及存储介质 |
| CN118078583A (zh) * | 2024-04-28 | 2024-05-28 | 江西求是高等研究院 | 一种上肢康复助动方法、系统及机器人 |
Citations (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US4846466A (en) * | 1987-11-20 | 1989-07-11 | Stima Iii Michael W | Microprocessor controlled electro-hydraulic exercise system |
| US5944635A (en) * | 1998-01-28 | 1999-08-31 | Digital Concepts Of Missouri, Inc. | Safety shutdown and latch off |
| CN102058464A (zh) * | 2010-11-27 | 2011-05-18 | 上海大学 | 下肢康复机器人运动控制方法 |
| CN102631276A (zh) * | 2011-12-31 | 2012-08-15 | 中国科学院深圳先进技术研究院 | 康复训练机器人中的交互方法及系统 |
| CN102525712B (zh) * | 2012-03-01 | 2013-10-02 | 中山大学 | 一种绳牵引上肢康复机器人及其控制方法 |
| CN103610567A (zh) * | 2013-11-12 | 2014-03-05 | 北京理工大学 | 脑卒中偏瘫患者辅助康复训练机器人 |
| CN105796286A (zh) * | 2016-02-23 | 2016-07-27 | 东南大学 | 使用气囊传感器的下肢外骨骼机器人控制方法 |
| CN106730638A (zh) * | 2016-12-21 | 2017-05-31 | 华中科技大学 | 基于交互力识别运动意图的欠驱动康复机器人的控制方法 |
-
2017
- 2017-09-15 CN CN201710832598.4A patent/CN109091818B/zh active Active
Patent Citations (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US4846466A (en) * | 1987-11-20 | 1989-07-11 | Stima Iii Michael W | Microprocessor controlled electro-hydraulic exercise system |
| US5944635A (en) * | 1998-01-28 | 1999-08-31 | Digital Concepts Of Missouri, Inc. | Safety shutdown and latch off |
| CN102058464A (zh) * | 2010-11-27 | 2011-05-18 | 上海大学 | 下肢康复机器人运动控制方法 |
| CN102631276A (zh) * | 2011-12-31 | 2012-08-15 | 中国科学院深圳先进技术研究院 | 康复训练机器人中的交互方法及系统 |
| CN102525712B (zh) * | 2012-03-01 | 2013-10-02 | 中山大学 | 一种绳牵引上肢康复机器人及其控制方法 |
| CN103610567A (zh) * | 2013-11-12 | 2014-03-05 | 北京理工大学 | 脑卒中偏瘫患者辅助康复训练机器人 |
| CN105796286A (zh) * | 2016-02-23 | 2016-07-27 | 东南大学 | 使用气囊传感器的下肢外骨骼机器人控制方法 |
| CN106730638A (zh) * | 2016-12-21 | 2017-05-31 | 华中科技大学 | 基于交互力识别运动意图的欠驱动康复机器人的控制方法 |
Non-Patent Citations (1)
| Title |
|---|
| 罗东峰: "桌面式上肢康复机器人控制研究", 《中国博士学位论文全文数据库 信息科技辑》 * |
Cited By (21)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN109925675B (zh) * | 2019-01-15 | 2020-08-25 | 河南翔宇医疗设备股份有限公司 | 智能磨砂板触摸屏视觉同步方法、装置、系统及移动终端 |
| CN109925675A (zh) * | 2019-01-15 | 2019-06-25 | 河南翔宇医疗设备股份有限公司 | 智能磨砂板触摸屏视觉同步方法、装置、系统及移动终端 |
| CN111243706A (zh) * | 2020-01-19 | 2020-06-05 | 东南大学 | 基于变阻抗演示学习的上肢康复机器人训练任务生成方法 |
| CN111243706B (zh) * | 2020-01-19 | 2022-11-18 | 东南大学 | 基于变阻抗演示学习的上肢康复机器人训练任务生成方法 |
| CN111281743A (zh) * | 2020-02-29 | 2020-06-16 | 西北工业大学 | 一种上肢康复外骨骼机器人自适应柔顺控制方法 |
| CN111904795B (zh) * | 2020-08-28 | 2022-08-26 | 中山大学 | 一种结合轨迹规划的康复机器人变阻抗控制方法 |
| CN111904795A (zh) * | 2020-08-28 | 2020-11-10 | 中山大学 | 一种结合轨迹规划的康复机器人变阻抗控制方法 |
| CN112086166A (zh) * | 2020-09-18 | 2020-12-15 | 常州市中医医院 | 一种骨科患者皮肤牵引护理方法与系统 |
| CN112086166B (zh) * | 2020-09-18 | 2022-11-15 | 常州市中医医院 | 一种骨科患者皮肤牵引护理方法与系统 |
| CN112171670A (zh) * | 2020-09-22 | 2021-01-05 | 北京石油化工学院 | 一种康复机器人等张运动控制方法及系统 |
| CN112171670B (zh) * | 2020-09-22 | 2024-01-23 | 北京石油化工学院 | 一种康复机器人等张运动控制方法及系统 |
| CN114055461B (zh) * | 2021-08-20 | 2023-02-14 | 华中科技大学 | 基于肌电接口的机器人力位同步遥操作控制方法及装置 |
| CN114055461A (zh) * | 2021-08-20 | 2022-02-18 | 华中科技大学 | 基于肌电接口的机器人力位同步遥操作控制方法及装置 |
| CN113520802A (zh) * | 2021-08-24 | 2021-10-22 | 上海卓道医疗科技有限公司 | 肢体康复训练设备以及控制方法 |
| CN113520802B (zh) * | 2021-08-24 | 2024-03-12 | 上海卓道医疗科技有限公司 | 肢体康复训练设备以及控制方法 |
| CN114089757A (zh) * | 2021-11-17 | 2022-02-25 | 北京石油化工学院 | 一种上下肢协调主动康复机器人控制方法及装置 |
| CN114089757B (zh) * | 2021-11-17 | 2024-02-02 | 北京石油化工学院 | 一种上下肢协调主动康复机器人控制方法及装置 |
| CN114147687A (zh) * | 2021-12-02 | 2022-03-08 | 中国科学技术大学 | 用于下肢外骨骼实时人机主导切换协同控制的方法与系统 |
| CN114147687B (zh) * | 2021-12-02 | 2024-02-23 | 中国科学技术大学 | 用于下肢外骨骼实时人机主导切换协同控制的方法与系统 |
| CN114569410A (zh) * | 2022-05-06 | 2022-06-03 | 卓道医疗科技(浙江)有限公司 | 康复机器人训练模式的控制方法、装置及存储介质 |
| CN118078583A (zh) * | 2024-04-28 | 2024-05-28 | 江西求是高等研究院 | 一种上肢康复助动方法、系统及机器人 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN109091818B (zh) | 2020-08-21 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN109091818A (zh) | 基于导纳控制的绳牵引上肢康复机器人的训练方法及系统 | |
| CN108785997B (zh) | 一种基于变导纳的下肢康复机器人柔顺控制方法 | |
| CN103263338B (zh) | 一种上肢康复机器人 | |
| CN111631726B (zh) | 上肢功能评估装置与方法及上肢康复训练系统与方法 | |
| CN107296718B (zh) | 气压肌肉驱动兼具上肢助力与复健训练功能之外骨骼装置 | |
| CN104586608B (zh) | 基于肌电控制的可穿戴式助力手指及其控制方法 | |
| CN107397649B (zh) | 一种基于径向基神经网络上肢外骨骼运动意图识别方法 | |
| CN110742775A (zh) | 基于力反馈技术的上肢主被动康复训练机器人系统 | |
| CN100594867C (zh) | 一种穿戴式手功能康复机器人及其控制系统 | |
| CN103845184B (zh) | 一种绳索驱动的外骨骼式上肢康复机器人系统 | |
| CN201164564Y (zh) | 一种穿戴式手功能康复机器人及其控制系统 | |
| CN105031908B (zh) | 一种平衡矫正式训练装置 | |
| CN102698411B (zh) | 坐卧式下肢康复机器人 | |
| CN107050763B (zh) | 一种新型踝关节康复机器人其控制方法 | |
| CN102525795B (zh) | 一种足部按摩机器人快速自动定位方法 | |
| CN103735389B (zh) | 一种手指间协调性训练康复装置 | |
| CN110215676A (zh) | 一种上肢双臂康复训练人机交互方法和系统 | |
| CN105963926A (zh) | 多模态融合手功能康复训练与智能评估系统 | |
| CN108814894A (zh) | 基于视觉人体位姿检测的上肢康复机器人系统及使用方法 | |
| CN107411935A (zh) | 一种用于软体康复机械手的多模式脑机接口控制方法 | |
| CN104382595A (zh) | 基于肌电信号与虚拟现实交互技术的上肢康复系统及方法 | |
| CN106779045A (zh) | 基于虚拟场景交互的康复训练机器人系统及其使用方法 | |
| CN106074089B (zh) | 一种双手跟踪式手指康复机器人系统 | |
| CN106974795A (zh) | 一种欠驱动上肢康复机器人控制系统 | |
| CN103750975A (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 |