CN110812125A - 一种基于六自由度机械臂的患侧手部康复训练方法及*** - Google Patents
一种基于六自由度机械臂的患侧手部康复训练方法及*** Download PDFInfo
- Publication number
- CN110812125A CN110812125A CN201911273784.4A CN201911273784A CN110812125A CN 110812125 A CN110812125 A CN 110812125A CN 201911273784 A CN201911273784 A CN 201911273784A CN 110812125 A CN110812125 A CN 110812125A
- Authority
- CN
- China
- Prior art keywords
- hand
- mechanical arm
- pose
- affected
- parameters
- 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
- 238000012549 training Methods 0.000 title claims abstract description 65
- 238000000034 method Methods 0.000 title claims abstract description 28
- 230000001133 acceleration Effects 0.000 claims abstract description 30
- 230000000694 effects Effects 0.000 claims abstract description 12
- 238000012545 processing Methods 0.000 claims description 4
- 238000005728 strengthening Methods 0.000 claims description 4
- 230000003044 adaptive effect Effects 0.000 claims description 2
- 238000010586 diagram Methods 0.000 description 8
- 210000001364 upper extremity Anatomy 0.000 description 5
- 238000002560 therapeutic procedure Methods 0.000 description 4
- 238000006243 chemical reaction Methods 0.000 description 2
- 210000003414 extremity Anatomy 0.000 description 2
- 239000011159 matrix material Substances 0.000 description 2
- 230000007659 motor function Effects 0.000 description 2
- 238000011084 recovery Methods 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- 206010001497 Agitation Diseases 0.000 description 1
- 206010019468 Hemiplegia Diseases 0.000 description 1
- 206010061296 Motor dysfunction Diseases 0.000 description 1
- 230000032683 aging Effects 0.000 description 1
- 210000004556 brain Anatomy 0.000 description 1
- 230000003925 brain function Effects 0.000 description 1
- 230000004064 dysfunction Effects 0.000 description 1
- 230000010354 integration Effects 0.000 description 1
- 210000000337 motor cortex Anatomy 0.000 description 1
- 230000000750 progressive effect Effects 0.000 description 1
- 238000013139 quantization Methods 0.000 description 1
- 238000007634 remodeling Methods 0.000 description 1
- 230000003252 repetitive effect Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 230000004936 stimulating effect 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
- A61H1/0285—Hand
-
- 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/0006—Exoskeletons, i.e. resembling a human figure
-
- 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/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
-
- 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
-
- 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
- A61H2205/00—Devices for specific parts of the body
- A61H2205/06—Arms
- A61H2205/065—Hands
-
- 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
- A61H2230/00—Measuring physical parameters of the user
- A61H2230/62—Posture
- A61H2230/625—Posture used as a control parameter for the apparatus
Landscapes
- Health & Medical Sciences (AREA)
- Engineering & Computer Science (AREA)
- Animal Behavior & Ethology (AREA)
- Physical Education & Sports Medicine (AREA)
- Rehabilitation Therapy (AREA)
- Life Sciences & Earth Sciences (AREA)
- Pain & Pain Management (AREA)
- General Health & Medical Sciences (AREA)
- Public Health (AREA)
- Veterinary Medicine (AREA)
- Epidemiology (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Rehabilitation Tools (AREA)
Abstract
本发明涉及一种基于六自由度机械臂的患侧手部康复训练方法及***。所述康复训练方法包括:采集患者日常生活活动训练ADL训练时健侧手部的加速度和姿态角;根据所述加速度以及所述姿态角确定健侧手部位姿参数;基于镜像原理,根据所述健侧手部位姿参数确定患侧手部位姿参数;所述患侧手部位姿参数为六自由度机械臂的机械臂末端位姿参数;根据所述机械臂末端位姿参数确定机械臂各关节位姿参数;根据所述机械臂各关节位姿参数生成健侧手部运动轨迹;根据所述健侧手部运动轨迹控制患者的患侧手部进行康复运动训练。采用本发明所提供的康复训练方法及***能够提高康复训练效果以及增加患者的主动性。
Description
技术领域
本发明涉及康复训练领域,特别是涉及一种基于六自由度机械臂的患侧手部康复训练方法及***。
背景技术
随着老龄化社会的到来,脑卒中逐渐成为运动功能障碍和偏瘫的主要原因,尤其手部功能障碍对患者的生活产生了许多不便,因此近年来对于上肢的康复训练***成为康复研究的热点。
通过引导患者进行运动,可以达到预防残疾和改善患者运动功能的效果,但在常规的康复训练中,一般是手臂在康复设备的控制下进行单一的运动训练;这样的训练方式通常会导致大脑皮层对重复运动的刺激性越来越低,以至于康复的效果差强人意。
因此,面向镜像治疗的患者基于六自由度机械臂的患侧手部康复训练方法应时而生,利用镜像装置,将健侧肢体活动的画面复制到患侧,患者通过这样的视觉反馈,进行运动观察、模仿以及再学***面镜或结合透镜进行,即“经典的镜像治疗始终依托一面镜子”,这种传统的镜像疗法容易受到镜像装置的限制、没有统一的量化标准并且在创新上难以突破,在训练过程中,由于刚开始复健时,患者的肢体无法完全依照自己的思想进行训练,导致患者的主动性差,无法积极进行康复训练。
发明内容
本发明的目的是提供一种基于六自由度机械臂的患侧手部康复训练方法及***,以解决目前的镜像疗法受镜像装置的限制、没有统一的量化标准导致康复训练效果差以及患者的主动性差的问题。
为实现上述目的,本发明提供了如下方案:
一种基于六自由度机械臂的患侧手部康复训练方法,包括:
采集患者日常生活活动训练ADL训练时健侧手部的加速度和姿态角;
根据所述加速度以及所述姿态角确定健侧手部位姿参数;
基于镜像原理,根据所述健侧手部位姿参数确定患侧手部位姿参数;所述患侧手部位姿参数为六自由度机械臂的机械臂末端位姿参数;
根据所述机械臂末端位姿参数确定机械臂各关节位姿参数;
根据所述机械臂各关节位姿参数生成健侧手部运动轨迹;
根据所述健侧手部运动轨迹控制患者的患侧手部进行康复运动训练。
可选的,所述根据所述加速度以及所述姿态角确定健侧手部位姿参数,具体包括:
对所述加速度以及所述姿态角进行积分处理,确定健侧手部位姿参数。
可选的,所述基于镜像原理,根据所述健侧手部位姿参数确定患侧手部位姿参数,具体包括:
利用公式[XJ YJ ZJ AJ BJ CJ]T=[-XH -YH -ZH -AH -BH -CH]T确定患侧手部位姿参数;其中,T为患侧手部位姿参数;XJ,YJ,ZJ为健侧手部的位置参数;AJ,BJ,CJ为健侧手部位姿参数;J为健侧手部;XH,YH,ZH为患侧手部的位置参数;AH,BH,CH为患侧手部的位姿参数;H为患侧手部。
可选的,所述根据所述机械臂末端位姿参数确定机械臂各关节位姿参数,具体包括:
以机械臂任一关节为原点,建立空间直角坐标系;
在所述空间直角坐标系下,利用六自由度机械臂逆解算法,根据所述机械臂末端位姿参数确定所述机械臂各个关节的旋转角;
根据所述旋转角确定机械臂各关节位姿参数。
一种基于六自由度机械臂的患侧手部康复训练***,包括:
健侧手部加速度及姿态角采集模块,用于采集患者日常生活活动训练ADL训练时健侧手部的加速度和姿态角;
健侧手部位姿参数确定模块,用于根据所述加速度以及所述姿态角确定健侧手部位姿参数;
患侧手部位姿参数确定模块,用于基于镜像原理,根据所述健侧手部位姿参数确定患侧手部位姿参数;所述患侧手部位姿参数为六自由度机械臂的机械臂末端位姿参数;
机械臂各关节位姿参数确定模块,用于根据所述机械臂末端位姿参数确定机械臂各关节位姿参数;
健侧手部运动轨迹生成模块,用于根据所述机械臂各关节位姿参数生成健侧手部运动轨迹;
控制模块,用于根据所述健侧手部运动轨迹控制患者的患侧手部进行康复运动训练。
可选的,所述健侧手部位姿参数确定模块具体包括:
健侧手部位姿参数确定单元,用于对所述加速度以及所述姿态角进行积分处理,确定健侧手部位姿参数。
可选的,所述患侧手部位姿参数确定模块具体包括:
患侧手部位姿参数确定单元,用于利用公式[XJ YJ ZJ AJ BJ CJ]T=[-XH -YH -ZH-AH -BH -CH]T确定患侧手部位姿参数;其中,T为患侧手部位姿参数;XJ,YJ,ZJ为健侧手部的位置参数;AJ,BJ,CJ为健侧手部位姿参数;J为健侧手部;XH,YH,ZH为患侧手部的位置参数;AH,BH,CH为患侧手部的位姿参数;H为患侧手部。
可选的,所述机械臂各关节位姿参数确定模块具体包括:
空间直角坐标系建立单元,用于以机械臂任一关节为原点,建立空间直角坐标系;
旋转角确定单元,用于在所述空间直角坐标系下,利用六自由度机械臂逆解算法,根据所述机械臂末端位姿参数确定所述机械臂各个关节的旋转角;
机械臂各关节位姿参数确定单元,用于根据所述旋转角确定机械臂各关节位姿参数。
根据本发明提供的具体实施例,本发明公开了以下技术效果:本发明提供了一种基于六自由度机械臂的患侧手部康复训练方法及***,获取六自由度机械臂基于健侧手部的加速度和姿态角,利用镜像原理,生成健侧手部运动轨迹,六自由度机械臂根据健侧手部运动轨迹控制患者的患侧手部进行康复运动训练,不依赖于镜像装置的限制。由于是基于患者健侧手部的健侧手部运动轨迹,因此增加了患者的主动性与参与性,帮助患者进行全周期的上肢康复训练,有效提高患者的日常生活能力,同时,极大限度的降低了康复治疗的工作强度,减轻了康复师和医生的工作量。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动性的前提下,还可以根据这些附图获得其他的附图。
图1为本发明所提供的基于六自由度机械臂的患侧手部康复训练方法流程图;
图2为本发明所提供的上肢康复机器人结构图;
图3为本发明所提供的机械手柄结构图;
图4为本发明所提供的镜像算法原理图;
图5为本发明所提供的基于六自由度机械臂的患侧手部康复训练***结构图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
本发明的目的是提供一种基于六自由度机械臂的患侧手部康复训练方法及***,提高了康复训练效果以及增加了患者的主动性。
为使本发明的上述目的、特征和优点能够更加明显易懂,下面结合附图和具体实施方式对本发明作进一步详细的说明。
图1为本发明所提供的基于六自由度机械臂的患侧手部康复训练方法流程图,如图1所示,一种基于六自由度机械臂的患侧手部康复训练方法,包括:
步骤101:采集患者日常生活活动训练ADL训练时健侧手部的加速度和姿态角。
图2为本发明所提供的上肢康复机器人结构图,图3为本发明所提供的机械手柄结构图,如图2图3所示,复健过程中,患者握住机械手柄1,按住振动开关2给予手柄振动信号,提示手柄开始测量,惯性传感器4采集健侧手部(Activities ofDailyLiving,ADL)训练时的加速度和姿态角,并将得到的加速度和姿态角通过蓝牙模块3传输到服务器。
步骤102:根据所述加速度以及所述姿态角确定健侧手部位姿参数。
步骤103:基于镜像原理,根据所述健侧手部位姿参数确定患侧手部位姿参数;所述患侧手部位姿参数为六自由度机械臂的机械臂末端位姿参数。
图4为本发明所提供的镜像算法原理图,如图4所示,服务器对加速度积分处理得到健侧手部位置参数,通过镜像原理将健侧手部位姿参数换算得到患侧手部位姿参数,即机械臂末端位姿参数。
所述步骤103具体包括:
利用公式[XJ YJ ZJ AJ BJ CJ]T=[-XH -YH -ZH -AH -BH -CH]T确定患侧手部位姿参数;其中,T为患侧手部位姿参数;XJ,YJ,ZJ为健侧手部的位置参数;AJ,BJ,CJ为健侧手部位姿参数;J为健侧手部;XH,YH,ZH为患侧手部的位置参数;AH,BH,CH为患侧手部的位姿参数;H为患侧手部。
步骤104:根据所述机械臂末端位姿参数确定机械臂各关节位姿参数。
所述步骤104具体包括:
以机械臂任一关节为原点,建立空间直角坐标系;
在所述空间直角坐标系下,利用六自由度机械臂逆解算法,根据所述机械臂末端位姿参数确定所述机械臂各个关节的旋转角;
根据所述旋转角确定机械臂各关节位姿参数。
步骤105:根据所述机械臂各关节位姿参数生成健侧手部运动轨迹。
步骤106:根据所述健侧手部运动轨迹控制患者的患侧手部进行康复运动训练。
根据六自由度机械臂逆解算法得到机械臂各关节位姿参数,并根据各关节位姿参数控制机械臂带动患者的患侧手部按照健侧手部运动轨迹进行康复运动训练。
在实际应用中,根据六关节机械臂逆运动学问题的快速求解方法和机械臂末端位姿参数T求出机械臂各关节旋转角度(θ1 θ2 θ3 θ4 θ5 θ6),根据各时刻的关节旋转角度控制机械臂带动患者的患侧手部按照健侧手部运轨迹进行康复运动训练。
对机械臂末端位姿参数T的求解来说,可采用现有相关技术,先求出机械臂第5关节的坐标系原点和第4、5、6个关节角的旋转角度(θ4 θ5 θ6),再根据第5关节的坐标系原点的坐标以及第4、5、6个关节角的旋转角求出第1、2、3个关节角的旋转角度(θ1 θ2 θ3)。
其中,Cij表示为cosθicosθj;Sij表示为sinθi;θi表示机械臂各关节的关节角;li表示机械臂各关节的长度;i=1.2.3...6j=1.2.3...6;A1,A2,A3,A4,A5,A6为转换矩阵符号,表示每个关节的转换矩阵可参考机器人学。
图5为本发明所提供的基于六自由度机械臂的患侧手部康复训练***结构图,如图5所示,一种基于六自由度机械臂的患侧手部康复训练***,包括:
健侧手部加速度及姿态角采集模块501,用于采集患者日常生活活动训练ADL训练时健侧手部的加速度和姿态角。
健侧手部位姿参数确定模块502,用于根据所述加速度以及所述姿态角确定健侧手部位姿参数。
所述健侧手部位姿参数确定模块502具体包括:健侧手部位姿参数确定单元,用于对所述加速度以及所述姿态角进行积分处理,确定健侧手部位姿参数。
患侧手部位姿参数确定模块503,用于基于镜像原理,根据所述健侧手部位姿参数确定患侧手部位姿参数;所述患侧手部位姿参数为六自由度机械臂的机械臂末端位姿参数。
所述患侧手部位姿参数确定模块503具体包括:患侧手部位姿参数确定单元,用于利用公式[XJ YJ ZJ AJ BJ CJ]T=[-XH -YH -ZH -AH -BH -CH]T确定患侧手部位姿参数;其中,T为患侧手部位姿参数;XJ,YJ,ZJ为健侧手部的位置参数;AJ,BJ,CJ为健侧手部位姿参数;J为健侧手部;XH,YH,ZH为患侧手部的位置参数;AH,BH,CH为患侧手部的位姿参数;H为患侧手部。
机械臂各关节位姿参数确定模块504,用于根据所述机械臂末端位姿参数确定机械臂各关节位姿参数。
所述机械臂各关节位姿参数确定模块504具体包括:空间直角坐标系建立单元,用于以机械臂任一关节为原点,建立空间直角坐标系;旋转角确定单元,用于在所述空间直角坐标系下,利用六自由度机械臂逆解算法,根据所述机械臂末端位姿参数确定所述机械臂各个关节的旋转角;机械臂各关节位姿参数确定单元,用于根据所述旋转角确定机械臂各关节位姿参数。
健侧手部运动轨迹生成模块505,用于根据所述机械臂各关节位姿参数生成健侧手部运动轨迹。
控制模块506,用于根据所述健侧手部运动轨迹控制患者的患侧手部进行康复运动训练。
在实际使用中的具体操作为:
健侧手部拿着1机械手柄做ADL训练运动,通过4惯性传感器采集健侧手部ADL训练时的加速度和姿态角参数,并将得到的数据通过2蓝牙模块传输到服务器。
上肢康复机器人中的服务器接受蓝牙传输的数据,并对其加速度积分处理得到健侧手部位置参数,通过镜像原理将健侧手部位姿参数换算得到患侧手部位姿参数,即机械臂末端位姿参数。
根据六自由度机械臂逆解算法得到机械臂各关节位姿参数,并根据各关节位姿参数控制机械臂带动患者的患侧手部按照健侧手部运动轨迹进行康复运动训练。
机械手柄1内置振动开关3和惯性传感器4,并带有蓝牙模块2。振动开关3用于响应振动控制惯性传感器开关4,惯性传感器4用于采集加速度信息,蓝牙模块2用于传输数据。
使用时,健侧手部握着机械手柄1做ADL训练运动,机械臂5得到数据,带动患侧手部按照健侧手部的运动轨迹进行康复训练运动,其中患侧手部与机械臂末端绑定在一起,从而增加了患者的主动性和参与性,使得患者更加积极参与康复训练。
本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。对于实施例公开的***而言,由于其与实施例公开的方法相对应,所以描述的比较简单,相关之处参见方法部分说明即可。
本文中应用了具体个例对本发明的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本发明的方法及其核心思想;同时,对于本领域的一般技术人员,依据本发明的思想,在具体实施方式及应用范围上均会有改变之处。综上所述,本说明书内容不应理解为对本发明的限制。
Claims (8)
1.一种基于六自由度机械臂的患侧手部康复训练方法,其特征在于,包括:
采集患者日常生活活动训练ADL训练时健侧手部的加速度和姿态角;
根据所述加速度以及所述姿态角确定健侧手部位姿参数;
基于镜像原理,根据所述健侧手部位姿参数确定患侧手部位姿参数;所述患侧手部位姿参数为六自由度机械臂的机械臂末端位姿参数;
根据所述机械臂末端位姿参数确定机械臂各关节位姿参数;
根据所述机械臂各关节位姿参数生成健侧手部运动轨迹;
根据所述健侧手部运动轨迹控制患者的患侧手部进行康复运动训练。
2.根据权利要求1所述的基于六自由度机械臂的患侧手部康复训练方法,其特征在于,所述根据所述加速度以及所述姿态角确定健侧手部位姿参数,具体包括:
对所述加速度以及所述姿态角进行积分处理,确定健侧手部位姿参数。
3.根据权利要求1所述的基于六自由度机械臂的患侧手部康复训练方法,其特征在于,所述基于镜像原理,根据所述健侧手部位姿参数确定患侧手部位姿参数,具体包括:
利用公式[XJ YJ ZJ AJ BJ CJ]T=[-XH-YH-ZH-AH-BH-CH]T确定患侧手部位姿参数;其中,T为患侧手部位姿参数;XJ,YJ,ZJ为健侧手部的位置参数;AJ,BJ,CJ为健侧手部位姿参数;J为健侧手部;XH,YH,ZH为患侧手部的位置参数;AH,BH,CH为患侧手部的位姿参数;H为患侧手部。
4.根据权利要求1所述的基于六自由度机械臂的患侧手部康复训练方法,其特征在于,所述根据所述机械臂末端位姿参数确定机械臂各关节位姿参数,具体包括:
以机械臂任一关节为原点,建立空间直角坐标系;
在所述空间直角坐标系下,利用六自由度机械臂逆解算法,根据所述机械臂末端位姿参数确定所述机械臂各个关节的旋转角;
根据所述旋转角确定机械臂各关节位姿参数。
5.一种基于六自由度机械臂的患侧手部康复训练***,其特征在于,包括:
健侧手部加速度及姿态角采集模块,用于采集患者日常生活活动训练ADL训练时健侧手部的加速度和姿态角;
健侧手部位姿参数确定模块,用于根据所述加速度以及所述姿态角确定健侧手部位姿参数;
患侧手部位姿参数确定模块,用于基于镜像原理,根据所述健侧手部位姿参数确定患侧手部位姿参数;所述患侧手部位姿参数为六自由度机械臂的机械臂末端位姿参数;
机械臂各关节位姿参数确定模块,用于根据所述机械臂末端位姿参数确定机械臂各关节位姿参数;
健侧手部运动轨迹生成模块,用于根据所述机械臂各关节位姿参数生成健侧手部运动轨迹;
控制模块,用于根据所述健侧手部运动轨迹控制患者的患侧手部进行康复运动训练。
6.根据权利要求5所述的基于六自由度机械臂的患侧手部康复训练***,其特征在于,所述健侧手部位姿参数确定模块具体包括:
健侧手部位姿参数确定单元,用于对所述加速度以及所述姿态角进行积分处理,确定健侧手部位姿参数。
7.根据权利要求5所述的基于六自由度机械臂的患侧手部康复训练***,其特征在于,所述患侧手部位姿参数确定模块具体包括:
患侧手部位姿参数确定单元,用于利用公式[XJ YJ ZJ AJ BJ CJ]T=[-XH-YH-ZH-AH-BH-CH]T确定患侧手部位姿参数;其中,T为患侧手部位姿参数;XJ,YJ,ZJ为健侧手部的位置参数;AJ,BJ,CJ为健侧手部位姿参数;J为健侧手部;XH,YH,ZH为患侧手部的位置参数;AH,BH,CH为患侧手部的位姿参数;H为患侧手部。
8.根据权利要求5所述的基于六自由度机械臂的患侧手部康复训练***,其特征在于,所述机械臂各关节位姿参数确定模块具体包括:
空间直角坐标系建立单元,用于以机械臂任一关节为原点,建立空间直角坐标系;
旋转角确定单元,用于在所述空间直角坐标系下,利用六自由度机械臂逆解算法,根据所述机械臂末端位姿参数确定所述机械臂各个关节的旋转角;
机械臂各关节位姿参数确定单元,用于根据所述旋转角确定机械臂各关节位姿参数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911273784.4A CN110812125A (zh) | 2019-12-12 | 2019-12-12 | 一种基于六自由度机械臂的患侧手部康复训练方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911273784.4A CN110812125A (zh) | 2019-12-12 | 2019-12-12 | 一种基于六自由度机械臂的患侧手部康复训练方法及*** |
Publications (1)
Publication Number | Publication Date |
---|---|
CN110812125A true CN110812125A (zh) | 2020-02-21 |
Family
ID=69544937
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911273784.4A Pending CN110812125A (zh) | 2019-12-12 | 2019-12-12 | 一种基于六自由度机械臂的患侧手部康复训练方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110812125A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113679568A (zh) * | 2021-09-01 | 2021-11-23 | 南京医科大学 | 机器人辅助脑卒中患者上肢多模态镜像康复训练评分*** |
CN114224577A (zh) * | 2022-02-24 | 2022-03-25 | 深圳市心流科技有限公司 | 智能假肢的训练方法、装置、电子设备、智能假肢及介质 |
Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102509025A (zh) * | 2011-11-25 | 2012-06-20 | 苏州大学 | 一种六自由度仿人灵巧臂逆运动学的快速求解方法 |
CN102566593A (zh) * | 2011-12-26 | 2012-07-11 | 北京航空航天大学 | 中轴穿越法逆解六自由度关节型工业机器人关节位移 |
CN102637158A (zh) * | 2012-04-28 | 2012-08-15 | 谷菲 | 一种六自由度串联机器人运动学逆解的求解方法 |
JP2016052492A (ja) * | 2014-09-03 | 2016-04-14 | 株式会社日本リハビリデバイス技術研究所 | 高い安全性を有する上肢・下肢リハビリ訓練装置 |
JP2016097238A (ja) * | 2014-11-26 | 2016-05-30 | 株式会社ピーアンドエーテクノロジーズ | リハビリ装置 |
CN106493708A (zh) * | 2016-12-09 | 2017-03-15 | 南京理工大学 | 一种基于双机械臂和辅助臂的带电作业机器人控制*** |
CN108888473A (zh) * | 2018-05-22 | 2018-11-27 | 哈尔滨工业大学 | 基于穿戴式助行外骨骼的下肢关节运动复现方法 |
CN109009880A (zh) * | 2018-09-01 | 2018-12-18 | 郑州大学 | 一种末端牵引式上肢康复机器人 |
CN109091819A (zh) * | 2018-08-13 | 2018-12-28 | 上海理工大学 | 上肢康复机器人控制*** |
CN109568082A (zh) * | 2018-12-11 | 2019-04-05 | 上海大学 | 一种上肢康复训练机器人及上肢康复训练方法 |
CN109702751A (zh) * | 2019-03-01 | 2019-05-03 | 中国科学院电子学研究所 | 一种七自由度串联机械臂的位置级逆解方法 |
CN110013419A (zh) * | 2019-05-14 | 2019-07-16 | 上海大学 | 一种双臂康复机器人及训练方法 |
CN110281241A (zh) * | 2019-06-27 | 2019-09-27 | 大连理工大学 | 基于激光跟踪仪测量机械臂运动学参数标定方法 |
-
2019
- 2019-12-12 CN CN201911273784.4A patent/CN110812125A/zh active Pending
Patent Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102509025A (zh) * | 2011-11-25 | 2012-06-20 | 苏州大学 | 一种六自由度仿人灵巧臂逆运动学的快速求解方法 |
CN102566593A (zh) * | 2011-12-26 | 2012-07-11 | 北京航空航天大学 | 中轴穿越法逆解六自由度关节型工业机器人关节位移 |
CN102637158A (zh) * | 2012-04-28 | 2012-08-15 | 谷菲 | 一种六自由度串联机器人运动学逆解的求解方法 |
JP2016052492A (ja) * | 2014-09-03 | 2016-04-14 | 株式会社日本リハビリデバイス技術研究所 | 高い安全性を有する上肢・下肢リハビリ訓練装置 |
JP2016097238A (ja) * | 2014-11-26 | 2016-05-30 | 株式会社ピーアンドエーテクノロジーズ | リハビリ装置 |
CN106493708A (zh) * | 2016-12-09 | 2017-03-15 | 南京理工大学 | 一种基于双机械臂和辅助臂的带电作业机器人控制*** |
CN108888473A (zh) * | 2018-05-22 | 2018-11-27 | 哈尔滨工业大学 | 基于穿戴式助行外骨骼的下肢关节运动复现方法 |
CN109091819A (zh) * | 2018-08-13 | 2018-12-28 | 上海理工大学 | 上肢康复机器人控制*** |
CN109009880A (zh) * | 2018-09-01 | 2018-12-18 | 郑州大学 | 一种末端牵引式上肢康复机器人 |
CN109568082A (zh) * | 2018-12-11 | 2019-04-05 | 上海大学 | 一种上肢康复训练机器人及上肢康复训练方法 |
CN109702751A (zh) * | 2019-03-01 | 2019-05-03 | 中国科学院电子学研究所 | 一种七自由度串联机械臂的位置级逆解方法 |
CN110013419A (zh) * | 2019-05-14 | 2019-07-16 | 上海大学 | 一种双臂康复机器人及训练方法 |
CN110281241A (zh) * | 2019-06-27 | 2019-09-27 | 大连理工大学 | 基于激光跟踪仪测量机械臂运动学参数标定方法 |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113679568A (zh) * | 2021-09-01 | 2021-11-23 | 南京医科大学 | 机器人辅助脑卒中患者上肢多模态镜像康复训练评分*** |
CN114224577A (zh) * | 2022-02-24 | 2022-03-25 | 深圳市心流科技有限公司 | 智能假肢的训练方法、装置、电子设备、智能假肢及介质 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US20220167879A1 (en) | Upper limb function assessment device and use method thereof and upper limb rehabilitation training system and use method thereof | |
CN104524742A (zh) | 一种基于Kinect传感器的脑瘫儿童康复训练方法 | |
CN109091818B (zh) | 基于导纳控制的绳牵引上肢康复机器人的训练方法及*** | |
CN109172066B (zh) | 基于语音控制与视觉识别的智能假肢手及其***和方法 | |
CN110812125A (zh) | 一种基于六自由度机械臂的患侧手部康复训练方法及*** | |
CN106003053A (zh) | 一种遥操作随动机器人控制***及其控制方法 | |
CN211357457U (zh) | 一种基于多轴机器人视觉动态跟踪的磁刺激*** | |
WO2023206833A1 (zh) | 基于肌肉协同和变刚度阻抗控制的手腕部康复训练*** | |
CN106491251B (zh) | 一种基于非侵入式脑机接口机器臂控制***及其控制方法 | |
CN111863198A (zh) | 基于虚拟现实的康复机器人交互***及方法 | |
WO2022073467A1 (zh) | 一种陪护按摩双臂多任务并行处理机器人装置 | |
CN111127991B (zh) | 一种3d医学教学*** | |
CN106371588A (zh) | 基于运动想象脑机接口的手功能康复方法 | |
CN109887570B (zh) | 一种基于rgb-d相机与imu传感器的机器人辅助康复训练方法 | |
CN116869770A (zh) | 一种双机协作上肢康复机器人的控制方法及*** | |
CN115345197A (zh) | 多模态信息融合的外肢体控制方法、***和电子设备 | |
Torres Quezada et al. | Robotic training system for upper limb rehabilitation | |
Durandau et al. | EMG-driven models of human-machine interaction in individuals wearing the H2 exoskeleton | |
CN113925742B (zh) | 一种目标驱动式的上肢外骨骼康复机器人的控制方法及其控制*** | |
CN105759657B (zh) | 操纵装置和操纵方法 | |
CN114010184A (zh) | 平面康复机器人运动数据采集和镜像方法 | |
CN213607940U (zh) | 一种手功能障碍康复*** | |
TWI601526B (zh) | Lower limb rehabilitation device control method and the implementation of the method of lower limb rehabilitation device | |
CN114432663A (zh) | 一种六自由度上肢康复机器人及其重力补偿方法 | |
CN110742774A (zh) | 一种基于Leap Motion的健患侧协同手部训练*** |
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 |