[发明专利]基于体感外设手臂运动追踪的康复训练系统及其训练方法

说明书

技术领域

本发明涉及一种属于生物医学工程、计算机和自动控制领域的康复训练技术，具体涉及一种基于体感外设的手臂运动追踪的康复训练系统及其训练方法。

背景技术

体感（Natural User Interface）是一种识别三维空间中肢体动作的人机交互技术，近年来受到广泛的关注。

微软公司推出的Kinect设备（即体感外设），由一个RGB摄像头和两个深度摄像头构成，能够捕捉深度信息，提供丰富和准确的三维运动信息。

中风后的功能缺失是一种常见的后遗症，所以病人通常需要进行长期的康复性训练恢复功能。在传统的功能康复治疗中，主要是靠理疗师来一对一的进行病人的康复训练，这样的方式使得工作效率较低。

在新颖的体感技术下，理疗师站在Kinect传感器前做一些康复性动作，Kinect实时地捕获到理疗师各个关节的三维坐标，通过对三维坐标的解析实时给出机械手臂控制命令，实现机械手臂带动患者进行康复性训练。这种技术不但可以实时处理理疗师的动作，还能根据需要存储理疗师的动作，以方便单个甚至多个患者进行准确的、周期的康复性训练。这些是传统理疗师对病人进行康复性训练做不到的。

发明内容

本发明提供一种基于体感周边外设手臂运动追踪的康复训练系统及其训练方法，通过理疗师示范指导性的康复动作，精准地映射成机械手臂控制命令，通过机械手臂运动带动患者手臂进行准确地、重复地、长期地训练，最终提升中风患者康复效果。

为实现上述目的，本发明提供一种基于体感周边外设手臂运动追踪的康复训练系统，其特点是，该系统包含基于体感外设的骨骼数据处理子系统，电路连接基于体感外设的骨骼数据处理子系统输出端的机械手臂控制子系统，以及电路连接机械手臂控制子系统输出端的康复机械手臂。

上述的基于体感外设的骨骼数据处理子系统采用微软公司的Kinect设备。

上述的康复机械手臂包含上臂部件，分别设置在上臂部件两端的下臂部件和肩部部件，以及机械手臂基座；

上述下臂部件与上臂部件之间还设有肘部屈伸旋转部件，下臂部件与上臂部件通过该肘部屈伸旋转部件转动连接；

上述上臂部件与肩部部件之间还设有肩关节前后转动部件，上臂部件与肩部部件通过该肩关节前后转动部件转动连接；

上述肩部部件的顶端设有肩关节上下转动部件，肩部部件通过该肩关节上下转动部件与机械手臂基座转动连接；

上述肘部屈伸旋转部件通过转轴连接有肘部屈伸旋转驱动电机；

上述肩关节前后转动部件通过转轴连接有肩部前后旋转驱动电机；

上述肩关节上下转动部件通过转轴连接有肩部上下旋转电机。

上述上臂部件与下臂部件都设有呈半圆弧形的支撑结构。

一种适用于基于体感外设手臂运动追踪的康复训练系统的训练方法，其特点是，该方法包含以下步骤：

步骤1、基于体感外设的骨骼数据处理子系统每秒对手腕、手肘、肩、双肩中点、另一侧肩的关节点捕获30次三维坐标；取各点最近五次的三维坐标数值，并分别计算取其平均数值；

步骤2、基于体感外设的骨骼数据处理子系统每次捕获上述五个关节点的三维坐标后，计算肘部关节的旋转关系和肩部关节的前后旋转关系；

步骤2.1、基于体感外设的骨骼数据处理子系统计算肘部关节的旋转关系，设手腕的三维坐标为A、手肘的三维坐标为B、肩的三维坐标为C；

计算关节旋转角度的公式如下：

                                                 

其中，所得的∠ABC即为肘部关节的旋转角度；

步骤2.2、基于体感外设的骨骼数据处理子系统计算肩部关节的前后旋转关系，设手肘的三维坐标为A、肩的三维坐标为B、双肩中点的三维坐标为C，

计算关节旋转角度的公式如下：

 

其中，所得的∠ABC即为肩部关节的前后旋转角度；

步骤3、基于体感外设的骨骼数据处理子系统通过手腕、手肘、肩和另一侧肩的关节点的三维坐标，判断手臂在身体的前方还是右侧；

步骤3.1、计算过手腕、手肘、肩三点三维坐标的平面方程的表达式（Ax +By +Cz +D =0），跳转到步骤3.2；

步骤3.2、计算另一侧肩的三维坐标到手腕、手肘、肩三点所在平面的距离，跳转到步骤3.3；