CN112171670A - 一种康复机器人等张运动控制方法及系统 - Google Patents
一种康复机器人等张运动控制方法及系统 Download PDFInfo
- Publication number
- CN112171670A CN112171670A CN202011000235.2A CN202011000235A CN112171670A CN 112171670 A CN112171670 A CN 112171670A CN 202011000235 A CN202011000235 A CN 202011000235A CN 112171670 A CN112171670 A CN 112171670A
- Authority
- CN
- China
- Prior art keywords
- robot
- moment
- rehabilitation
- patient
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 34
- 238000013016 damping Methods 0.000 claims description 21
- 230000008859 change Effects 0.000 claims description 20
- 238000010586 diagram Methods 0.000 claims description 7
- 238000012545 processing Methods 0.000 claims description 6
- 230000004044 response Effects 0.000 claims description 6
- 238000012549 training Methods 0.000 abstract description 18
- 230000008569 process Effects 0.000 abstract description 11
- 238000004088 simulation Methods 0.000 description 10
- 210000002310 elbow joint Anatomy 0.000 description 5
- 230000003189 isokinetic effect Effects 0.000 description 5
- 210000003205 muscle Anatomy 0.000 description 4
- 238000011161 development Methods 0.000 description 2
- 239000003814 drug Substances 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 238000006467 substitution reaction Methods 0.000 description 2
- 210000001364 upper extremity Anatomy 0.000 description 2
- 208000025978 Athletic injury Diseases 0.000 description 1
- 206010041738 Sports injury Diseases 0.000 description 1
- 238000004458 analytical method Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 210000003414 extremity Anatomy 0.000 description 1
- 210000004394 hip joint Anatomy 0.000 description 1
- 210000000629 knee joint Anatomy 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000000474 nursing effect Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 210000000323 shoulder joint Anatomy 0.000 description 1
- 238000002560 therapeutic procedure Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1628—Programme controls characterised by the control loop
- B25J9/1633—Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Rehabilitation Tools (AREA)
Abstract
本发明涉及一种康复机器人等张运动控制方法及系统,该方法通过获取患者施加到机器人关节上的实际力矩,对实际力矩与可变负载的力矩求和,得到驱动力矩,将所述驱动力矩输入到导纳模型中,导纳模型根据所述驱动力矩输出机器人关节的康复运动轨迹,控制康复机器人带动患者运动,本发明提供的技术方案,由于对每个患者来说,可变负载是提前设置好的,是不变的,所以该运动为等张运动,通过改变负载的大小,可以实现不同阻力的等张运动;由于在等张运动训练过程中,可变负载的力矩会抵消一部分患者施加到机器人关节上的实际力矩,患者在训练过程中会感觉费力,提高了运动控制的跟踪精度,改善了系统的柔顺性,使治疗精准度提高。
Description
技术领域
本发明涉及康复机器人运动控制技术领域,具体涉及一种康复机器人等张运动控制方法及系统。
背景技术
随着全民运动的兴起,运动损伤的发生比例越来越高。康复机器人作为医疗机器人的一个重要分支,它的研究贯穿了康复医学、生物力学、机械学、机械力学、电子学、材料学、计算机科学以及机器人学等诸多领域,已经成为了国际机器人领域的一个研究热点。目前,康复机器人已经广泛地应用到康复护理、假肢和康复治疗等方面,这不仅促进了康复医学的发展,也带动了相关领域的新技术和新理论的发展。
目前康复机器人,对于主动康复训练大多进行阻抗控制的研究,阻抗控制的基本思路是将力的偏差信号反馈到位置伺服环,而力的偏差信号和位置之间的关系称为目标阻抗,通过调节目标阻抗可以实现系统的柔顺控制。但阻抗控制的跟踪精度不高,系统的柔顺性不好,给患者的康复训练带来困难。
发明内容
有鉴于此,本发明的目的在于克服现有技术的不足,提供一种康复机器人等张运动控制方法及系统,以解决现有技术中康复机器人阻抗控制中跟踪精度不高、柔顺性不好的问题。
为实现以上目的,本发明采用如下技术方案:
一种康复机器人等张运动控制方法,包括:
获取患者施加到机器人关节上的实际力矩;
读取预先设置的可变负载的力矩;
对实际力矩与可变负载的力矩求和,并将求和结果输入到导纳模型中,以使导纳模型输出机器人关节的康复运动轨迹,控制康复机器人带动患者运动;
其中,患者施加到机器人关节上的实际力矩与可变负载的力矩方向相反。
优选地,所述方法,还包括:
通过调节可变负载的力矩的大小实现不同阻力的等张康复运动;和/或,
通过调节导纳模型中的导纳参数实现不同阻力的等张康复运动。
优选地,所述获取患者施加到机器人关节上的实际力矩,包括:
通过关节电机码盘,获取机器人关节的运动状态;
通过关节力矩传感器,获取机器人关节实际受到的和力矩;
根据机器人关节的运动状态,基于机器人动力学模型,求解出机器人关节所受的关节电机的驱动力矩;
从所述和力矩中减去关节电机的驱动力矩,分离出患者施加到机器人关节上的实际力矩;
其中,所述关节力矩传感器,安装在关节电机和机器人关节之间。
优选地,所述导纳模型根据所述驱动力矩输出机器人关节的康复运动轨迹,控制康复机器人带动患者运动,具体为:
导纳模型根据驱动力矩计算出机器人关节相应的运动增量;
将运动增量和机器人实际位置叠加后,由伺服控制器控制机器人运动。
优选地,所述导纳参数至少包括:
惯性参数、阻尼参数、刚度参数。
优选地,通过以下步骤优化所述导纳参数,包括:
初始化惯性参数和阻尼参数,通过观察不同刚度参数下,机器人关节的运动速度时间变化图,选择系统柔顺性最好时所对应的刚度参数;
将系统柔顺性最好时的刚度参数,及初始化的惯性参数输入到导纳模型,通过设置不同的阻尼参数,获取不同的运动速度时间变化曲线;
选择理想的运动速度时间变化曲线所对应的阻尼参数,及系统柔顺性最好时的刚度参数输入到导纳模型,通过设置不同的惯性参数,获取不同的运动速度时间变化曲线;
通过观察所述运动速度时间变化曲线,选择理解的机器人关节速度响应时间和系统柔顺性所对应的惯性参数。
另外,本发明还提出了一种康复机器人等张运动控制系统,包括:
获取模块,用于获取患者施加到机器人关节上的实际力矩;
读取模块,用于读取预先设置的可变负载的力矩;
计算模块,用于对实际力矩与可变负载的力矩求和,并将求和结果输入到导纳模型中,以使导纳模型输出机器人关节的康复运动轨迹,控制康复机器人带动患者运动;
其中,患者施加到机器人关节上的实际力矩与可变负载的力矩方向相反。
优选地,所述系统,还包括:
调节模块,用于通过调节可变负载的力矩的大小实现不同阻力的等张康复运动;和/或,
通过调节导纳模型中的导纳参数实现不同阻力的等张康复运动。
优选地,所述导纳模型根据所述驱动力矩输出机器人关节的康复运动轨迹,控制康复机器人带动患者运动,具体为:
导纳模型根据驱动力矩计算出机器人关节相应的运动增量;
将运动增量和机器人实际位置叠加后,由伺服控制器控制机器人运动。
另外,本发明还提出了一种康复机器人等张运动控制系统,包括:
处理器,
用于存储处理器可执行指令的存储器;
其中,所述处理器被配置为:
获取患者施加到机器人关节上的实际力矩;
读取预先设置的可变负载的力矩;
对实际力矩与可变负载的力矩求和,并将求和结果输入到导纳模型中,以使导纳模型输出机器人关节的康复运动轨迹,控制康复机器人带动患者运动;
其中,患者施加到机器人关节上的实际力矩与可变负载的力矩方向相反。
本发明采用以上技术方案,至少具备以下有益效果:
通过获取患者施加到机器人关节上的实际力矩,对实际力矩与可变负载的力矩求和,得到驱动力矩,将所述驱动力矩输入到导纳模型中,导纳模型根据所述驱动力矩输出机器人关节的康复运动轨迹,控制康复机器人带动患者运动,本发明提供的技术方案,由于对每个患者来说,可变负载是提前设置好的,是不变的,所以该运动为等张运动,通过改变负载的大小,可以实现不同阻力的等张运动;由于在等张运动训练过程中,可变负载的力矩会抵消一部分患者施加到机器人关节上的实际力矩,患者在训练过程中会感觉费力,提高了运动控制的跟踪精度,改善了系统的柔顺性,使治疗精准度提高。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明一实施例提供的一种康复机器人等张运动控制方法的流程图;
图2为本发明一实施例提供的康复机器人基本导纳控制模型的示意图;
图3为本发明一实施例提供的基于导纳控制的等张运动控制模型的示意图;
图4A~图4B为本发明一实施例提供的康复机器人等张运动控制的仿真模型;
图5为本发明一实施例提供的不同刚度参数下机器人关节的速度时间变化曲线图;
图6为本发明一实施例提供的不同阻尼参数下机器人关节的速度时间变化曲线图;
图7为本发明一实施例提供的不同惯性参数下机器人关节的速度时间变化曲线图;
图8为本发明一实施例提供的患者的实际力矩和可变负载的力矩曲线图;
图9A~9B为本发明另一实施例提供的康复机器人等张运动控制的仿真模型;
图10为本发明另一实施例提供的等张运动时机器人关节角度变化曲线图;
图11为本发明另一实施例提供的等张运动时机器人关节速度变化曲线图;
图12为本发明另一实施例提供的等张运动控制仿真模型检测到的患者力矩曲线图;
图13为本发明另一实施例提供的等张运动时机器人关节速度变化曲线图;
图14为本发明一实施例提供的患者施加的实际力矩和等张运动控制仿真模型检测到的患者力矩曲线图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚,下面将对本发明的技术方案进行详细的描述。显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动的前提下所得到的所有其它实施方式,都属于本发明所保护的范围。
下面通过附图和实施例,对本发明的技术方案做进一步的详细描述。
参见图1,本发明一实施例提出的一种康复机器人等张运动控制方法,包括:
步骤S1、获取患者施加到机器人关节上的实际力矩;
步骤S2、读取预先设置的可变负载的力矩;
步骤S3、对实际力矩与可变负载的力矩求和,并将求和结果输入到导纳模型中,以使导纳模型输出机器人关节的康复运动轨迹,控制康复机器人带动患者运动;
其中,患者施加到机器人关节上的实际力矩与可变负载的力矩方向相反。
需要说明的是,在使用等张康复设备前,需要对患者的肌力情况进行测试,得到患者具体的肌力大小后,建立肌力大小与可变负载的力矩对应表,按照肌力大小与可变负载的力矩对应表,对可变负载的力矩进行设置,该对应表通过实验数据得到。
可以理解的是,本实施例提供的技术方案,通过获取患者施加到机器人关节上的实际力矩,对实际力矩与可变负载的力矩求和,得到驱动力矩,将所述驱动力矩输入到导纳模型中,导纳模型根据所述驱动力矩输出机器人关节的康复运动轨迹,控制康复机器人带动患者运动,本实施例提供的技术方案,由于对每个患者来说,可变负载是提前设置好的,是不变的,所以该运动为等张运动,通过改变负载的大小,可以实现不同阻力的等张运动;由于在等张运动训练过程中,可变负载的力矩会抵消一部分患者施加到机器人关节上的实际力矩,患者在训练过程中会感觉费力,提高了运动控制的跟踪精度,改善了系统的柔顺性,使治疗精准度提高。
优选地,所述获取患者施加到机器人关节上的实际力矩,包括:
通过关节电机码盘,获取机器人关节的运动状态;
通过关节力矩传感器,获取机器人关节实际受到的和力矩;
根据机器人关节的运动状态,基于机器人动力学模型,求解出机器人关节所受的关节电机的驱动力矩;
从所述和力矩中减去关节电机的驱动力矩,分离出患者施加到机器人关节上的实际力矩;
其中,所述关节力矩传感器,安装在关节电机和机器人关节之间。
可以理解的是,本实施例提供的技术方案,通过获取机器人关节的运动状态及机器人关节实际受到的和力矩,根据机器人关节的运动状态,基于机器人动力学模型,求解出机器人关节所受的关节电机的驱动力矩,从所述和力矩中减去关节电机的驱动力矩,从而分离出患者施加到机器人关节上的实际力矩,操作简单、数据精准、用户体验度好、满意度高。
优选地,所述关节力矩传感器为单轴的力矩传感器。
优选地,所述机器人关节的运动状态,至少包括:
肩关节的运动状态、肘关节的运动状态、髋关节的运动状态、膝关节的运动状态。
需要说明的是,所述各关节的运动状态至少包括:屈曲伸展、内收外展、内旋外旋等。
可以理解的是,在不考虑关节力矩传感器微小形变量的情况下,机器人关节的运动状态和其所受的电机驱动力之间存在动力学关系。机器人关节的运动状态可以通过关节电机码盘获得,再通过机器人动力学模型即可以求解机器人关节所受的电机驱动力矩,从关节力矩传感器的示数中减去电机驱动力矩部分即可分离出患者施加到机器人关节上的实际力矩。
优选地,所述导纳模型根据所述驱动力矩输出机器人关节的康复运动轨迹,控制康复机器人带动患者运动,具体为:
导纳模型根据驱动力矩计算出机器人关节相应的运动增量;
将运动增量和机器人实际位置叠加后,由伺服控制器控制机器人运动。
图2为康复机器人基本导纳控制模型的示意图,参见图2,基本导纳控制模型中各个变量的含义如下:
F患表示患者施加到机器人关节上的实际作用力;
τ患表示患者施加到机器人关节上的实际力矩;
τ传表示关节力矩传感器的示数,即机器人关节实际受到的和力矩;
τ驱表示机器人关节所受的关节电机的驱动力矩;
τe表示分离出的患者施加到机器人关节上的实际力矩;
Xd表示机器人期望位置;
X表示机器人的实际位置;
Xe表示机器人期望位置与实际位置之差:Xe=Xd-X。
由上述康复机器人患者实际力矩计算方法可知:τe=τ患=τ传-τ驱。在图4A~图4B的导纳控制模型中,患者施加到机器人上的作用力F患通过机器人关节,间接作用到关节力矩传感器上。关节力矩传感器τ传表示患者施加到机器人关节上的力矩τ患和电机的驱动力矩τ驱的和,通过关节力矩传感器τ传和电机的驱动力矩τ驱求差,即可分离出患者施加的实际力矩τe。
图3为基于导纳控制的等张运动控制模型的示意图,图3为在图2的基础上变形得到。参见图3,等张运动控制模型在图2的基础上增加了可变负载的力矩τ负,通过调节可变负载的力矩大小即可实现不同阻力的等张康复运动。
在图3所示的等张运动控制模型中,患者施加的实际力矩τe减去可变负载的力矩τ负后作为导纳模型的输入τr,导纳模型根据输入力矩τr计算出机器人关节相应的运动增量Xe,运动增量和机器人实际位置叠加后,由伺服控制器控制机器人运动。在此模型中,可变负载的力矩τ负会抵消患者施加的实际力矩τe,患者在训练过程中会始终感受到可变负载的力矩的存在。在实际模型中,由于患者施加的实际力矩τe可正可负,所以可变负载的力矩τ负同样可正可负,但需要保证其始终和患者施加的力矩符号相反。所以通过图3所示的等张运动控制模型,便可以实现机器人的等张康复训练。
优选地,所述方法,还包括:
通过调节可变负载的力矩的大小实现不同阻力的等张康复运动;和/或,
通过调节导纳模型中的导纳参数实现不同阻力的等张康复运动。
优选地,所述导纳参数至少包括:
惯性参数、阻尼参数、刚度参数。
优选地,通过以下步骤优化所述导纳参数,包括:
初始化惯性参数和阻尼参数,通过观察不同刚度参数下,机器人关节的运动速度时间变化图,选择系统柔顺性最好时所对应的刚度参数;
将系统柔顺性最好时的刚度参数,及初始化的惯性参数输入到导纳模型,通过设置不同的阻尼参数,获取不同的运动速度时间变化曲线;
选择理想的运动速度时间变化曲线所对应的阻尼参数,及系统柔顺性最好时的刚度参数输入到导纳模型,通过设置不同的惯性参数,获取不同的运动速度时间变化曲线;
通过观察所述运动速度时间变化曲线,选择理解的机器人关节速度响应时间和系统柔顺性所对应的惯性参数。
参见图4A~图4B,以康复机器人的上肢的肘关节的运动控制为例,在Matlab中对本实施例提供的这种等张运动控制方法进行了仿真模拟和导纳参数优化,仿真模型如图4A~图4B所示。
对于等张运动,假设患者在机器人肘关节施加的实际力矩为5Nm,设置可变负载的力矩为5Nm的阶跃信号,初选惯性参数M=0.1,阻尼参数B=10,分别设刚度参数K=0,0.01,0.1,1,10,观察机器人关节运动速度随时间的变化情况如图5所示。参见图5,当刚度参数K逐渐变大时,控制系统刚度随之增大,患者训练时就像压缩一个刚度很大的弹簧,患者的运动速度会逐渐变小为零。通过以上分析可知,设置刚度系数只会使系统变“硬”,柔顺性变差。所以为了提高系统的柔顺性,此模型取K=0。
设置刚度参数K=0,初选惯性参数M=0.1,分别设阻尼参数B=0,0.1,1,10,100,观察机器人关节运动速度随时间的变化情况如图6所示。参见图6,当阻尼参数逐渐变大时,系统的阻尼系数变大,机器人关节的运动速度会被拖慢并逐渐变小,当阻尼系数无限大时,机器人关节的运动速度会变为零。在等张控制模型中,要根据可变负载大小和康复运动速度合理设置阻尼参数,在此取B=100。
设置刚度参数K=0,阻尼参数B=100,分别设惯性参数M=0,1,5,10,20,观察机器人关节运动速度随时间的变化情况如图7所示。参见图7,当惯性参数逐渐变大时,系统的质量变大,机器人关节的运动速度响应会逐渐变慢,对于不同的康复方法应设置不同的惯性参数。例如,阻力运动的惯性参数可以取大一点,虽然机器人关节速度响应较慢,但有利于提高训练过程的柔顺性;阻力运动的惯性参数可以取小一点,提高机器人关节响应速度,快速达到康复训练速度,有利于提高训练效果。在此取M=1。
由此,通过控制变量法,得到了针对当前机器人平台和等张运动控制模型的最优导纳参数:M=1,B=100,K=0。
在得到等张运动控制模型的优化导纳参数后,本发明设计了患者的实际力矩曲线,并根据动态施载方法画出了可变负载的力矩曲线,如图8所示。患者力矩曲线中预设力矩为20Nm,0-0.5S患者关节向正方向施加作用力,0.5-4.5S患者关节持续施向正方向加20Nm力矩,4.5-5S患者关节停止施加作用力;5-10S患者的作用力大小与1-5S相同,方向相反。
将患者的实际力矩曲线导入控制模型后,由仿真结果可知机器人关节在4.8625S时速度会变为0。可变负载的力矩曲线中,滞后量设置为10Nm,0-0.25S患者的实际力矩小于滞后量,可变负载的力矩值为0;0.2-0.5S负载的力矩大小为患者的实际力矩的相反数,再滞后10Nm;0.5-4.5S患者的实际力矩大于等于预设力矩,负载为-20Nm;4.5-4.8625S患者的实际力矩变小,负载力矩不变;4.8625S-5S当机器人关节速度变为0时,负载的力矩也为0。
在此同样以上肢肘关节为例,将患者的实际力矩曲线和可变负载的力矩曲线加载到Matlab模型中进行了仿真,仿真模型如图9A~图9B所示。
控制系统仿真后,得到了机器人关节的角度变化如图10所示,机器人关节的速度变化如图11所示,机器人检测到的患者力矩如图12所示。
参见图10,机器人关节在0-1.935rad之间运动,属于肘关节的关节活动度内,且运动曲线光滑,0S和10S的角度误差为0.0061rad;参见图11,机器人关节的最大运动速度为0.455rad/s,大小合理,曲线光滑,运行平稳;参见图13,机器人检测到的患者力矩与患者施加的实际力矩几乎一致。
通过图13仿真可得,在0.5S-4.5S,5.5S-9.5S两个时间段内,患者施加的力矩值恒定为20Nm和-20Nm,通过等张运动控制模型,患者可以稳定地进行等张运动训练。
另外,参见图14,本发明另一实施例还提出的一种康复机器人等张运动控制系统100,包括:
获取模块101,用于获取患者施加到机器人关节上的实际力矩;
读取模块102,用于读取预先设置的可变负载的力矩;
计算模块103,用于对实际力矩与可变负载的力矩求和,并将求和结果输入到导纳模型中,以使导纳模型输出机器人关节的康复运动轨迹,控制康复机器人带动患者运动;
其中,患者施加到机器人关节上的实际力矩与可变负载的力矩方向相反。
可以理解的是,本实施例提供的技术方案,通过获取患者施加到机器人关节上的实际力矩,对实际力矩与可变负载的力矩求和,得到驱动力矩,将所述驱动力矩输入到导纳模型中,导纳模型根据所述驱动力矩输出机器人关节的康复运动轨迹,控制康复机器人带动患者运动,本实施例提供的技术方案,由于对每个患者来说,可变负载是提前设置好的,是不变的,所以该运动为等张运动,通过改变负载的大小,可以实现不同阻力的等张运动;由于在等张运动训练过程中,可变负载的力矩会抵消一部分患者施加到机器人关节上的实际力矩,患者在训练过程中会感觉费力,提高了运动控制的跟踪精度,改善了系统的柔顺性,使治疗精准度提高。
优选地,所述系统,还包括:
调节模块,用于通过调节可变负载的力矩的大小实现不同阻力的等张康复运动;和/或,
通过调节导纳模型中的导纳参数实现不同阻力的等张康复运动。
优选地,所述导纳模型根据所述驱动力矩输出机器人关节的康复运动轨迹,控制康复机器人带动患者运动,具体为:
导纳模型根据驱动力矩计算出机器人关节相应的运动增量;
将运动增量和机器人实际位置叠加后,由伺服控制器控制机器人运动。
优选地,所述导纳参数至少包括:
惯性参数、阻尼参数、刚度参数。
另外,本发明另一实施例还提出的一种康复机器人等张运动控制系统,包括:
处理器,
用于存储处理器可执行指令的存储器;
其中,所述处理器被配置为:
获取患者施加到机器人关节上的实际力矩;
读取预先设置的可变负载的力矩;
对实际力矩与可变负载的力矩求和,并将求和结果输入到导纳模型中,以使导纳模型输出机器人关节的康复运动轨迹,控制康复机器人带动患者运动;
其中,患者施加到机器人关节上的实际力矩与可变负载的力矩方向相反。
可以理解的是,本实施例提供的技术方案,通过获取患者施加到机器人关节上的实际力矩,对实际力矩与可变负载的力矩求和,得到驱动力矩,将所述驱动力矩输入到导纳模型中,导纳模型根据所述驱动力矩输出机器人关节的康复运动轨迹,控制康复机器人带动患者运动,本实施例提供的技术方案,由于对每个患者来说,可变负载是提前设置好的,是不变的,所以该运动为等张运动,通过改变负载的大小,可以实现不同阻力的等张运动;由于在等张运动训练过程中,可变负载的力矩会抵消一部分患者施加到机器人关节上的实际力矩,患者在训练过程中会感觉费力,提高了运动控制的跟踪精度,改善了系统的柔顺性,使治疗精准度提高。
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到变化或替换,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应以所述权利要求的保护范围为准。术语“第一”、“第二”仅用于描述目的,而不能理解为指示或暗示相对重要性。术语“多个”指两个或两个以上,除非另有明确的限定。
Claims (10)
1.一种康复机器人等张运动控制方法,其特征在于,包括:
获取患者施加到机器人关节上的实际力矩;
读取预先设置的可变负载的力矩;
对实际力矩与可变负载的力矩求和,并将求和结果输入到导纳模型中,以使导纳模型输出机器人关节的康复运动轨迹,控制康复机器人带动患者运动;
其中,患者施加到机器人关节上的实际力矩与可变负载的力矩方向相反。
2.根据权利要求1所述的方法,其特征在于,所述方法,还包括:
通过调节可变负载的力矩的大小实现不同阻力的等张康复运动;和/或,
通过调节导纳模型中的导纳参数实现不同阻力的等张康复运动。
3.根据权利要求1所述的方法,其特征在于,所述获取患者施加到机器人关节上的实际力矩,包括:
通过关节电机码盘,获取机器人关节的运动状态;
通过关节力矩传感器,获取机器人关节实际受到的和力矩;
根据机器人关节的运动状态,基于机器人动力学模型,求解出机器人关节所受的关节电机的驱动力矩;
从所述和力矩中减去关节电机的驱动力矩,分离出患者施加到机器人关节上的实际力矩;
其中,所述关节力矩传感器,安装在关节电机和机器人关节之间。
4.根据权利要求1所述的方法,其特征在于,所述导纳模型根据所述驱动力矩输出机器人关节的康复运动轨迹,控制康复机器人带动患者运动,具体为:
导纳模型根据驱动力矩计算出机器人关节相应的运动增量;
将运动增量和机器人实际位置叠加后,由伺服控制器控制机器人运动。
5.根据权利要求2所述的方法,其特征在于,所述导纳参数至少包括:
惯性参数、阻尼参数、刚度参数。
6.根据权利要求5所述的方法,其特征在于,通过以下步骤优化所述导纳参数,包括:
初始化惯性参数和阻尼参数,通过观察不同刚度参数下,机器人关节的运动速度时间变化图,选择系统柔顺性最好时所对应的刚度参数;
将系统柔顺性最好时的刚度参数,及初始化的惯性参数输入到导纳模型,通过设置不同的阻尼参数,获取不同的运动速度时间变化曲线;
选择理想的运动速度时间变化曲线所对应的阻尼参数,及系统柔顺性最好时的刚度参数输入到导纳模型,通过设置不同的惯性参数,获取不同的运动速度时间变化曲线;
通过观察所述运动速度时间变化曲线,选择理解的机器人关节速度响应时间和系统柔顺性所对应的惯性参数。
7.一种康复机器人等张运动控制系统,其特征在于,包括:
获取模块,用于获取患者施加到机器人关节上的实际力矩;
读取模块,用于读取预先设置的可变负载的力矩;
计算模块,用于对实际力矩与可变负载的力矩求和,并将求和结果输入到导纳模型中,以使导纳模型输出机器人关节的康复运动轨迹,控制康复机器人带动患者运动;
其中,患者施加到机器人关节上的实际力矩与可变负载的力矩方向相反。
8.根据权利要求7所述的系统,其特征在于,还包括:
调节模块,用于通过调节可变负载的力矩的大小实现不同阻力的等张康复运动;和/或,
通过调节导纳模型中的导纳参数实现不同阻力的等张康复运动。
9.根据权利要求7所述的系统,其特征在于,所述导纳模型根据所述驱动力矩输出机器人关节的康复运动轨迹,控制康复机器人带动患者运动,具体为:
导纳模型根据驱动力矩计算出机器人关节相应的运动增量;
将运动增量和机器人实际位置叠加后,由伺服控制器控制机器人运动。
10.一种康复机器人等张运动控制系统,其特征在于,包括:
处理器,
用于存储处理器可执行指令的存储器;
其中,所述处理器被配置为:
获取患者施加到机器人关节上的实际力矩;
读取预先设置的可变负载的力矩;
对实际力矩与可变负载的力矩求和,并将求和结果输入到导纳模型中,以使导纳模型输出机器人关节的康复运动轨迹,控制康复机器人带动患者运动;
其中,患者施加到机器人关节上的实际力矩与可变负载的力矩方向相反。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011000235.2A CN112171670B (zh) | 2020-09-22 | 2020-09-22 | 一种康复机器人等张运动控制方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011000235.2A CN112171670B (zh) | 2020-09-22 | 2020-09-22 | 一种康复机器人等张运动控制方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112171670A true CN112171670A (zh) | 2021-01-05 |
CN112171670B CN112171670B (zh) | 2024-01-23 |
Family
ID=73956436
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011000235.2A Active CN112171670B (zh) | 2020-09-22 | 2020-09-22 | 一种康复机器人等张运动控制方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112171670B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113069315A (zh) * | 2021-03-24 | 2021-07-06 | 上海傅利叶智能科技有限公司 | 机器人提供助力的方法、装置和康复机器人 |
CN114089757A (zh) * | 2021-11-17 | 2022-02-25 | 北京石油化工学院 | 一种上下肢协调主动康复机器人控制方法及装置 |
Citations (30)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5400244A (en) * | 1991-06-25 | 1995-03-21 | Kabushiki Kaisha Toshiba | Running control system for mobile robot provided with multiple sensor information integration system |
CN101632857A (zh) * | 2008-07-21 | 2010-01-27 | 王国梁 | 往复式运动器的惯性负载机构 |
US20120101414A1 (en) * | 2009-05-25 | 2012-04-26 | Reha Technologies Gmbh | Device for therapeutically treating and/or training the lower extremities of a person |
US20130173059A1 (en) * | 2012-01-02 | 2013-07-04 | Hyundai Motor Company | Method and system for controlling driving of wearable robot |
US20130245829A1 (en) * | 2012-03-15 | 2013-09-19 | Jtekt Corporation | Robot control method, robot control device, and robot control system |
CN103690333A (zh) * | 2013-12-25 | 2014-04-02 | 南京理工大学 | 一种带生物力反馈的可变刚度膝关节康复训练装置及其方法 |
CN104723340A (zh) * | 2015-03-07 | 2015-06-24 | 哈尔滨工业大学 | 基于连接和阻尼配置的柔性关节机械臂的阻抗控制方法 |
CN104869969A (zh) * | 2012-09-17 | 2015-08-26 | 哈佛大学校长及研究员协会 | 用于辅助人类运动的软式外装护具 |
WO2015177634A1 (en) * | 2014-05-22 | 2015-11-26 | Toyota Jidosha Kabushiki Kaisha | Rehabilitation apparatus, control method, and control program |
US20160052128A1 (en) * | 2014-08-20 | 2016-02-25 | Kuka Roboter Gmbh | Method Of Programming An Industrial Robot And Industrial Robots |
US20160051433A1 (en) * | 2013-04-12 | 2016-02-25 | Sabanci Üniversitesi | A series elastic holonomic mobile platform for upper extremity rehabilitation |
CN105640740A (zh) * | 2016-03-24 | 2016-06-08 | 常州市建本医疗康复器材有限公司 | 一种智能康复方法及系统 |
US20160158601A1 (en) * | 2014-12-04 | 2016-06-09 | Korea Polytechnic University Industry Academic Cooperation Foundation | Human muscular strength amplification robot driven by intention of user and driving method thereof |
KR20160066083A (ko) * | 2014-12-01 | 2016-06-10 | 한국과학기술원 | 뇌졸중 환자를 위한 재활 로봇 제어방법 |
CN106094811A (zh) * | 2015-04-27 | 2016-11-09 | 华中科技大学 | 一种基于多传感器的助行机器人人机接口的避障控制方法 |
CN106726341A (zh) * | 2016-12-06 | 2017-05-31 | 西安交通大学 | 基于人机阻抗匹配模型的变刚度肘关节康复机器人及其控制方法 |
CN107553492A (zh) * | 2017-09-18 | 2018-01-09 | 北京卫星环境工程研究所 | 基于赫兹弹性模型的机器人主动力柔顺销孔对接装配方法 |
CN108983601A (zh) * | 2018-06-19 | 2018-12-11 | 江苏大学 | 一种提高采摘机器人柔顺抓取性能的参数自整定阻抗控制系统构造方法 |
CN109091818A (zh) * | 2017-09-15 | 2018-12-28 | 中山大学 | 基于导纳控制的绳牵引上肢康复机器人的训练方法及系统 |
CN109700627A (zh) * | 2018-12-29 | 2019-05-03 | 湖南健行智能机器人有限公司 | 一种膝关节康复机器人系统及其人机柔顺交互控制方法 |
CN109789025A (zh) * | 2016-09-29 | 2019-05-21 | 美国医疗设备有限公司 | 用于接纳和协助调配血管假体的柔顺性构件 |
CN109806106A (zh) * | 2019-02-01 | 2019-05-28 | 中山大学 | 一种基于鲁棒控制与导纳控制结合的下肢康复机器人的控制方法 |
CN109846672A (zh) * | 2019-03-07 | 2019-06-07 | 合肥工业大学 | 可变刚度的踝足康复矫形器及其运动控制方法 |
CN110202574A (zh) * | 2019-06-05 | 2019-09-06 | 南京航空航天大学 | 基于环境刚度估计的机器人自适应混合阻抗/导纳控制方法 |
CN110244791A (zh) * | 2019-07-11 | 2019-09-17 | 北京理工大学 | 一种双足机器人足部力和力矩跟随控制方法 |
CN110279557A (zh) * | 2019-07-02 | 2019-09-27 | 安徽工业大学 | 一种下肢康复机器人控制系统及控制方法 |
CN110279986A (zh) * | 2019-03-29 | 2019-09-27 | 中山大学 | 一种基于肌电信号的康复机器人控制方法 |
CN110597072A (zh) * | 2019-10-22 | 2019-12-20 | 上海电气集团股份有限公司 | 机器人导纳柔顺控制方法及系统 |
CN111243706A (zh) * | 2020-01-19 | 2020-06-05 | 东南大学 | 基于变阻抗演示学习的上肢康复机器人训练任务生成方法 |
CN111345971A (zh) * | 2020-03-14 | 2020-06-30 | 北京工业大学 | 一种基于导纳模型的踝康复机器人多模式柔顺训练方法 |
-
2020
- 2020-09-22 CN CN202011000235.2A patent/CN112171670B/zh active Active
Patent Citations (30)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5400244A (en) * | 1991-06-25 | 1995-03-21 | Kabushiki Kaisha Toshiba | Running control system for mobile robot provided with multiple sensor information integration system |
CN101632857A (zh) * | 2008-07-21 | 2010-01-27 | 王国梁 | 往复式运动器的惯性负载机构 |
US20120101414A1 (en) * | 2009-05-25 | 2012-04-26 | Reha Technologies Gmbh | Device for therapeutically treating and/or training the lower extremities of a person |
US20130173059A1 (en) * | 2012-01-02 | 2013-07-04 | Hyundai Motor Company | Method and system for controlling driving of wearable robot |
US20130245829A1 (en) * | 2012-03-15 | 2013-09-19 | Jtekt Corporation | Robot control method, robot control device, and robot control system |
CN104869969A (zh) * | 2012-09-17 | 2015-08-26 | 哈佛大学校长及研究员协会 | 用于辅助人类运动的软式外装护具 |
US20160051433A1 (en) * | 2013-04-12 | 2016-02-25 | Sabanci Üniversitesi | A series elastic holonomic mobile platform for upper extremity rehabilitation |
CN103690333A (zh) * | 2013-12-25 | 2014-04-02 | 南京理工大学 | 一种带生物力反馈的可变刚度膝关节康复训练装置及其方法 |
WO2015177634A1 (en) * | 2014-05-22 | 2015-11-26 | Toyota Jidosha Kabushiki Kaisha | Rehabilitation apparatus, control method, and control program |
US20160052128A1 (en) * | 2014-08-20 | 2016-02-25 | Kuka Roboter Gmbh | Method Of Programming An Industrial Robot And Industrial Robots |
KR20160066083A (ko) * | 2014-12-01 | 2016-06-10 | 한국과학기술원 | 뇌졸중 환자를 위한 재활 로봇 제어방법 |
US20160158601A1 (en) * | 2014-12-04 | 2016-06-09 | Korea Polytechnic University Industry Academic Cooperation Foundation | Human muscular strength amplification robot driven by intention of user and driving method thereof |
CN104723340A (zh) * | 2015-03-07 | 2015-06-24 | 哈尔滨工业大学 | 基于连接和阻尼配置的柔性关节机械臂的阻抗控制方法 |
CN106094811A (zh) * | 2015-04-27 | 2016-11-09 | 华中科技大学 | 一种基于多传感器的助行机器人人机接口的避障控制方法 |
CN105640740A (zh) * | 2016-03-24 | 2016-06-08 | 常州市建本医疗康复器材有限公司 | 一种智能康复方法及系统 |
CN109789025A (zh) * | 2016-09-29 | 2019-05-21 | 美国医疗设备有限公司 | 用于接纳和协助调配血管假体的柔顺性构件 |
CN106726341A (zh) * | 2016-12-06 | 2017-05-31 | 西安交通大学 | 基于人机阻抗匹配模型的变刚度肘关节康复机器人及其控制方法 |
CN109091818A (zh) * | 2017-09-15 | 2018-12-28 | 中山大学 | 基于导纳控制的绳牵引上肢康复机器人的训练方法及系统 |
CN107553492A (zh) * | 2017-09-18 | 2018-01-09 | 北京卫星环境工程研究所 | 基于赫兹弹性模型的机器人主动力柔顺销孔对接装配方法 |
CN108983601A (zh) * | 2018-06-19 | 2018-12-11 | 江苏大学 | 一种提高采摘机器人柔顺抓取性能的参数自整定阻抗控制系统构造方法 |
CN109700627A (zh) * | 2018-12-29 | 2019-05-03 | 湖南健行智能机器人有限公司 | 一种膝关节康复机器人系统及其人机柔顺交互控制方法 |
CN109806106A (zh) * | 2019-02-01 | 2019-05-28 | 中山大学 | 一种基于鲁棒控制与导纳控制结合的下肢康复机器人的控制方法 |
CN109846672A (zh) * | 2019-03-07 | 2019-06-07 | 合肥工业大学 | 可变刚度的踝足康复矫形器及其运动控制方法 |
CN110279986A (zh) * | 2019-03-29 | 2019-09-27 | 中山大学 | 一种基于肌电信号的康复机器人控制方法 |
CN110202574A (zh) * | 2019-06-05 | 2019-09-06 | 南京航空航天大学 | 基于环境刚度估计的机器人自适应混合阻抗/导纳控制方法 |
CN110279557A (zh) * | 2019-07-02 | 2019-09-27 | 安徽工业大学 | 一种下肢康复机器人控制系统及控制方法 |
CN110244791A (zh) * | 2019-07-11 | 2019-09-17 | 北京理工大学 | 一种双足机器人足部力和力矩跟随控制方法 |
CN110597072A (zh) * | 2019-10-22 | 2019-12-20 | 上海电气集团股份有限公司 | 机器人导纳柔顺控制方法及系统 |
CN111243706A (zh) * | 2020-01-19 | 2020-06-05 | 东南大学 | 基于变阻抗演示学习的上肢康复机器人训练任务生成方法 |
CN111345971A (zh) * | 2020-03-14 | 2020-06-30 | 北京工业大学 | 一种基于导纳模型的踝康复机器人多模式柔顺训练方法 |
Non-Patent Citations (5)
Title |
---|
左文昆: "基于导纳控制的上肢康复外骨骼主动训练方法研究", 中国优秀硕士学位论文全文数据库 信息科技辑, pages 140 - 322 * |
曹莹瑜: "运动性损伤康复机器人多功能床体设计", 北京石油化工学院学报 * |
杨帆: "基于sEMG的机械臂仿人变阻抗控制研究", 中国优秀硕士学位论文全文数据库 信息科技辑, no. 2 * |
王国帅: "针对运动损伤的上下肢康复机器人运动控制研究", 中国优秀硕士学位论文全文数据库 信息科技辑 * |
韩书娜: "康复锻炼用肌电控制机械手开发", 机床与液压 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113069315A (zh) * | 2021-03-24 | 2021-07-06 | 上海傅利叶智能科技有限公司 | 机器人提供助力的方法、装置和康复机器人 |
CN113069315B (zh) * | 2021-03-24 | 2024-02-20 | 上海傅利叶智能科技有限公司 | 机器人提供助力的方法、装置和康复机器人 |
CN114089757A (zh) * | 2021-11-17 | 2022-02-25 | 北京石油化工学院 | 一种上下肢协调主动康复机器人控制方法及装置 |
CN114089757B (zh) * | 2021-11-17 | 2024-02-02 | 北京石油化工学院 | 一种上下肢协调主动康复机器人控制方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN112171670B (zh) | 2024-01-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Karavas et al. | Tele-impedance based assistive control for a compliant knee exoskeleton | |
Zhang et al. | Admittance shaping-based assistive control of SEA-driven robotic hip exoskeleton | |
Khalili et al. | An intelligent robotic system for rehabilitation of joints and estimation of body segment parameters | |
Ghan et al. | Control and system identification for the Berkeley lower extremity exoskeleton (BLEEX) | |
Wang et al. | Model predictive control-based gait pattern generation for wearable exoskeletons | |
Kim et al. | An ankle–foot prosthesis emulator with control of plantarflexion and inversion–eversion torque | |
Durandau et al. | Neuromechanical model-based adaptive control of bilateral ankle exoskeletons: Biological joint torque and electromyogram reduction across walking conditions | |
CN107613936A (zh) | 外骨骼 | |
CN112171670A (zh) | 一种康复机器人等张运动控制方法及系统 | |
Baser et al. | Biomimetic compliant lower limb exoskeleton (BioComEx) and its experimental evaluation | |
CN112207823A (zh) | 一种康复机器人等速运动控制方法及系统 | |
Cao et al. | Optimizing control of passive gait training exoskeleton driven by pneumatic muscles using switch-mode firefly algorithm | |
Asl et al. | Satisfying task completion and assist-as-needed performance in robotic exoskeletons | |
Tsoi et al. | Design, modeling and control of an ankle rehabilitation robot | |
Mohan et al. | Conceptual Design and Control of a Sitting-Type Lower-Limb Rehabilitation System Established on a Spatial 3-P RRR Parallel Manipulator | |
Horn et al. | Nonholonomic virtual constraints for control of powered prostheses across walking speeds | |
Ayas et al. | A redundantly actuated ankle rehabilitation robot and its control strategies | |
CN114795604B (zh) | 基于非零和博弈的下肢假肢协调控制方法及系统 | |
Faraj et al. | Modeling and robust computed torque control for lower limb exoskeleton contacting with ground | |
Huang et al. | Gravity Compensation Based Control for Lower-Limb Load-Bearing Exoskeleton | |
Zhang et al. | Inhibitory connections between neural oscillators for a robotic suit | |
Lippi et al. | Identification of gait phases with neural networks for smooth transparent control of a lower limb exoskeleton | |
Naghavi et al. | Assist-as-needed control of a hip exoskeleton, using central pattern generators in a stride management strategy | |
Feng et al. | A perturbation platform and exoskeleton simulator for studying balance control of hip exoskeleton: Design and preliminary validation | |
Cheng et al. | Compliance Control of a Lower Limb Rehabilitation Robot in Mirror Therapy |
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 |