体感交互式上肢镜像康复训练机器人系统

doi:10.3785/j.issn.1006-754X.2022.00.027

体感交互式上肢镜像康复训练机器人系统

刘庆祥^,^,¹, 郭冰菁^,^,¹^,², 韩建海¹^,²^,³, 李向攀¹^,², 黄明祥¹

1.河南科技大学机电工程学院，河南洛阳 471003

2.河南省机器人与智能系统重点实验室，河南洛阳 471003

3.机械装备先进制造河南省协同创新中心，河南洛阳 471003

Somatosensory interactive upper-limb mirror rehabilitation training robot system

LIU Qing-xiang^,^,¹, GUO Bing-jing^,^,¹^,², HAN Jian-hai¹^,²^,³, LI Xiang-pan¹^,², HUANG Ming-xiang¹

1.College of Mechanical and Electrical Engineering，Henan University of Science and Technology，Luoyang 471003，China

2.Henan Key Laboratory of Robotics and Intelligent Systems，Luoyang 471003，China

3.Henan Collaborative Innovation Center for Advanced Manufacturing of Mechanical Equipment，Luoyang 471003，China

通讯作者: 郭冰菁（1973—），女，江苏南京人，副教授，博士，从事机电控制技术和机器人研究，E-mail：bingjing@haust.edu.cn，https：//orcid.org/0000-0002-8591-8034郭冰菁（1973—），女，江苏南京人，副教授，博士，从事机电控制技术和机器人研究，E-mail：bingjing@haust.edu.cn，https：//orcid.org/0000-0002-8591-8034

收稿日期: 2021-05-11 修回日期: 2021-07-11

基金资助:

河南省科技攻关计划资助项目. 192102210065. 212102310890. 212102310249

Received: 2021-05-11 Revised: 2021-07-11

作者简介 About authors

刘庆祥（1995—），男，河南新乡人，硕士生，从事机器人研究，E-mail：1627049654@qq.com，https：//orcid.org/0000-0001-5335-0133 , E-mail：1627049654@qq.com

摘要

针对脑卒中患者因大脑神经损伤而造成的上肢运动功能缺失，结合镜像疗法的机器人辅助训练可通过促使双侧肢协同运动来有效地促进大脑神经元重塑，从而实现运动功能恢复。为此，将镜像康复理论、虚拟现实技术和机器人技术有效结合，提出一种体感交互式上肢镜像康复训练机器人系统。使用动作捕捉设备采集患者健肢的位姿信息，通过设计人机镜像运动映射算法来映射上肢康复训练机器人的运动轨迹。考虑到康复治疗的柔性需要，该机器人的关节采用基于比例压力控制的摆动气缸来驱动；同时，针对气动系统的特性，设计了PD（proportional differential，比例微分）+速度前馈补偿的轨迹跟踪控制策略，实现了双侧肢协同运动的镜像康复训练。通过对机器人系统样机进行复合运动轨迹规划试验和镜像康复训练试验，验证了该系统在镜像康复治疗中的可行性和有效性。所设计的机器人系统为人体双侧肢协同运动的康复训练临床需求提供了设计思路和实现方法。

关键词： 上肢康复训练机器人 ; 镜像治疗 ; 体感交互 ; 比例压力控制 ; 运动映射

Abstract

Aiming at the loss of upper limb motor function caused by brain nerve injury in stroke patients, the robot assisted training combined with mirror therapy can effectively promote the remodeling of brain neurons by promoting the coordinated movement of bilateral limbs, so as to realize the recovery of motor function. Therefore, a somatosensory interactive upper-limb mirror rehabilitation training robot system was proposed by effectively combining the mirror rehabilitation theory, virtual reality technology and robot technology. The pose information of human healthy limb was collected by the motion capture equipment, and the motion trajectory of upper-limb rehabilitation training robot was mapped by designing a human-machine mirror motion mapping algorithm. Considering the flexibility of rehabilitation treatment, the robot joints were driven by oscillating cylinders based on proportional pressure control; at the same time, according to the characteristics of pneumatic system, the trajectory tracking control strategy of PD (proportional differential) + speed feedforward compensation was designed to realize the mirror rehabilitation training of coordinated movement of bilateral limbs. The feasibility and effectiveness of robot system in the mirror rehabilitation treatment were verified by the composite motion trajectory planning test and the mirror mirror rehabilitation training test for the robot system prototype. The designed robot system provides a design idea and implementation method for the clinical needs of rehabilitation training for the cooperative movement of human bilateral limbs.

Keywords： upper-limb rehabilitation training robot ; mirror therapy ; somatosensory interaction ; proportional pressure control ; motion mapping

PDF (4176KB) 元数据多维度评价相关文章导出 EndNote| Ris| Bibtex 收藏本文

本文引用格式

刘庆祥, 郭冰菁, 韩建海, 李向攀, 黄明祥. 体感交互式上肢镜像康复训练机器人系统. 工程设计学报[J], 2022, 29(2): 143-152 doi:10.3785/j.issn.1006-754X.2022.00.027

LIU Qing-xiang, GUO Bing-jing, HAN Jian-hai, LI Xiang-pan, HUANG Ming-xiang. Somatosensory interactive upper-limb mirror rehabilitation training robot system. Chinese Journal of Engineering Design[J], 2022, 29(2): 143-152 doi:10.3785/j.issn.1006-754X.2022.00.027

近年来，经循证医学证明镜像疗法是一种有效的临床治疗方法，可用于脑卒中后单侧忽略症患者或偏瘫患者的上肢运动功能恢复^［1］。镜像疗法的原理是：利用一面镜子反射健肢动作，让患者产生患肢运动的错觉，以刺激其大脑产生运动意识，从而促使患肢运动功能重建。镜像疗法有效性的内在机制是人体大脑镜像神经元的激活，从而促进大脑神经的可塑性^［2-3］。镜像疗法已被广泛应用于人体上肢康复的临床治疗。但传统的镜像治疗存在一定的局限性：第一，患肢实际上是无法移动的，仅通过运动想象来促使大脑神经元重塑；第二，镜像是通过镜子反射产生的，因镜像装置的限制，临床治疗效果的稳定性会受到影响。因此，镜像疗法的实施亟须寻求创新突破^［4］。

目前，已有很多学者针对镜像疗法的有效实施提出了多种方法，可归纳为以下2类。一类是将镜像疗法与虚拟现实技术结合，使患者产生身临其境的沉浸感，增加康复治疗的趣味性。如：冈山大学的Kenji等^［5］开发了一个虚拟现实镜像视觉反馈系统，其由计算机、手部动作捕捉数据手套、手臂移动跟踪定位系统、显示器和虚拟训练游戏系统组成，患者通过穿戴数据手套来控制虚拟场景中的手臂移动，利用运动想象产生患肢抓取的错觉。该系统可同时进行手腕和手指功能的康复训练。奥塔哥大学的Hoermann等^［6］开发了一个用于手部运动功能康复训练的镜像系统，通过摄像头采集健康手的图像，并在液晶屏幕上显示其镜像图像，然后基于Unity3D软件设计虚拟镜像场景，以进行患肢手部的镜像康复治疗。另一类是将镜像疗法与上肢康复训练机器人结合，使用机器人进行辅助训练有利于上肢运动功能的恢复，弥补了传统镜像疗法中患肢不能动的缺陷，促进了视觉和本体感觉的整合。如：Beom等^［7］设计了一个可以实时运动的穿戴式两轴机器人，用于偏瘫患者手臂的康复训练。该机器人的原理为：健肢一侧的传感器将位姿信息转换为坐标信号并传递给患肢一侧的机器人，以使患肢和健肢同步移动，通过两肢体间的空间耦合效应促进患肢运动功能的恢复（其作用机制是在镜像神经元作用下，一侧肢体倾向于采用另一侧肢体的空间特征）。在采用机器人辅助训练的镜像治疗中，机器人通过镜像对称的映射运动来带动患肢运动，形成双侧肢协同运动模式，使得未受损的大脑半球与受损的大脑半球相互作用，从而更好地诱导大脑运动皮层网络的重组，促进皮层神经的可塑性^［8-10］。

综上所述，健肢运动镜像的虚拟现实呈现和机器人辅助患者双侧肢协同运动均能有效改善传统镜像疗法的不足，提高康复效率。基于此，笔者通过将镜像康复理论、虚拟现实技术和机器人技术三者有效结合，提出了一种体感交互式上肢镜像康复训练机器人系统。该系统采用可穿戴式动作捕捉设备快速获取患者健肢的位姿信息，并利用虚拟现实技术将健肢与健肢镜像运动呈现到虚拟场景中，同时使用气动机械臂牵引患肢作镜像运动，以实现体感交互式镜像康复训练。

1 上肢镜像康复训练机器人系统结构

传统的康复训练机器人仅能根据医师设置的康复轨迹机械地重复动作^［11］，患者只能被动地作跟随运动。但是由于患者存在个体差异，偏瘫程度不同的患者使用时应对康复训练机器人设定的期望轨迹做出调整，以增加康复过程中的舒适性^［12］。因此，在康复训练机器人辅助患者康复治疗的过程中，如何实现良好的人机交互、人机共融已成为迫切的需求。为了使康复训练机器人更好地服务患者以及实现自然有效的人机交互，提出一种体感交互式上肢镜像康复训练机器人系统，其总体布局如图1所示。

图1

新窗口打开| 下载原图ZIP| 生成PPT

图1 体感交互式上肢镜像康复训练机器人系统的总体布局

Fig.1 Overall layout of somatosensory interactive upper-limb mirror rehabilitation training robot system

体感交互式上肢镜像康复训练机器人系统主要包括主控计算机（搭载虚拟现实体感交互平台）、控制器、可穿戴式动作捕捉设备、二自由度气动机械臂和工作台。其中，可穿戴式动作捕捉设备主要用于采集患者健肢的位姿信息；气动机械臂为平面连杆结构，其关节由摆动气缸驱动，其末端与患肢末端（手部）相连，通过末端牵引的方法进行康复训练^［13］。在主控计算机端搭载的虚拟现实体感交互平台中建立实时同步的人体模型以及康复训练虚拟场景，然后基于人机镜像运动映射算法将患者健肢位姿信息换算为镜像后气动机械臂的运动轨迹，并生成相应的控制信号发送至气动机械臂的控制器，以实时控制气动机械臂带动患肢作镜像运动。

所设计的上肢镜像康复训练机器人系统适用于上肢偏瘫患者。该系统以患者健肢为主端，通过动作捕捉设备将健肢动作输入到虚拟现实体感交互平台中，健肢动作被镜像映射为患肢动作并同步到虚拟场景中，虚拟场景中的健肢镜像动作通过视觉反馈给患者，以刺激患者大脑中控制患肢运动的神经元，从而实现数字化镜像治疗。同时，健肢动作的镜像映射轨迹作为康复训练机器人的期望轨迹，由机器人带动患肢作镜像运动，促进患肢运动功能恢复。相对于传统的镜像治疗和机器人辅助训练，所设计的系统采用人体大脑和肢体双闭环的康复思想，在实现视觉反馈的镜像治疗的同时促使双侧肢协同运动，有利于患者大脑皮层神经元重塑和患肢运动功能恢复。此外，由于健肢运动更符合患肢自身的用手习惯，使用健肢运动映射控制康复训练机器人的运动更具有个性化特征^［14］。

2 上肢镜像康复训练机器人的控制系统

2.1　控制系统组成

体感交互式上肢镜像康复训练机器人控制系统的硬件主要包括主控计算机、LinksRT半实物仿真机、比例压力阀、旋转编码器、摆动气缸和VD_Suit动作捕捉设备，如图2所示。

图2

新窗口打开| 下载原图ZIP| 生成PPT

图2 体感交互式上肢镜像康复训练机器人控制系统框图

Fig.2 Control system block diagram of somatosensory interactive upper-limb mirror rehabilitation training robot

体感交互式上肢镜像康复训练机器人的控制系统基于VD_Suit动作捕捉设备采集的患者健肢的位姿信息，实现健肢与气动机械臂的运动映射；以LinksRT半实物仿真机作为控制器，其中，PCI-6602计数器板用于采集旋转编码器信号以获取气动机械臂的关节角度，PCI-6251多功能采集板卡用于采集摆动气缸的压力信号，PCI-6216模拟量输出卡用于控制比例压力阀的出口压力，从而控制气动机械臂运动。基于MATLAB/Simulink软件建立气动机械臂的控制模型，并在实际搭建的物理样机上完成半实物仿真，可以方便地调试控制算法，从而快速地验证其有效性。

2.2　控制策略设计

气动系统最大的优点是柔顺性好，其被广泛应用于各类柔性场合。气动系统能够在完成作业任务的同时保证使用者的安全和对环境的友好性。但是，由于气体的可压缩性大，使得气动系统在控制稳定性方面较电机驱动系统差。另外，气动系统的低阻尼比特性使其伺服控制的响应不够稳定。当气缸低速工作时，因受摩擦力矩的强非线性和低阻尼特性的影响，气缸在响应过程中出现“爬行”现象。因此，设计合适的控制策略来改善气动系统的伺服控制响应特性尤为重要。根据气动系统的特性，本文气动机械臂采用PD（proportional differential，比例微分）+速度前馈补偿的控制策略，如图3所示。其中，PD控制能够增大系统阻尼，提高稳定性；速度前馈补偿可有效消除系统的迟滞，从而满足康复轨迹跟踪的控制需求。

图3

新窗口打开| 下载原图ZIP| 生成PPT

图3 气动机械臂的PD+速度前馈补偿控制策略框图

Fig.3 Block diagram of PD + speed feedforward compensation control strategy of pneumatic manipulator

基于图3，PD+速度前馈补偿控制策略可表示为：

\{\begin{array}{l} u (k) = K_{P} e (k) + K_{D} [e (k) - e (k - 1)] + K_{V} {\dot{θ}}_{d} (k) \\ e (k) = θ_{d} (k) - θ (k) \end{array}

（1）

式中： $θ_{d}$ （k）为气动机械臂关节的期望角度； ${\dot{θ}}_{d}$ （k）为气动机械臂关节的期望角速度； $θ$ （k）为气动机械臂关节的实际角度；u（k）为比例压力阀的控制电压；K_P为比例增益；K_D为微分增益；K_V为速度前馈增益；e（k）为位置误差。

3 人机镜像运动映射算法

体感交互式上肢镜像康复机器人实现镜像控制的关键是获取稳定的患者健肢位姿信息，并通过运动映射算法将其转换为气动机械臂的期望轨迹。本文通过VD_Suit动作捕捉设备来采集患者健肢的位姿信息^［15］，将其映射为气动机械臂末端的位置并规划气动机械臂各关节的转动角度，实现体感交互控制。

运动映射的目的是让气动机械臂牵引患者患肢按健肢的镜像运动进行康复训练^［16］。目前，常用的运动映射方法主要包括末端映射、关节映射和关键点映射。对于主端和从端结构不一致（异构）的遥操作系统，无法在关节空间中建立二者的映射关系。在所设计的上肢镜像康复训练机器人系统中，气动机械臂与患者健肢为异构映射，且采用末端牵引的方式带动患肢，故本文选择末端映射的方法。该方法的优点是映射算法简单，且不需要考虑主、从端的结构和角度关系。在笛卡尔坐标系中，建立患者健肢末端位置与气动机械臂末端位置的映射关系，即将健肢末端的工作空间与气动机械臂末端的工作空间进行配准，从而实现健肢末端位姿与气动机械臂末端位姿的对应^［17］。一般情况下，运动映射需要分别建立主、从端的运动学方程和工作空间，通过设计人机镜像运动映射算法来将健肢末端位置转换成气动机械臂末端的目标位置，随后通过求解运动学逆解来规划其关节转动角度，以实现主从跟随运动。在本文的上肢镜像康复训练机器人系统中，动作捕捉设备将采集到的患者健肢的位姿信息直接传输至虚拟场景中的人体模型，而后Unity3D软件（搭载非常强大的物理和动画引擎）直接提取健肢末端的位姿信息，无须进行复杂的运动学建模。综上，提出一种基于工作空间的人机镜像运动映射算法，如图4所示。其中： $X_{P_{m}}$ 、 $Y_{P_{m}}$ 为患者健肢末端P_m在健肢工作坐标系下的位置； $X_{P_{s}}$ 、 $Y_{P_{s}}$ 为患肢末端P_s在患肢工作坐标系下的期望位置（由健肢末端位置镜像映射得到）；X_P 、Y_P 为气动机械臂末端P在机械臂基坐标系下的位置（由患肢末端期望位置 $X_{P_{s}}$ 、 $Y_{P_{s}}$ 经坐标系转换后得到）。

图4

新窗口打开| 下载原图ZIP| 生成PPT

图4 基于工作空间的人机镜像运动映射算法

Fig.4 Human-machine mirror motion mapping algorithm based on workspace

主、从端工作空间的匹配是实现异构遥操作系统有效控制的基础^［18-19］。在本文的上肢镜像康复训练机器人系统中，主端健肢穿戴的动作捕捉设备的工作空间为三维空间，可采集360°全方位的位姿信息，而从端气动机械臂末端只能作平面移动且可达范围有限，因此须对通过动作捕捉设备获取的健肢末端工作空间进行限定^［20］：忽略垂直于工作台的Z向位移，将健肢末端的工作空间限定在与气动机械臂末端工作空间对应的一定范围的平面内，仅将健肢末端在该平面内的位移视为有效信号。对气动机械臂末端的工作空间进行分析，并建立其运动学模型。二自由度气动机械臂的结构及各坐标系之间的关系如图5所示。其中：XOY为世界坐标系，X₁O₁Y₁为以气动机械臂大臂关节为原点构建的基坐标系，X₂O₂Y₂为以气动机械臂小臂关节为原点构建的坐标系。

图5

新窗口打开| 下载原图ZIP| 生成PPT

图5 二自由度气动机械臂结构简图及坐标系构建

Fig.5 Structure diagram of two-degree-of-freedom pneumatic manipulator and coordinate system construction

利用几何法建立二自由度气动机械臂末端的正运动学方程，可表示为：

\{\begin{array}{l} X_{P} = L_{1} c o s θ_{1} + L_{2} c o s (θ_{1} + θ_{2}) \\ Y_{P} = L_{1} s i n θ_{1} + L_{2} s i n (θ_{1} + θ_{2}) \end{array}

式中：θ₁、θ₂分别为气动机械臂大、小臂关节的转动角度，以逆时针方向为正向；L₁、L₂分别为气动机械臂大、小臂的长度。

根据二自由度气动机械臂末端的正运动学方程，得到其末端的工作空间，如图6所示。

图6

新窗口打开| 下载原图ZIP| 生成PPT

图6 气动机械臂末端的工作空间

Fig.6 Workspace of the end of pneumatic manipulator

对于基于工作空间的人机镜像运动映射算法，需要将人体健肢末端的位置映射到牵引患肢的气动机械臂末端的工作空间中，建立健肢末端与气动机械臂末端工作空间的镜像映射关系，如图7所示。图中：X_mO_mY_m为健肢工作坐标系，X_sO_sY_s为患肢工作坐标系，其坐标轴方向相同。

图7

新窗口打开| 下载原图ZIP| 生成PPT

图7 健肢末端与气动机械臂末端工作空间的镜像映射关系

Fig.7 Mirror mapping relationship of workspace between healthy limb end and pneumatic manipulator end

基于工作空间的人机镜像运动映射算法采用点到点的方式控制气动机械臂运动。基于上述定义的坐标系，得到健肢工作坐标系与患肢工作坐标系的镜像变换矩阵^sT_m：

{}^{s} T_{m} = [\begin{matrix} K_{X} & 0 \\ 0 & K_{Y} \end{matrix}]

式中：K_X 、K_Y 为X、Y向上的比例映射系数。

由于本文上肢镜像康复训练机器人系统的运动映射为镜像映射，且健肢、患肢工作坐标系的方向都一致，取K_X = -1， K_Y =1，则可得健肢、患肢末端位置的映射关系为：

P_{s} = {}^{s}T T_{m} P_{m}

式中： P_m为健肢末端在健肢工作坐标系中的位置矢量； P_s为患肢末端在患肢工作坐标系中的位置矢量。

当气动机械臂工作时，其末端与患肢末端相连。为了求解气动机械臂末端在基坐标系X₁O₁Y₁中的位置，需对患肢末端位置矢量进行坐标转换，转换过程如下：

P = R_{s} P_{s} + P_{s o}

式中： $P$ 为气动机械臂末端在基坐标系X₁O₁Y₁中位置矢量； $P_{s o}$ 为患肢工作坐标系原点在基坐标系X₁O₁Y₁中的位置矢量； $R_{s}$ 为患肢工作坐标系X_sO_sY_s与基坐标系X₁O₁Y₁的旋转矩阵。

设患肢工作坐标系X_sO_sY_s相对于气动机械臂基坐标系X₁O₁Y₁的旋转角为φ，则旋转矩阵可表示为：

R_{s} = [\begin{array}{l} c o s φ \\ s i n φ \end{array} \begin{array}{l} - s i n φ \\ c o s φ \end{array}]

通过求气动机械臂末端的运动学逆解可得到其关节的转动角度。利用几何法求得气动机械臂的逆运动学方程，根据其工作情况，取θ₂ $\in$ （0， $\frac{3}{4}$ π），可得：

\{\begin{array}{l} θ_{1} = a r c t a n \frac{Y_{P}}{X_{P}} - a r c c o s \frac{X_{P}^{2} + Y_{P}^{2} + L_{1}^{2} - L_{2}^{2}}{2 L_{1} \sqrt[]{X_{P}^{2} + Y_{P}^{2}}} \\ θ_{2} = a r c c o s \frac{(X_{P}^{2} + Y_{P}^{2}) - L_{1}^{2} - L_{2}^{2}}{2 L_{1} L_{2}} \end{array}

4 试验验证

4.1　样机试验平台搭建

为了测试体感交互式上肢镜像康复训练机器人系统的性能，搭建了如图8所示的样机试验平台，其由主控计算机、LinksRT仿真机（内置控制器及扩展板卡）、二自由度气动机械臂和VD_Suit动作捕捉设备组成。该上肢镜像康复训练机器人系统设有被动康复训练和主动康复训练两种模式。其中：对于被动康复训练模式，气动机械臂末端的轨迹完全按照动作捕捉设备采集的患者健肢末端位置信息（或理疗师的康复训练动作轨迹）映射得到；对于主动康复训练模式，患者患肢具有一定的运动功能，患者可主动跟随健肢运动过程，自适应调节气动机械臂控制的阻抗系数，提高患肢在康复过程中的参与度。由于轨迹控制是机器人康复训练的基础，首先通过单关节轨迹跟踪试验来分析上肢镜像康复训练机器人系统的运动跟踪特性，然后通过复合运动轨迹规划试验对其多关节协调控制进行验证，最后通过镜像康复训练试验对所设计的人机镜像运动映射算法和控制策略的有效性进行验证。

图8

新窗口打开| 下载原图ZIP| 生成PPT

图8 体感交互式上肢镜像康复训练机器人系统样机试验平台

Fig.8 Somatosensory interactive upper limb mirror rehabilitation training robot system prototype test platform

4.2　单关节轨迹跟踪试验

为保证气动机械臂运动的稳定性，须对PD+速度前馈补偿的控制算法进行参数调整。为了测试气动机械臂关节的轨迹跟踪响应特性，根据康复训练中人体上肢关节活动度和康复运动周期，选择峰值为40°、周期为6 s的正弦信号作为气动机械臂关节的期望轨迹信号，对其2个关节单独进行轨迹跟踪试验。气动系统气源压力设为0.6 MPa，试验参数如表1所示，气动机械臂各关节的轨迹跟踪曲线如图9所示。

表1 气动机械臂的PD+速度前馈补偿控制参数

Table 1 PD + speed feedforward compensation control parameters of pneumatic manipulator

关节	K_P	K_D	K_V
大臂关节	0.24	0.022	0.012
小臂关节	0.40	0.014	0.030

新窗口打开| 下载CSV

图9

新窗口打开| 下载原图ZIP| 生成PPT

图9 气动机械臂关节轨迹对比

Fig.9 Trajectory comparison of pneumatic manipulator joints

通过对比基于PD控制和PD+速度前馈补偿控制的气动机械臂单关节轨迹跟踪曲线，可以看出采用PD+速度前馈补偿控制后气动机械臂的迟滞得到了明显优化；拐点处关节的转动角度存在误差是因为当关节进行屈/伸转换时，摆动气缸需要换向，此时比例压力阀两端的压差变化较大，且在换向过程中存在的摩擦及冲击等不确定性因素，导致气动机械臂关节的轨迹跟踪存在误差。采用PD+速度前馈补偿控制时，气动机械臂大、小臂关节轨迹跟踪的平均误差分别为0.8°和1.5°，轨迹跟踪的均方根误差分别为0.8°和1.0°。由此可以看出，基于比例压力控制的气动机械臂的运动跟踪特性符合康复训练的要求。

4.3　复合运动轨迹规划试验

在上肢镜像康复训练机器人的安全工作空间内，以康复训练时常用的平面画圆动作为例规划训练轨迹，轨迹圆心在气动机械臂基坐标系X₁O₁Y₁中的坐标为（308.15， 0）m、轨迹半径100 mm。该圆形轨迹的函数表达式为：

\{\begin{array}{l} x = 308.15 + 100 c o s t \\ y = 100 s i n t \end{array}

（8）

为了使气动机械臂具有较好的运动特性，即保证其速度与加速度连续，利用S形曲线对气动机械臂末端的轨迹进行插值处理。然后基于气动机械臂的逆运动学方程，求解其2个关节的角位移规划曲线，从而获得复合运动规划轨迹。由于样机处于试验阶段，选择多位健康人员进行试验。本文选取其中2位测试者的试验数据进行分析。测试者1：身高为168 m，体重为65 kg；测试者2：身高为175 m，体重为75 kg。设定运动周期为10 s，则规划的气动机械臂末端轨迹如图10中实线所示。测试者1使用时气动机械臂末端的实际轨迹如图10中虚线所示，测试者2使用时气动机械臂末端的实际轨迹如图10中点线所示。

图10

新窗口打开| 下载原图ZIP| 生成PPT

图10 做画圆动作时气动机械臂末端轨迹对比

Fig.10 Trajectory comparison of pneumatic manipulator end during drawing a circle

测试者1和测试者2 使用时，气动机械臂末端X、Y向的轨迹分别如图11（a）和图11（b）所示。画圆的康复动作是气动机械臂大、小臂关节的旋转运动的合成运动，大、小臂关节轨迹的变化曲线分别如图11（c）和图11（d）所示。对比试验曲线可知，曲线平滑连续，无突变及抖动现象气动，气动机械臂运动平稳，跟踪误差主要出现在刚开始和结束处，开始时比例压力阀送入摆动气缸两腔的气体的压差变化大，导致气动机械臂不稳定，从而产生了较大的误差；而结束时压差变化小导致气动机械臂因驱动力不足而无法克服系统阻尼，从而产生了较大的误差。

图11

新窗口打开| 下载原图ZIP| 生成PPT

图11 做画圆动作时气动机械臂末端X、Y向轨迹及其关节轨迹对比

Fig.11 Comparison of X and Y directional trajectories of end and joint trajectories of pneumatic manipulator during drawing a circle

表2所示为测试者做画圆动作时气动机械臂的轨迹跟踪误差。其中：在测试者1使用时，气动机械臂末端X、Y向位置的平均误差分别为1.5 mm和4.3 mm，均方根误差分别为1.6 mm和5.4 mm；大、小臂关节转动角度的平均误差分别为0.8°和1.5°，均方根误差分别为0.7°和1.3°。在测试者2使用时，气动机械臂末端X、Y向位置的平均误差分别为1.1 mm和3.5 mm，均方根误差分别为1.4 mm和2.2 mm；大、小臂关节转动角度的平均误差分别为0.7°和1.2°，均方根误差分别为0.6°和0.9°。通过对比各项误差可知，对于不同使用者，气动机械臂的轨迹跟踪误差均较小，均符合系统要求，说明所设计的上肢镜像康复训练机器人系统具有普适性。在实验中，不同人使用时气动机械臂轨迹跟踪误差不同主要是因为体重的影响，测试者2较重，导致气动机械臂阻尼增大，这在一定程度上改善了气动系统的稳定性。结果表明，在机器人辅助的双侧上肢训练中，考虑增加驱动柔性采用的气压驱动关节，在运动过程中的位置精度及轨迹跟踪精度、速度均满足上肢康复训练的要求。

表2 做画圆动作时气动机械臂的轨迹跟踪误差

Table 2 Trajectory tracking error of pneumatic manipulator during drawing a circle

测试者	末端位置误差/mm				关节转动角度误差/(°)
	平均误差		均方根误差		平均误差		均方根误差
	X向	Y向	X向	Y向	大臂	小臂	大臂	小臂
1	1.5	4.3	1.6	5.4	0.8	1.5	0.78	1.3
2	1.1	3.5	1.4	2.2	0.7	1.2	0.6	0.9

新窗口打开| 下载CSV

4.4　镜像康复训练试验

为实现气动机械臂牵引患肢跟随健肢作同步的镜像运动，首先建立主控计算机中的虚拟环境与仿真机之间的TCP（transmission control protocol，传输控制协议）通信，其次根据动作捕捉设备采集的健肢位姿数据进行镜像运动映射，得到气动机械臂末端的位置信息，然后通过TCP通信传输给仿真机，通过求运动学逆解得到气动机械臂各关节的转动角度，最后控制比例压力阀对气动机械臂各关节进行伺服驱动。

同样由健康人进行镜像康复训练功能的验证。操作者穿戴动作捕捉设备坐在样机前方，一侧手（主手，模拟患者健肢）放在桌面初始位置，另一侧手（从手）抓住气动机械臂末端。对动作捕捉设备进行标定后，主手在桌面有效工作空间内作一系列平面运动，基于采集的位姿信息，通过人机镜像运动映射算法得到气动机械臂末端的轨迹，并与其实际轨迹进行对比。本试验中，操作者主手画方形图案作为康复训练的运动轨迹，利用动作捕捉设备采集相应的位姿信息，气动机械臂运动轨迹由旋转编码器反馈。康复训练时气动机械臂末端的映射轨迹及实际轨迹如图12所示。

图12

新窗口打开| 下载原图ZIP| 生成PPT

图12 康复训练时气动机械臂末端的轨迹对比

Fig.12 Trajectory comparison of pneumatic manipulator end during rehabilitation training

由图12可知，由于人体上肢运动具有一定的抖动，所映射的期望轨迹是不规则的，但气动机械臂的运动跟踪性能良好，使得偏差在康复训练允许范围之内；气动机械臂的康复动作与主手动作相符，可以较好地进行相同动作的牵引训练。通过对比验证了气动机械臂运动跟踪响应的快速性、稳定性和可行性，表明所设计的人机镜像运动映射算法和控制策略是有效的。

5 结论

本文开发的体感交互式上肢镜像康复训练机器人系统结构简单，操作方便以及控制方式新颖。患者可以直接通过穿戴动作捕捉设备采集健肢位姿信息来控制气动机械臂运动，从而辅助患者进行双侧肢协同运动的镜像训练，使镜像疗法与机器人辅助训练相辅相成。经试验验证，动作捕捉设备获取人体上肢位姿信息后，通过人机镜像运动映射算法能够有效地将健肢位姿信息转换为气动机械臂的运动轨迹，并牵引患肢完成康复训练。所设计的PD+速度前馈补偿控制算法实现了气压机械臂的运动控制，其在运动过程中的轨迹跟踪误差较小，运动平稳，能满足康复训练的要求。后续将在主动康复训练模式下对辅助力控制和机器人阻抗控制方面开展进一步研究。由于目前仍处于实验室试验阶段，并未开展临床试验，为更全面地评价该上肢镜像康复训练机器人系统的效果，还有待进一步开展临床试验。

参考文献

原文顺序

文献年度倒序

文中引用次数倒序

被引期刊影响因子

[1]

荣积峰，丁力，张雯，等.

康复机器人结合镜像疗法对脑卒中偏瘫患者上肢功能的效果

［J］.中国康复理论与实践，2019，25（6）：709-713. doi：10.3969/j.issn.1006-9771.2019.06.016

[本文引用: 1]

RONG

Ji-feng

， DING

， ZHANG

Wen

， et al.

Effects of robot-assisted therapy combined with mirror therapy on upper limbs rehabilitation in patients with hemiplegia after stroke

［J］. Chinese Journal of Rehabilitation Theory and Practice， 2019， 25（6）： 709-713.

DOI:10.3969/j.issn.1006-9771.2019.06.016 [本文引用: 1]

[2]

马玉静，勾丽洁，王文清.

镜像视觉反馈在脑卒中患者上肢功能障碍康复中的应用

［J］.中国康复医学杂志，2016，31（3）：358-362. doi：10.3969/j.issn.1001-1242.2016.03.024

[本文引用: 1]

Yu-jing

， GOU

Li-jie

， WANG

Wen-qing

Application of mirror visual feedback in rehabilitation of upper limb dysfunction in stroke patients

［J］. Chinese Journal of Rehabilitation Medicine， 2016， 31（3）： 358-362.

DOI:10.3969/j.issn.1001-1242.2016.03.024 [本文引用: 1]

[3]

梁天佳

脑卒中偏瘫上肢功能障碍康复治疗研究进展

［J］.广西医科大学学报，2018，35（7）：1026-1028. doi：10.16190/j.cnki.45-1211/r.2018.07.034

[本文引用: 1]

LIANG

Tian-jia

Research progress in rehabilitation treatment of upper limb dysfunction in stroke patients with hemiplegia

［J］. Journal of Guangxi Medical University， 2018， 35（7）： 1026-1028.

DOI:10.16190/j.cnki.45-1211/r.2018.07.034 [本文引用: 1]

[4]

梁爽，邹任玲，姜亚斌，等.

镜像集成疗法的上肢康复训练技术研究进展

［J］.中国康复理论与实践，2017，23（1）：59-62. doi：10.3969/j.issn.1006-9771.2017.01.014

[本文引用: 1]

LIANG

Shuang

， ZOU

Ren-ling

， JIANG

Ya-bin

， et al.

Advance of mirror integrated therapy for upper limbs rehabilitation （review）

［J］. Chinese Journal of Rehabilitation Theory and Practice， 2017， 23（1）： 59-62.

DOI:10.3969/j.issn.1006-9771.2017.01.014 [本文引用: 1]

[5]

KENJI

， SATOSHI

， TAKASHI

， et al.

Nonimmersive virtual reality mirror visual feedback therapy and its application for the treatment of complex regional pain syndrome： an open-label pilot study

［J］. Pain Medicine， 2010， 11（4）： 622-629. doi：10.1111/j. 1526-4637.2010.00819.x

[本文引用: 1]

[6]

HOERMANN

， SANTOS

L F D

， MORKISCH

， et al.

Computerized mirror therapy with augmented reflection technology for stroke rehabilitation： a feasibility study in a rehabilitation center

［C］//2015 International Conference on Virtual Rehabilitation （ICVR）， Valencia， Jun. 9-12， 2015. doi：10.1109/icvr.2015.7358575

[本文引用: 1]

[7]

BEOM

， KOH S， NAM

H S

， et al.

Robotic mirror therapy system for functional recovery of hemiplegic arms

［J］. Journal of Visualized Experiments， 2016（114）： e54521. doi：10.3791/54521

[本文引用: 1]

[8]

李梦晓，冯丽娟，张福蓉，等.

镜像视觉反馈疗法在康复训练中的研究进展

［J］.中国康复理论与实践，2017，23（12）：1403-1406. doi：10.3969/j.issn.1006-9771.2017.12.007

[本文引用: 1]

Meng-xiao

， FENG

Li-juan

， ZHANG

Fu-rong

， et al.

Mirror visual feedback therapy for rehabilitation training （review）

［J］. Chinese Journal of Rehabilitation Theory and Practice， 2017， 23（12）： 1403-1406.

DOI:10.3969/j.issn.1006-9771.2017.12.007 [本文引用: 1]

[9]

KIM

， MILLER

L M

， FEDULOW

， et al.

Kinematic data analysis for post-stroke patients following bilateral versus unilateral rehabilitation with an upper limb wearable robotic system

［J］. IEEE Transactions on Neural Systems and Rehabilitation Engineering， 2013， 21（2）： 153-164. doi：10.1109/tnsre.2012.2207462

[10]

丁力，贾杰.

镜像疗法在中老年脑卒中患者功能恢复中的应用现状

［J］.老年医学与保健，2015，21（3）：188-190. doi：10.3969/j.issn.1008-8296.2015-23

[本文引用: 1]

DING

， JIA

Jie

Application status of mirror therapy in functional recovery of middle-aged and elderly stroke patients

［J］. Geriatrics and Health Care， 2015， 21（3）： 188-190.

DOI:10.3969/j.issn.1008-8296.2015-23 [本文引用: 1]

[11]

陈臻，刘佳敏，陆晓，等.

镜像康复机器人在偏瘫康复中的应用研究

［J］.中国康复医学杂志，2020，35（8）：903-906. doi：10.3969/j.issn.1001-1242.2020.08.003

[本文引用: 1]

CHEN

Zhen

， LIU

Jia-min

， LU

Xiao

， et al.

Application research of mirror rehabilitation robot in hemiplegia rehabilitation

［J］. Chinese Journal of Rehabilitation Medicine， 2020， 35（8）： 903-906.

DOI:10.3969/j.issn.1001-1242.2020.08.003 [本文引用: 1]

[12]

SHAHBAZI

， ATASHZAR

S F

， TAVAKOLI

， et al.

Robotics-assisted mirror rehabilitation therapy： a therapist-in-the-loop assist-as-needed architecture

［J］. IEEE/ASME Transactions on Mechatronics， 2016， 21（4）： 1954-1965. doi：10.1109/tmech.2016.2551725

[本文引用: 1]

[13]

丁宝杰，韩建海，李向攀，等.

气动上肢康复机器人伺服控制和运动规划研究

［J］.液压与气动，2020（4）：67-72. doi：10.11832/j.issn.1000-4858.2020.04.011

[本文引用: 1]

DING

Bao-jie

， HAN

Jian-hai

， LI

Xiang-pan

， et al.

Servo control and motion planning of pneumatic upper-limb rehabilitation robot

［J］. Chinese Hydraulics & Pneumatics， 2020（4）： 67-72.

DOI:10.11832/j.issn.1000-4858.2020.04.011 [本文引用: 1]

[14]

瞿畅，吴炳，陈厚军，等.

体感控制的上肢外骨骼镜像康复机器人系统

［J］.中国机械工程，2018，29（20）：94-99. doi：10.3969/j.issn.1004-132X.2018.20.014

[本文引用: 1]

Chang

， WU

Bing

， CHEN

Hou-jun

， et al.

Upper-limb exoskeletal mirror rehabilitation robot systems based on motion sensing control

［J］. China Mechanical Engineering， 2018， 29（20）： 94-99.

DOI:10.3969/j.issn.1004-132X.2018.20.014 [本文引用: 1]

[15]

李启雷，金文光，耿卫东.

基于无线惯性传感器的人体动作捕获方法

［J］.浙江大学学报（工学版），2012，46（2）：280-285. doi：10.3785/j.issn.1008-973X.2012.02.016

[本文引用: 1]

Qi-lei

， JIN

Wen-guang

， GENG

Wei-dong

Human motion capture using wireless inertial sensors

［J］. Journal of Zhejiang University （Engineering Science）， 2012， 46（2）： 280-285.

DOI:10.3785/j.issn.1008-973X.2012.02.016 [本文引用: 1]

[16]

刘杰，张玉茹，刘博.

人手到灵巧手的运动映射实现

［J］.机器人，2003，25（5）：444-447. doi：10.3321/j.issn：1002-0446.2003.05.013

[本文引用: 1]

LIU

Jie

， ZHANG

Yu-ru

， LIU

Motion mapping of human hand to dexterous robotic hands

［J］. Robot， 2003， 25（5）： 444-447.

DOI:10.3321/j.issn：1002-0446.2003.05.013 [本文引用: 1]

[17]

李家霖，杨洋，杨铁，等.

外骨骼式遥操作主手设计及主从异构映射算法研究

［J］.机器人，2020，42（6）：651-660. doi：10.13973/j.cnki.robot.200077

[本文引用: 1]

Jia-lin

， YANG

Yang

， YANG

Tie

， et al.

Design of exoskeletal teleoperation master device and research on master-slave isomerism mapping algorithm

［J］. Robot， 2020， 42（6）： 651-660.

DOI:10.13973/j.cnki.robot.200077 [本文引用: 1]

[18]

刘理想，张静，徐亮，等.

异构遥操作仿人机械臂灵巧作业控制

［J］.传感器与微系统，2018，37（7）：39-41. doi： 10.13873/J.1000-9787（2018）07-0039-03

[本文引用: 1]

LIU

Li-xiang

， ZHANG

Jing

， XU

Liang

， et al.

Dexterous work control of humanoid manipulator isomerism heterogeneous teleoperation

［J］. Transducer and Microsystem Technologies， 2018， 37（7）： 39-41.

DOI:10.13873/J.1000-9787（2018）07-0039-03 [本文引用: 1]

[19]

刘霞，潘成伟.

异构型遥操作系统的定位与接触控制研究

［J］.电子科技大学学报，2018，47（4）：532-538. doi：10.3969/j.issn.1001-0548.2018.04.010

[本文引用: 1]

LIU

Xia

， PAN

Cheng-wei

Research on location and contact control of heterogeneous teleoperation systems

［J］. Journal of University of Electronic Science and Technology of China， 2018， 47（4）： 532-538.

DOI:10.3969/j.issn.1001-0548.2018.04.010 [本文引用: 1]

[20]

汤卿，刘丝丝，尚留记，等.

基于KUKA工业机器人的遥操作控制系统设计与异构主从控制方法研究

［J］.四川大学学报（工程科学版），2016，48（1）：180-185. doi：10.15961/j.jsuese.2016.01.027

[本文引用: 1]

TANG

Qing

， LIU

Si-si

， SHANG

Liu-ji

， et al.

Design of teleoperation system of KUKA industrial robot and the control algorithm with heterogeneous master/slave structure

［J］. Journal of Sichuan University （Engineering Science Edition）， 2016， 48（1）： 180-185.

DOI:10.15961/j.jsuese.2016.01.027 [本文引用: 1]

康复机器人结合镜像疗法对脑卒中偏瘫患者上肢功能的效果

2019

... 近年来，经循证医学证明镜像疗法是一种有效的临床治疗方法，可用于脑卒中后单侧忽略症患者或偏瘫患者的上肢运动功能恢复^［1］.镜像疗法的原理是：利用一面镜子反射健肢动作，让患者产生患肢运动的错觉，以刺激其大脑产生运动意识，从而促使患肢运动功能重建.镜像疗法有效性的内在机制是人体大脑镜像神经元的激活，从而促进大脑神经的可塑性^［2-3］.镜像疗法已被广泛应用于人体上肢康复的临床治疗.但传统的镜像治疗存在一定的局限性：第一，患肢实际上是无法移动的，仅通过运动想象来促使大脑神经元重塑；第二，镜像是通过镜子反射产生的，因镜像装置的限制，临床治疗效果的稳定性会受到影响.因此，镜像疗法的实施亟须寻求创新突破^［4］. ...

康复机器人结合镜像疗法对脑卒中偏瘫患者上肢功能的效果

2019

镜像视觉反馈在脑卒中患者上肢功能障碍康复中的应用

2016

镜像视觉反馈在脑卒中患者上肢功能障碍康复中的应用

2016

脑卒中偏瘫上肢功能障碍康复治疗研究进展

2018

脑卒中偏瘫上肢功能障碍康复治疗研究进展

2018

镜像集成疗法的上肢康复训练技术研究进展

2017

镜像集成疗法的上肢康复训练技术研究进展

2017

Nonimmersive virtual reality mirror visual feedback therapy and its application for the treatment of complex regional pain syndrome： an open-label pilot study

2010

... 目前，已有很多学者针对镜像疗法的有效实施提出了多种方法，可归纳为以下2类.一类是将镜像疗法与虚拟现实技术结合，使患者产生身临其境的沉浸感，增加康复治疗的趣味性.如：冈山大学的Kenji等^［5］开发了一个虚拟现实镜像视觉反馈系统，其由计算机、手部动作捕捉数据手套、手臂移动跟踪定位系统、显示器和虚拟训练游戏系统组成，患者通过穿戴数据手套来控制虚拟场景中的手臂移动，利用运动想象产生患肢抓取的错觉.该系统可同时进行手腕和手指功能的康复训练.奥塔哥大学的Hoermann等^［6］开发了一个用于手部运动功能康复训练的镜像系统，通过摄像头采集健康手的图像，并在液晶屏幕上显示其镜像图像，然后基于Unity3D软件设计虚拟镜像场景，以进行患肢手部的镜像康复治疗.另一类是将镜像疗法与上肢康复训练机器人结合，使用机器人进行辅助训练有利于上肢运动功能的恢复，弥补了传统镜像疗法中患肢不能动的缺陷，促进了视觉和本体感觉的整合.如：Beom等^［7］设计了一个可以实时运动的穿戴式两轴机器人，用于偏瘫患者手臂的康复训练.该机器人的原理为：健肢一侧的传感器将位姿信息转换为坐标信号并传递给患肢一侧的机器人，以使患肢和健肢同步移动，通过两肢体间的空间耦合效应促进患肢运动功能的恢复（其作用机制是在镜像神经元作用下，一侧肢体倾向于采用另一侧肢体的空间特征）.在采用机器人辅助训练的镜像治疗中，机器人通过镜像对称的映射运动来带动患肢运动，形成双侧肢协同运动模式，使得未受损的大脑半球与受损的大脑半球相互作用，从而更好地诱导大脑运动皮层网络的重组，促进皮层神经的可塑性^［8-10］. ...

Computerized mirror therapy with augmented reflection technology for stroke rehabilitation： a feasibility study in a rehabilitation center

2015

Robotic mirror therapy system for functional recovery of hemiplegic arms

镜像视觉反馈疗法在康复训练中的研究进展

2017

镜像视觉反馈疗法在康复训练中的研究进展

2017

Kinematic data analysis for post-stroke patients following bilateral versus unilateral rehabilitation with an upper limb wearable robotic system

2013

镜像疗法在中老年脑卒中患者功能恢复中的应用现状

2015

镜像疗法在中老年脑卒中患者功能恢复中的应用现状

2015

镜像康复机器人在偏瘫康复中的应用研究

2020

... 传统的康复训练机器人仅能根据医师设置的康复轨迹机械地重复动作^［11］，患者只能被动地作跟随运动.但是由于患者存在个体差异，偏瘫程度不同的患者使用时应对康复训练机器人设定的期望轨迹做出调整，以增加康复过程中的舒适性^［12］.因此，在康复训练机器人辅助患者康复治疗的过程中，如何实现良好的人机交互、人机共融已成为迫切的需求.为了使康复训练机器人更好地服务患者以及实现自然有效的人机交互，提出一种体感交互式上肢镜像康复训练机器人系统，其总体布局如图1所示. ...

镜像康复机器人在偏瘫康复中的应用研究

2020

Robotics-assisted mirror rehabilitation therapy： a therapist-in-the-loop assist-as-needed architecture

2016

气动上肢康复机器人伺服控制和运动规划研究

2020

... 体感交互式上肢镜像康复训练机器人系统主要包括主控计算机（搭载虚拟现实体感交互平台）、控制器、可穿戴式动作捕捉设备、二自由度气动机械臂和工作台.其中，可穿戴式动作捕捉设备主要用于采集患者健肢的位姿信息；气动机械臂为平面连杆结构，其关节由摆动气缸驱动，其末端与患肢末端（手部）相连，通过末端牵引的方法进行康复训练^［13］.在主控计算机端搭载的虚拟现实体感交互平台中建立实时同步的人体模型以及康复训练虚拟场景，然后基于人机镜像运动映射算法将患者健肢位姿信息换算为镜像后气动机械臂的运动轨迹，并生成相应的控制信号发送至气动机械臂的控制器，以实时控制气动机械臂带动患肢作镜像运动. ...

气动上肢康复机器人伺服控制和运动规划研究

2020

体感控制的上肢外骨骼镜像康复机器人系统

2018

... 所设计的上肢镜像康复训练机器人系统适用于上肢偏瘫患者.该系统以患者健肢为主端，通过动作捕捉设备将健肢动作输入到虚拟现实体感交互平台中，健肢动作被镜像映射为患肢动作并同步到虚拟场景中，虚拟场景中的健肢镜像动作通过视觉反馈给患者，以刺激患者大脑中控制患肢运动的神经元，从而实现数字化镜像治疗.同时，健肢动作的镜像映射轨迹作为康复训练机器人的期望轨迹，由机器人带动患肢作镜像运动，促进患肢运动功能恢复.相对于传统的镜像治疗和机器人辅助训练，所设计的系统采用人体大脑和肢体双闭环的康复思想，在实现视觉反馈的镜像治疗的同时促使双侧肢协同运动，有利于患者大脑皮层神经元重塑和患肢运动功能恢复.此外，由于健肢运动更符合患肢自身的用手习惯，使用健肢运动映射控制康复训练机器人的运动更具有个性化特征^［14］. ...

体感控制的上肢外骨骼镜像康复机器人系统

2018

基于无线惯性传感器的人体动作捕获方法

2012

... 体感交互式上肢镜像康复机器人实现镜像控制的关键是获取稳定的患者健肢位姿信息，并通过运动映射算法将其转换为气动机械臂的期望轨迹.本文通过VD_Suit动作捕捉设备来采集患者健肢的位姿信息^［15］，将其映射为气动机械臂末端的位置并规划气动机械臂各关节的转动角度，实现体感交互控制. ...

基于无线惯性传感器的人体动作捕获方法

2012

人手到灵巧手的运动映射实现

2003

... 运动映射的目的是让气动机械臂牵引患者患肢按健肢的镜像运动进行康复训练^［16］.目前，常用的运动映射方法主要包括末端映射、关节映射和关键点映射.对于主端和从端结构不一致（异构）的遥操作系统，无法在关节空间中建立二者的映射关系.在所设计的上肢镜像康复训练机器人系统中，气动机械臂与患者健肢为异构映射，且采用末端牵引的方式带动患肢，故本文选择末端映射的方法.该方法的优点是映射算法简单，且不需要考虑主、从端的结构和角度关系.在笛卡尔坐标系中，建立患者健肢末端位置与气动机械臂末端位置的映射关系，即将健肢末端的工作空间与气动机械臂末端的工作空间进行配准，从而实现健肢末端位姿与气动机械臂末端位姿的对应^［17］.一般情况下，运动映射需要分别建立主、从端的运动学方程和工作空间，通过设计人机镜像运动映射算法来将健肢末端位置转换成气动机械臂末端的目标位置，随后通过求解运动学逆解来规划其关节转动角度，以实现主从跟随运动.在本文的上肢镜像康复训练机器人系统中，动作捕捉设备将采集到的患者健肢的位姿信息直接传输至虚拟场景中的人体模型，而后Unity3D软件（搭载非常强大的物理和动画引擎）直接提取健肢末端的位姿信息，无须进行复杂的运动学建模.综上，提出一种基于工作空间的人机镜像运动映射算法，如图4所示.其中：

X_{P_{m}}

、

Y_{P_{m}}

为患者健肢末端P_m在健肢工作坐标系下的位置；

X_{P_{s}}

、

Y_{P_{s}}

为患肢末端P_s在患肢工作坐标系下的期望位置（由健肢末端位置镜像映射得到）；X_P 、Y_P 为气动机械臂末端P在机械臂基坐标系下的位置（由患肢末端期望位置

X_{P_{s}}

、

Y_{P_{s}}

经坐标系转换后得到）. ...

人手到灵巧手的运动映射实现

2003

X_{P_{m}}

、

Y_{P_{m}}

为患者健肢末端P_m在健肢工作坐标系下的位置；

X_{P_{s}}

、

Y_{P_{s}}

X_{P_{s}}

、

Y_{P_{s}}

经坐标系转换后得到）. ...

外骨骼式遥操作主手设计及主从异构映射算法研究

2020

X_{P_{m}}

、

Y_{P_{m}}

为患者健肢末端P_m在健肢工作坐标系下的位置；

X_{P_{s}}

、

Y_{P_{s}}

X_{P_{s}}

、

Y_{P_{s}}

经坐标系转换后得到）. ...

外骨骼式遥操作主手设计及主从异构映射算法研究

2020

X_{P_{m}}

、

Y_{P_{m}}

为患者健肢末端P_m在健肢工作坐标系下的位置；

X_{P_{s}}

、

Y_{P_{s}}

X_{P_{s}}

、

Y_{P_{s}}

经坐标系转换后得到）. ...

异构遥操作仿人机械臂灵巧作业控制

2018

... 主、从端工作空间的匹配是实现异构遥操作系统有效控制的基础^［18-19］.在本文的上肢镜像康复训练机器人系统中，主端健肢穿戴的动作捕捉设备的工作空间为三维空间，可采集360°全方位的位姿信息，而从端气动机械臂末端只能作平面移动且可达范围有限，因此须对通过动作捕捉设备获取的健肢末端工作空间进行限定^［20］：忽略垂直于工作台的Z向位移，将健肢末端的工作空间限定在与气动机械臂末端工作空间对应的一定范围的平面内，仅将健肢末端在该平面内的位移视为有效信号.对气动机械臂末端的工作空间进行分析，并建立其运动学模型.二自由度气动机械臂的结构及各坐标系之间的关系如图5所示.其中：XOY为世界坐标系，X₁O₁Y₁为以气动机械臂大臂关节为原点构建的基坐标系，X₂O₂Y₂为以气动机械臂小臂关节为原点构建的坐标系. ...

异构遥操作仿人机械臂灵巧作业控制

2018

异构型遥操作系统的定位与接触控制研究

2018

异构型遥操作系统的定位与接触控制研究

2018

基于KUKA工业机器人的遥操作控制系统设计与异构主从控制方法研究

2016

基于KUKA工业机器人的遥操作控制系统设计与异构主从控制方法研究

2016

〈

〉