ROBOT SYSTEM FOR ACTIVE AND PASSIVE UPPER LIMB REHABILITATION TRAINING BASED ON FORCE FEEDBACK TECHNOLOGY

Abstract

A robot system for active and passive upper limb rehabilitation training based on a force feedback technology includes a robot body and an active and passive training host computer system. Active and passive rehabilitation training may be performed at degrees of freedom such as adduction/abduction and flexion/extension of left and right shoulder joints, and flexion/extension of left and right elbow joints according to a condition of a patient. In a passive rehabilitation training mode, the robot body drives the upper limb of the patient to move according to a track specified by the host computer, to gradually restore a basic motion function of the upper limb. In an active rehabilitation training mode, the patient holds the tail ends of the robot body with both hands to interact with a rehabilitation training scene, and can feel real and accurate force feedback.

Claims

1. A robot system for active and passive upper limb rehabilitation training based on a force feedback technology, comprising: a robot body, comprising two multi-degree-of-freedom manipulators configured for placing hands of a patient and a motor unit, wherein a force/torque sensor is mounted on a tail end of each manipulator of the two multi-degree-of-freedom manipulators; and an active and passive training host computer system for an active rehabilitation training and/or a passive rehabilitation training, wherein when the robot system provides the passive rehabilitation training, the hands of the patient are supported by the tail end of the each manipulator, and the robot system calculates an expected position track of the tail end of the each manipulator into a motion angle of at least one motor according to a rehabilitation training action, and controls the each manipulator to draw an upper limb to complete a training task set by the robot system; and when the robot system provides the active rehabilitation training, a virtual rehabilitation training scene is provided by a man-machine interaction interface, the each manipulator serves as an interface for a man-machine interaction, the hands of the patient control the tail end of the each manipulator to move, and the robot system enables the patient to interact with the virtual rehabilitation training scene by using a visual feedback and a force feedback, to complete a task in the virtual rehabilitation training scene.

2. The robot system for active and passive upper limb rehabilitation training according to claim 1, wherein the robot body is worn on a human body by using a detachable part.

3. The robot system for active and passive upper limb rehabilitation training according to claim 2, wherein the detachable part is a belt, and the two multi-degree-of-freedom manipulators are respectively mounted on two sides of the belt.

4. The robot system for active and passive upper limb rehabilitation training according to claim 1, wherein the passive rehabilitation training comprises: calculating, by the robot system according to the rehabilitation training action, the expected position track of the tail end into a plurality of motion angles of six motors by using an inverse kinematics calculation formula of the each manipulator, and storing the plurality of motion angles; driving, by the each manipulator, to make the upper limb perform a training according to a specified rehabilitation action until a specified quantity of times of training is reached; and analyzing an accuracy level of an action of the upper limb of the patient according to feedback information from each motor of the six motors in a training process, and scoring a rehabilitation effect, to obtain a line graph of a passive rehabilitation effect of the patient after the rehabilitation effect is scored a plurality of times.

5. The robot system for active and passive upper limb rehabilitation training according to claim 4, wherein the feedback information from the each motor comprises an angle and/or a current.

6. The robot system for active and passive upper limb rehabilitation training according to claim 1, wherein the active rehabilitation training comprises visual feedback information and force feedback information, wherein a presentation manner of the visual feedback information is that: the man-machine interaction interface of the robot system displays a scene of a rehabilitation training task and virtual hands of the patient, positions of the virtual hands change with positions of the hands of the patient, the positions of the virtual hands are obtained through a calculation by the robot system by using a forward kinematics calculation formula of the each manipulator according to angle information of six motors, and the man-machine interaction interface continuously updates the positions of the hands of the patient to provide the visual feedback information for the patient; and a presentation manner of the force feedback information is that: the hands of the patient control, by using the tail end of the each manipulator, the virtual hands in the man-machine interaction interface to collide with a virtual object, the robot system calculates force/torque information generated through a collision according to an algorithm, and allocates a force/torque to the six motors through statics analysis of the each manipulator, and the each manipulator presents a force on the upper limb of the patient, and allows the patient to feel the force during the active rehabilitation training; and a rehabilitation condition of the upper limb of the patient is analyzed according to information recorded in a training process, and a rehabilitation effect is scored, to obtain a line graph of an active rehabilitation effect of the patient after the rehabilitation effect is scored a plurality of times.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

[0019] FIG. 1 is a schematic structural diagram of a three-degree-of-freedom robot system for active and passive upper limb rehabilitation training according to the present invention;

[0020] FIG. 2 is a flowchart of a use method of passive rehabilitation training according to the present invention;

[0021] FIG. 3 is a flowchart of a use method of active rehabilitation training according to the present invention; and

[0022] FIG. 4 is a control diagram of implementing precise force feedback by a system.

DETAILED DESCRIPTION OF THE EMBODIMENTS

[0023] The technical solutions of the present invention are described in detail below with reference to the accompanying drawings and specific implementations.

[0024] As shown in FIG. 1, a robot system for active and passive upper limb rehabilitation training based on a force feedback technology includes a robot body 2 and an active and passive training host computer system. The robot body 2 includes two three-degree-of-freedom manipulators and six motor units configured to drive the manipulators. A patient 1 wears the robot body 2 on the waist by using a rigid belt. Preferably, tightness of the rigid belt can be adjusted by using a velcro tape. Human hands hold tail ends of the two manipulators extending from two sides of the belt, and a force/torque sensor is mounted on the tail end of the manipulator. The active and passive training host computer system includes an active rehabilitation training host computer 3 and a passive rehabilitation training host computer 4.

[0025] There is bidirectional data transmission between the robot body 2 and the passive rehabilitation training host computer 4. The host computer transmits control instructions for the six motors to the robot body, and motor data (such as an angle and a current) of the robot body 2 is fed back to the host computer. There is bidirectional data transmission between the robot body 2 and the active rehabilitation training host computer 3. The robot body 2 transmits data of the six motors and the force/torque sensor to the host computer, and the host computer transmits data for controlling the motors to the robot body. When the system provides passive rehabilitation training, the patient holds the tail ends of the manipulators with both hands, and the manipulators draw the upper limbs to complete long-time and highly repetitive training tasks. In this case, the manipulator plays a role in supporting the passive rehabilitation training. When the system provides active rehabilitation training, the patient holds the tail ends of the manipulators with both hands and completes some tasks in a virtual rehabilitation training scene with visual feedback and force feedback. The design of man-machine integration enables the robot system for active and passive upper limb rehabilitation training to help the patient perform a large quantity of active and passive rehabilitation training by using the two manipulators extending from the waist as an interface for man-machine interaction without an additional somatosensory device, and has an important application value for upper limb rehabilitation training.

[0026] FIG. 2 is a flowchart of a use method of passive rehabilitation according to the robot system for active and passive upper limb rehabilitation training based on a force feedback technology. In an early stage of rehabilitation training, the patient has an inadequate muscle group function and poor coordination between joints, and therefore, a large quantity of repetitive passive rehabilitation training needs to be performed first. First, the medical personnel perform basic examination on the patient to determine whether the upper limb of the patient has a basic autonomous motion function, and if not, the medical personnel evaluate rehabilitation needs of the patient for upper limb functions such as shoulder joint adduction and abduction, shoulder joint extension and flexion, elbow joint flexion and extension, and customize a training action and a quantity of times of training for the patient. Passive rehabilitation training host computer software calculates angles of joints of the two manipulators according to a track of the training action, and sends instructions to the motors through a bus. The patient wears the robot body on the waist, performs adjustment by using the velcro tape, and holds the tail ends of the manipulators with both hands. The manipulators drive the upper limbs to move until the quantity of times of training is reached. An accuracy level of the action of the upper limbs of the patient is analyzed according to feedback information from the motor in a training process, and a rehabilitation effect is scored. After the rehabilitation effect is scored a plurality of times, a line graph of the passive rehabilitation effect of the patient can be obtained. States of the motors are monitored throughout the process. If there is any exception (such as excessive feedback current), power cutoff is automatically performed to ensure patient safety.

[0027] FIG. 3 is a flowchart of a use method of active rehabilitation according to the robot system for active and passive upper limb rehabilitation training based on a force feedback technology. After the patient performs long-term passive rehabilitation training, the muscle group capability and the joint function of the patient are greatly restored, and the basic motion ability is regained. In this case, the patient needs scientific active rehabilitation training to improve flexibility of the upper limbs. First, the medical personnel determine flexibility and coordination of the upper limbs of the patient through simple tests. If rehabilitation treatment is needed, a proper rehabilitation training task is designed according to a specific condition. For example, the training task may be performed in the form of game interaction. In the active rehabilitation training process, no additional somatosensory device is needed. The manipulator is an interface for man-machine interaction between the patient and a rehabilitation game. The patient holds the tail ends of the manipulators, and the active rehabilitation training host computer displays a rehabilitation training game scene in a man-machine interaction interface (a computer screen). Two small balls may be used as agents of two hands in the scene, and positions of the small balls change with positions of the hands. The positions of the small balls are obtained through calculation by the system by using a forward kinematics calculation formula of the three-degree-of-freedom manipulator according to angle information of the six motors. The patient controls the manipulators to move, and the angle information of the joints of the manipulators are transmitted to the active rehabilitation training host computer. Positions of the tail end agent balls in the game scene are calculated by using a kinematics equation. The positions of the balls are continuously updated to provide visual information for the patient.

[0028] In addition, in the active rehabilitation training process, the system can further provide precise force feedback for the patient, so that the patient can feel the force when holding the manipulators for training. The rehabilitation game is more vivid and real through dual stimulation of visual information and force information, thereby improving training enthusiasm of the patient. FIG. 4 is a control diagram of implementing precise force feedback by a robot system for active and passive upper limb rehabilitation training according to the present invention. In the active training process, if the system detects a collision between the tail end agent and a virtual object, the system calculates a force/torque according to a collision algorithm, calculates an expected force/torque to each joint of the manipulator by using a statics equation, and at the same time, sends a corresponding control instruction to the motor. To ensure precision of the force feedback at the tail end of the manipulator, a detected signal of the force/torque sensor at the tail end of the manipulator is used as a feedback signal, to adjust a working state of the motor in real time, thereby providing the patient with a more precise and real force feedback feeling.

[0029] Flexibility and coordination of the upper limbs of the patient are analyzed according to information recorded in the training process (such as a task completion duration), and a rehabilitation effect is scored. After the rehabilitation effect is scored a plurality of times, a line graph of the active rehabilitation effect of the patient can be obtained.

[0030] In conclusion, in the robot system for active and passive upper limb rehabilitation training based on a force feedback technology provided in the present invention, the robot system is directly worn on the waist of a person through the man-machine integration design. The person holds the tail ends of the two manipulators extending from the waist, to complete some active and passive upper limb rehabilitation training for shoulder joint adduction and abduction, shoulder joint extension and flexion, elbow joint flexion and extension. Secondly, the flexibility of the upper limbs of the patient can be gradually enhanced through active and passive rehabilitation training without an additional somatosensory device. Moreover, in the active training process, the system provides real-time force feedback for the upper limb by using the manipulator according to the interaction between the patient and the rehabilitation game, and improves the rehabilitation training effect through dual stimulation of the visual information and the force information. Specific training content such as the angle of the motion joint during passive rehabilitation and the form and difficulty of the task during active training may be modified and customized according to an actual condition of the patient.