CN112140110A - 一种康复机器人患者实际力矩计算方法及系统 - Google Patents
一种康复机器人患者实际力矩计算方法及系统 Download PDFInfo
- Publication number
- CN112140110A CN112140110A CN202010999472.8A CN202010999472A CN112140110A CN 112140110 A CN112140110 A CN 112140110A CN 202010999472 A CN202010999472 A CN 202010999472A CN 112140110 A CN112140110 A CN 112140110A
- Authority
- CN
- China
- Prior art keywords
- joint
- robot
- torque
- patient
- moment
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 27
- 238000004364 calculation method Methods 0.000 claims description 10
- 210000002310 elbow joint Anatomy 0.000 claims description 3
- 210000004394 hip joint Anatomy 0.000 claims description 3
- 210000000629 knee joint Anatomy 0.000 claims description 3
- 210000000323 shoulder joint Anatomy 0.000 claims description 3
- 101100234547 Caenorhabditis elegans rod-1 gene Proteins 0.000 description 9
- 238000005381 potential energy Methods 0.000 description 7
- 230000005484 gravity Effects 0.000 description 6
- 238000010586 diagram Methods 0.000 description 4
- 238000004458 analytical method Methods 0.000 description 3
- 239000011159 matrix material Substances 0.000 description 3
- 230000001133 acceleration Effects 0.000 description 2
- 239000003814 drug Substances 0.000 description 2
- 210000001503 joint Anatomy 0.000 description 2
- 238000006467 substitution reaction Methods 0.000 description 2
- 239000013598 vector Substances 0.000 description 2
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 210000003414 extremity Anatomy 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 230000000474 nursing effect Effects 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/1674—Programme controls characterised by safety, monitoring, diagnostic
-
- 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/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/1607—Calculation of inertia, jacobian matrixes and inverses
-
- 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/0237—Stretching or bending or torsioning apparatus for exercising for the lower limbs
- A61H1/024—Knee
-
- 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/0237—Stretching or bending or torsioning apparatus for exercising for the lower limbs
- A61H1/0244—Hip
-
- 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
- A61H1/0277—Elbow
-
- 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
- A61H1/0281—Shoulder
-
- 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
-
- 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/12—Driving means
- A61H2201/1207—Driving means with electric or magnetic drive
-
- 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/50—Control means thereof
- A61H2201/5007—Control means thereof computer controlled
- A61H2201/501—Control means thereof computer controlled connected to external computer devices or networks
-
- 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/50—Control means thereof
- A61H2201/5058—Sensors or detectors
-
- 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/50—Control means thereof
- A61H2201/5058—Sensors or detectors
- A61H2201/5061—Force sensors
-
- 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/50—Control means thereof
- A61H2201/5058—Sensors or detectors
- A61H2201/5064—Position sensors
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/45—Nc applications
- G05B2219/45108—Aid, robot for aid to, assist human disabled
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/45—Nc applications
- G05B2219/45109—Excercise, coordination, therapy, rehabillitation robot for disabled patients
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B2219/00—Program-control systems
- G05B2219/30—Nc systems
- G05B2219/45—Nc applications
- G05B2219/45112—Arm movement aid
Landscapes
- Health & Medical Sciences (AREA)
- Engineering & Computer Science (AREA)
- Life Sciences & Earth Sciences (AREA)
- Animal Behavior & Ethology (AREA)
- Epidemiology (AREA)
- Pain & Pain Management (AREA)
- Physical Education & Sports Medicine (AREA)
- Rehabilitation Therapy (AREA)
- Veterinary Medicine (AREA)
- Public Health (AREA)
- General Health & Medical Sciences (AREA)
- Mechanical Engineering (AREA)
- Robotics (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Automation & Control Theory (AREA)
- Rehabilitation Tools (AREA)
- Manipulator (AREA)
Abstract
本发明涉及一种康复机器人患者实际力矩计算方法及系统,该方法通过关节电机码盘,获取机器人关节的运动状态,通过关节力矩传感器,获取机器人关节实际受到的和力矩,根据机器人关节的运动状态,基于机器人动力学模型,求解出机器人关节所受的关节电机的驱动力矩,从所述和力矩中减去关节电机的驱动力矩,从而分离出患者施加到机器人关节上的实际力矩,操作简单、数据精准、用户体验度好、满意度高。
Description
技术领域
本发明涉及机器人力学分析技术领域,具体涉及一种康复机器人患者实际力矩计算方法及系统。
背景技术
康复机器人作为医疗机器人的一个重要分支,它的研究贯穿了康复医学、生物力学、机械学、机械力学、电子学、材料学、计算机科学以及机器人学等诸多领域,已经成为了国际机器人领域的一个研究热点。目前,康复机器人已经广泛地应用到康复护理、假肢和康复治疗等方面,这不仅促进了康复医学的发展,也带动了相关领域的新技术和新理论的发展。
目前,常见的康复机器人使用关节末端的力矩传感来检测患者力矩。但在患者训练过程中力矩传感既会受到电机的驱动力,又会受到患者施加的作用力,所以,力矩传感示数是一个多输入的复杂变量,其中包含了患者作用力、关节重力、关节运动的惯性力等多个部分,因此患者的实际作用力并不能直接获得。而由于患者的实际作用力矩无法得到,就无法通过设置不同的导纳控制模型和参数,得到不同康复方法对应的康复运动轨迹增量Xe,就无法将运动轨迹增量补偿到位置控制内环中,无法最终实现康复机器人的康复运动控制。
发明内容
有鉴于此,本发明的目的在于克服现有技术的不足,提供一种康复机器人患者实际力矩计算方法及系统,以解决现有技术中康复机器人患者的实际作用力矩无法实际获取,导致康复机器人的康复运动无法精准控制的问题。
为实现以上目的,本发明采用如下技术方案:
一种康复机器人患者实际力矩计算方法,包括:
通过关节电机码盘,获取机器人关节的运动状态;
通过关节力矩传感器,获取机器人关节实际受到的和力矩;
根据机器人关节的运动状态,基于机器人动力学模型,求解出机器人关节所受的关节电机的驱动力矩;
从所述和力矩中减去关节电机的驱动力矩,分离出患者施加到机器人关节上的实际力矩;
其中,所述关节力矩传感器,安装在关节电机和机器人关节之间。
优选地,所述机器人关节的运动状态,至少包括:
肩关节的运动状态、肘关节的运动状态、髋关节的运动状态、膝关节的运动状态。
优选地,所述关节力矩传感器为单轴的力矩传感器。
优选地,所述求解出机器人关节所受的关节电机的驱动力矩,包括以下项中的至少一项:
拉格朗日法、牛顿欧拉法、凯恩法。
优选地,所述方法,还包括:
根据患者施加到机器人关节上的实际力矩,使用导纳控制建立康复机器人基本导纳控制模型。
另外,本发明还提出了一种康复机器人患者实际力矩计算系统,包括:
关节电机码盘,用于获取机器人关节的运动状态;
关节力矩传感器,用于获取机器人关节实际受到的和力矩;
计算模块,用于根据机器人关节的运动状态,基于机器人动力学模型,求解出机器人关节所受的关节电机的驱动力矩;
还用于从所述和力矩中减去关节电机的驱动力矩,分离出患者施加到机器人关节上的实际力矩;
其中,所述关节力矩传感器,安装在关节电机和机器人关节之间。
优选地,所述计算模块包括:
上位机及与所述上位机相连的运动控制器;
所述运动控制器分别与机器人关节驱动器及所述关节力矩传感器相连;
所述运动控制器用于接收关节电机码盘获取的机器人关节的运动状态;
还用于接收所述关节力矩传感器获取的机器人关节实际受到的和力矩;
所述上位机,用于根据机器人关节的运动状态,基于机器人动力学模型,求解出机器人关节所受的关节电机的驱动力矩;
还用于从所述和力矩中减去关节电机的驱动力矩,分离出患者施加到机器人关节上的实际力矩。
优选地,所述上位机,还用于根据患者施加到机器人关节上的实际力矩,使用导纳控制建立康复机器人基本导纳控制模型;
所述运动控制器,还用于根据所述康复机器人基本导纳控制模型,控制康复机器人的运动轨迹。
优选地,所述运动控制器为以下各项中的一种或多种的组合,包括:
PLC控制器、单片机、DSP处理器、FPGA控制器。
优选地,所述关节力矩传感器为单轴的力矩传感器。
本发明采用以上技术方案,至少具备以下有益效果:
通过获取机器人关节的运动状态及机器人关节实际受到的和力矩,根据机器人关节的运动状态,基于机器人动力学模型,求解出机器人关节所受的关节电机的驱动力矩,从所述和力矩中减去关节电机的驱动力矩,从而分离出患者施加到机器人关节上的实际力矩,操作简单、数据精准、用户体验度好、满意度高。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明一实施例提供的一种康复机器人患者实际力矩计算方法的流程图;
图2为本发明一实施例提供的一种康复机器人患者实际力矩计算系统的示意框图;
图3为本发明一实施例提供的一种康复机器人患者实际力矩计算系统的硬件结构图;
图4为本发明一实施例提供的康复机器人基本导纳控制模型的示意图;
图5为本发明一实施例提供的康复机器人的二连杆动力学模型的示意图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚,下面将对本发明的技术方案进行详细的描述。显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动的前提下所得到的所有其它实施方式,都属于本发明所保护的范围。
下面通过附图和实施例,对本发明的技术方案做进一步的详细描述。
参见图1,本发明一实施例提出的一种康复机器人患者实际力矩计算方法,包括:
步骤S1、通过关节电机码盘,获取机器人关节的运动状态;
步骤S2、通过关节力矩传感器,获取机器人关节实际受到的和力矩;
步骤S3、根据机器人关节的运动状态,基于机器人动力学模型,求解出机器人关节所受的关节电机的驱动力矩;
从所述和力矩中减去关节电机的驱动力矩,分离出患者施加到机器人关节上的实际力矩;
其中,所述关节力矩传感器,安装在关节电机和机器人关节之间。
可以理解的是,本实施例提供的技术方案,通过获取机器人关节的运动状态及机器人关节实际受到的和力矩,根据机器人关节的运动状态,基于机器人动力学模型,求解出机器人关节所受的关节电机的驱动力矩,从所述和力矩中减去关节电机的驱动力矩,从而分离出患者施加到机器人关节上的实际力矩,操作简单、数据精准、用户体验度好、满意度高。
优选地,所述关节力矩传感器为单轴的力矩传感器。
优选地,所述机器人关节的运动状态,至少包括:
肩关节的运动状态、肘关节的运动状态、髋关节的运动状态、膝关节的运动状态。
需要说明的是,所述各关节的运动状态至少包括:屈曲伸展、内收外展、内旋外旋等。
可以理解的是,在不考虑关节力矩传感器微小形变量的情况下,机器人关节的运动状态和其所受的电机驱动力之间存在动力学关系。机器人关节的运动状态可以通过关节电机码盘获得,再通过机器人动力学模型即可以求解机器人关节所受的电机驱动力矩,从关节力矩传感器的示数中减去电机驱动力矩部分即可分离出患者施加到机器人关节上的实际力矩。
优选地,所述求解出机器人关节所受的关节电机的驱动力矩,包括以下项中的至少一项:
拉格朗日法、牛顿欧拉法、凯恩法。
机器人动力学分析是机器人运动控制的关键,动力学方程表达了机器人关节运动状态和其所受力矩之间的关系,是下一步康复机器人导纳运动控制模型中的重要组成部分。和机器人的运动学一样,动力学也分为正和逆两部分,正动力学是通过作用在关节上的力或力矩(F,T),计算机器人关节的运动信息,如位置,速度和加速度
常见的机器人动力学分析方法有:拉格朗日法、牛顿欧拉法、凯恩法等,由于拉格朗日方程简洁明了,易于理解,本申请选择拉格朗日方程进行康复机器人二连杆模型的建模和分析。
拉格朗日方程将模型看成一个系统进行整体分析,通过建立系统的动能和势能函数,直接推导出动力学方程。
系统的动能减去系统的势能就能得到拉格朗日因子,如式(3)所示,
L=T-E (3)
其中,系统的总动能为T;系统的总势能为E。
系统各个节点的拉格朗日方程为:
其中,L表示拉格朗日函数,qi表示关节的广义坐标,τi为作用于关节qi的广义力矩。将拉格朗日方程写成矩阵形式如下:
康复机器人动力学建模:
在此以二连杆模型为基础进行动力学建模,如图5所示。
图5中,连杆1和连杆2的长度分别为l1和l2,质量分别为m1和m2;C1表示连杆1的重心,C2表示连杆2的重心;r1表示C1到连杆1转轴之间的距离,r2表示C2到连杆2转轴之间的距离;θ1表示连杆1和X轴之间的角度,θ2表示连杆2和连杆1轴线之间的角度。
连杆1的动能如下,其中J1表示连杆1的转动惯量。
连杆1的势能表示为:
E1=m1gr1 sinθ1 (7)
同样的,连杆2的动能为:
由几何关系可以得到,连杆2重心的坐标(x2,y2)为:
将式(9)中的分别对时间求导平方再相加,可以得到连杆2重心的速度为:
将式(10)带入式(8),可以得到连杆2的动能为:
连杆2的势能为:
E2=m2gy2=m2g(l1 sinθ1+r2 sin(θ1+θ2)) (12)
得到了连杆1、连杆2的动能和势能后,将其代入式(3),可以得到该模型的拉格朗日因子为:
将式(13)代入式(4),即可得到连杆1的拉格朗日方程:
同样可以求得连杆2的拉格朗日方程:
至此,两个连杆的拉格朗日动力学方程计算完成,连杆1和连杆2的动力学方程如式(14)和式(15)所示,将两式合并表示为矩阵形式如下:
其中M(θ)为惯性矩阵,
G(θ)为重力的向量
优选地,所述方法,还包括:
根据患者施加到机器人关节上的实际力矩,使用导纳控制建立康复机器人基本导纳控制模型。
可以理解的是,得到患者施加到机器人关节上的实际力矩后,通过设置不同的导纳控制模型和参数,就可以得到不同康复方法对应的康复运动轨迹增量,运动轨迹增量补偿到位置控制内环中,最终可以实现康复机器人的康复运动的精准控制。
另外,参见图2,本发明另一实施例提出的一种康复机器人患者实际力矩计算系统100,包括:
关节电机码盘101,用于获取机器人关节的运动状态;
关节力矩传感器102,用于获取机器人关节实际受到的和力矩;
计算模块103,用于根据机器人关节的运动状态,基于机器人动力学模型,求解出机器人关节所受的关节电机的驱动力矩;
还用于从所述和力矩中减去关节电机的驱动力矩,分离出患者施加到机器人关节上的实际力矩;
其中,所述关节力矩传感器,安装在关节电机和机器人关节之间。
参见图3,优选地,所述计算模块103包括:
上位机及1031与所述上位机相连的运动控制器1032;
所述运动控制器1032分别与机器人关节驱动器及所述关节力矩传感器102相连;
所述运动控制器1032用于接收关节电机码盘101获取的机器人关节的运动状态;
还用于接收所述关节力矩传感器102获取的机器人关节实际受到的和力矩;
所述上位机1031,用于根据机器人关节的运动状态,基于机器人动力学模型,求解出机器人关节所受的关节电机的驱动力矩;
还用于从所述和力矩中减去关节电机的驱动力矩,分离出患者施加到机器人关节上的实际力矩。
优选地,所述运动控制器1032为以下各项中的一种或多种的组合,包括:
PLC控制器、单片机、DSP处理器、FPGA控制器。
优选地,所述关节力矩传感器102为单轴的力矩传感器。
参见图4,优选地,所述上位机,还用于根据患者施加到机器人关节上的实际力矩,使用导纳控制建立康复机器人基本导纳控制模型;
所述运动控制器,还用于根据所述康复机器人基本导纳控制模型,控制康复机器人的运动轨迹。
参见图4,控制模型中各个变量的含义如下:
F患表示患者施加到机器人关节上的实际作用力;
τ患表示患者施加到机器人关节上的实际力矩;
τ传表示关节力矩传感器的示数,即机器人关节实际受到的和力矩;
τ驱表示机器人关节所受的关节电机的驱动力矩;
τe表示分离出的患者施加到机器人关节上的实际力矩;
Xd表示机器人期望位置;
X表示机器人的实际位置;
Xe表示机器人期望位置与实际位置之差:Xe=Xd-X。
由上述康复机器人患者实际力矩计算方法可知:τe=τ患=τ传-τ驱。在图4的导纳控制模型中,患者施加到机器人上的作用力F患通过机器人关节,间接作用到关节力矩传感器上。关节力矩传感器τ传表示患者施加到机器人关节上的力矩τ患和电机的驱动力矩τ驱的和,通过关节力矩传感器τ传和电机的驱动力矩τ驱求差,即可分离出患者施加的实际力矩τe。
可以理解的是,得到患者施加到机器人关节上的实际力矩后,通过设置不同的导纳控制模型和参数,就可以得到不同康复方法对应的康复运动轨迹增量,运动轨迹增量补偿到位置控制内环中,最终可以实现康复机器人的康复运动的精准控制。本实施例提供的技术方案,解决了现有技术中康复机器人患者的实际作用力矩无法实际获取,导致康复机器人的康复运动无法精准控制的问题。
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到变化或替换,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应以所述权利要求的保护范围为准。术语“第一”、“第二”仅用于描述目的,而不能理解为指示或暗示相对重要性。术语“多个”指两个或两个以上,除非另有明确的限定。
Claims (10)
1.一种康复机器人患者实际力矩计算方法,其特征在于,包括:
通过关节电机码盘,获取机器人关节的运动状态;
通过关节力矩传感器,获取机器人关节实际受到的和力矩;
根据机器人关节的运动状态,基于机器人动力学模型,求解出机器人关节所受的关节电机的驱动力矩;
从所述和力矩中减去关节电机的驱动力矩,分离出患者施加到机器人关节上的实际力矩;
其中,所述关节力矩传感器,安装在关节电机和机器人关节之间。
2.根据权利要求1所述的方法,其特征在于,所述机器人关节的运动状态,至少包括:
肩关节的运动状态、肘关节的运动状态、髋关节的运动状态、膝关节的运动状态。
3.根据权利要求1所述的方法,其特征在于,
所述关节力矩传感器为单轴的力矩传感器。
4.根据权利要求1所述的方法,其特征在于,所述求解出机器人关节所受的关节电机的驱动力矩,包括以下项中的至少一项:
拉格朗日法、牛顿欧拉法、凯恩法。
5.根据权利要求1所述的方法,其特征在于,还包括:
根据患者施加到机器人关节上的实际力矩,使用导纳控制建立康复机器人基本导纳控制模型。
6.一种康复机器人患者实际力矩计算系统,其特征在于,包括:
关节电机码盘,用于获取机器人关节的运动状态;
关节力矩传感器,用于获取机器人关节实际受到的和力矩;
计算模块,用于根据机器人关节的运动状态,基于机器人动力学模型,求解出机器人关节所受的关节电机的驱动力矩;
还用于从所述和力矩中减去关节电机的驱动力矩,分离出患者施加到机器人关节上的实际力矩;
其中,所述关节力矩传感器,安装在关节电机和机器人关节之间。
7.根据权利要求6所述的系统,其特征在于,所述计算模块包括:
上位机及与所述上位机相连的运动控制器;
所述运动控制器分别与机器人关节驱动器及所述关节力矩传感器相连;
所述运动控制器用于接收关节电机码盘获取的机器人关节的运动状态;
还用于接收所述关节力矩传感器获取的机器人关节实际受到的和力矩;
所述上位机,用于根据机器人关节的运动状态,基于机器人动力学模型,求解出机器人关节所受的关节电机的驱动力矩;
还用于从所述和力矩中减去关节电机的驱动力矩,分离出患者施加到机器人关节上的实际力矩。
8.根据权利要求7所述的系统,其特征在于,
所述上位机,还用于根据患者施加到机器人关节上的实际力矩,使用导纳控制建立康复机器人基本导纳控制模型;
所述运动控制器,还用于根据所述康复机器人基本导纳控制模型,控制康复机器人的运动轨迹。
9.根据权利要求7所述的系统,其特征在于,所述运动控制器为以下各项中的一种或多种的组合,包括:
PLC控制器、单片机、DSP处理器、FPGA控制器。
10.根据权利要求6所述的系统,其特征在于,
所述关节力矩传感器为单轴的力矩传感器。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010999472.8A CN112140110A (zh) | 2020-09-22 | 2020-09-22 | 一种康复机器人患者实际力矩计算方法及系统 |
FR2104057A FR3114246B1 (fr) | 2020-09-22 | 2021-04-19 | Procédé et système pour calculer le moment réel appliqué sur un robot de rééducation par le patient |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010999472.8A CN112140110A (zh) | 2020-09-22 | 2020-09-22 | 一种康复机器人患者实际力矩计算方法及系统 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN112140110A true CN112140110A (zh) | 2020-12-29 |
Family
ID=73892550
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010999472.8A Pending CN112140110A (zh) | 2020-09-22 | 2020-09-22 | 一种康复机器人患者实际力矩计算方法及系统 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN112140110A (zh) |
FR (1) | FR3114246B1 (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114089757A (zh) * | 2021-11-17 | 2022-02-25 | 北京石油化工学院 | 一种上下肢协调主动康复机器人控制方法及装置 |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117116459B (zh) * | 2023-10-20 | 2024-01-16 | 中国科学院自动化研究所 | 康复机器人主动康复训练控制方法及装置 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH08234801A (ja) * | 1995-01-12 | 1996-09-13 | Siemens Ag | モータ駆動式関節アームのための制御装置及び制御方法 |
CN103521966A (zh) * | 2013-09-23 | 2014-01-22 | 北京石油化工学院 | 大直径管道自动焊接装置 |
CN105437209A (zh) * | 2015-12-08 | 2016-03-30 | 东北大学 | 一种具有人机交互动力学模型的外骨骼式上肢康复机器人 |
CN106737657A (zh) * | 2015-11-20 | 2017-05-31 | 沈阳新松机器人自动化股份有限公司 | 一种基于动力学系统的机器人安全控制方法及系统 |
CN206764764U (zh) * | 2017-02-24 | 2017-12-19 | 北京大艾机器人科技有限公司 | 驱动控制装置及具有其的外骨骼机器人 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5982767B2 (ja) * | 2011-09-26 | 2016-08-31 | ソニー株式会社 | 運動補助装置及び運動補助方法、コンピューター・プログラム、並びにプログラム記録媒体 |
KR101417488B1 (ko) * | 2012-12-17 | 2014-07-08 | 현대자동차주식회사 | 착용로봇의 의도토크 추출방법 및 추출시스템 |
CN111631726B (zh) * | 2020-06-01 | 2021-03-12 | 深圳华鹊景医疗科技有限公司 | 上肢功能评估装置与方法及上肢康复训练系统与方法 |
-
2020
- 2020-09-22 CN CN202010999472.8A patent/CN112140110A/zh active Pending
-
2021
- 2021-04-19 FR FR2104057A patent/FR3114246B1/fr active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH08234801A (ja) * | 1995-01-12 | 1996-09-13 | Siemens Ag | モータ駆動式関節アームのための制御装置及び制御方法 |
CN103521966A (zh) * | 2013-09-23 | 2014-01-22 | 北京石油化工学院 | 大直径管道自动焊接装置 |
CN106737657A (zh) * | 2015-11-20 | 2017-05-31 | 沈阳新松机器人自动化股份有限公司 | 一种基于动力学系统的机器人安全控制方法及系统 |
CN105437209A (zh) * | 2015-12-08 | 2016-03-30 | 东北大学 | 一种具有人机交互动力学模型的外骨骼式上肢康复机器人 |
CN206764764U (zh) * | 2017-02-24 | 2017-12-19 | 北京大艾机器人科技有限公司 | 驱动控制装置及具有其的外骨骼机器人 |
Non-Patent Citations (1)
Title |
---|
王孙安编著: "建模、仿真与机电系统的相似", 西安交通大学出版社, pages: 155 - 156 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114089757A (zh) * | 2021-11-17 | 2022-02-25 | 北京石油化工学院 | 一种上下肢协调主动康复机器人控制方法及装置 |
CN114089757B (zh) * | 2021-11-17 | 2024-02-02 | 北京石油化工学院 | 一种上下肢协调主动康复机器人控制方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
FR3114246A1 (fr) | 2022-03-25 |
FR3114246B1 (fr) | 2023-06-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Chen et al. | Design and development of a new cable-driven parallel robot for waist rehabilitation | |
CN105437209B (zh) | 一种具有人机交互动力学模型的外骨骼式上肢康复机器人 | |
Ghan et al. | System identification for the Berkeley lower extremity exoskeleton (BLEEX) | |
CN108338791B (zh) | 失稳运动数据的检测装置及检测方法 | |
CN107616898B (zh) | 基于日常动作的上肢穿戴式康复机器人及康复评价方法 | |
CN105539890A (zh) | 一种模拟空间机械臂捕获目标卫星的地面三维空间微重力的装置与方法 | |
CN103895022A (zh) | 穿戴式体感控制机械手 | |
Fang et al. | Skill learning for human-robot interaction using wearable device | |
CN112140110A (zh) | 一种康复机器人患者实际力矩计算方法及系统 | |
CN114417738B (zh) | 稀疏imu实时人体动作捕捉及关节受力预测方法及系统 | |
CN109746901B (zh) | 一种用于外骨骼机器人的动态负载信息计算方法 | |
CN111390877A (zh) | 一种外骨骼装置及外骨骼变导纳控制方法 | |
CN113771040A (zh) | 一种下肢外骨骼机器人控制系统及方法 | |
CN113283116B (zh) | 多信息融合的人体运动分析方法和装置 | |
CN109159120B (zh) | 基于康复机械臂关节电机电流反馈的主动控制方法及系统 | |
Zhou et al. | Toward Human Motion Digital Twin: A Motion Capture System for Human-Centric Applications | |
CN115252369B (zh) | 一种基于下肢外骨骼机器人的按需辅助控制方法 | |
CN111716334A (zh) | 一种基于滑模阻抗的上肢外骨骼控制方法 | |
Yan et al. | Kinematic analysis and dynamic optimization simulation of a novel unpowered exoskeleton with parallel topology | |
Li et al. | Design and analysis of joint-assisted exoskeleton control system of upper limb in active spacesuit | |
CN112057083B (zh) | 可穿戴人体上肢位姿采集设备及采集方法 | |
CN113608451A (zh) | 基于ros的仿真控制平台及外骨骼机器人仿真控制系统 | |
Zhang et al. | Design on subsection based mix position controller for lower limb rehabilitation robot | |
CN111150608A (zh) | 基于压力传感器识别运动意图的康复机器人的控制方法 | |
CN117085301B (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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20201229 |