Rehabilitation movement control method and system based on rehabilitation robot, equipment and medium

A technology of motion control system and rehabilitation robot, which is applied in the direction of sensors, passive exercise equipment, medical science, etc., can solve the problems of wide influence, lack of flexibility in system control, and can only receive position commands, etc., to achieve the effect of comfortable training

Pending Publication Date: 2021-01-01
SHANGHAI ELECTRICGROUP CORP
View PDF8 Cites 4 Cited by
  • Summary
  • Abstract
  • Description
  • Claims
  • Application Information

AI Technical Summary

Problems solved by technology

[0003] At present, the teaching mode training of rehabilitation robots basically adopts the position control method, that is, by obtaining the motion trajectory point information preset by the therapist, and directly sending the trajectory point information to the rehabilitation robot controller to control the motion of the rehabilitation robot. Control is actually to receive the position information command of each joint point, and then send the command directly to the motor driver to make the motor run to the specified position. The position control mode is the most common way at present, and the implementation is relatively simple, but its disadvantages It is also obvious: the system control lacks flexibility and can only receive position commands. Once a communication failure occurs, it will have a wide range of impacts, and the equipment will suddenly stop moving, causing unpredictable situations, and the consequences are more serious. At the same time, because the position motion control will ignore the intermediate process , with the goal of reaching the target position, lacks good interactivity

Method used

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
View more

Image

Smart Image Click on the blue labels to locate them in the text.
Viewing Examples
Smart Image
  • Rehabilitation movement control method and system based on rehabilitation robot, equipment and medium
  • Rehabilitation movement control method and system based on rehabilitation robot, equipment and medium
  • Rehabilitation movement control method and system based on rehabilitation robot, equipment and medium

Examples

Experimental program
Comparison scheme
Effect test

Embodiment 1

[0075] A rehabilitation motion control method based on a rehabilitation robot, such as figure 1 As shown, the rehabilitation exercise control method includes:

[0076] S10. Acquire teaching data, where the teaching data includes a smooth motion track of at least one motion joint when the patient is driven to perform the teaching motion;

[0077] S20. Acquiring real-time motion data of each motion joint of the patient when the rehabilitation robot drives the patient to perform rehabilitation motion according to the smooth motion trajectory; the real-time motion data includes position data and joint speed data of each motion joint;

[0078] S30. Obtain expected position data of the next expected trajectory point of each kinematic joint based on the smooth motion trajectory;

[0079] S40. According to the real-time motion data and the expected position data, calculate and obtain the torque data for driving the rehabilitation robot to move each kinematic joint to the next expecte...

Embodiment 2

[0086] This embodiment is further on the basis of embodiment 1, as image 3 As shown, before step S50, the rehabilitation exercise control method also includes:

[0087] S41. Construct a dynamic function according to the real-time motion data, and the dynamic function is used to solve the output torque of the rehabilitation robot at the current trajectory point;

[0088] S42. Obtain real-time torque data of the rehabilitation robot at the current trajectory point; it should be noted that this data can be directly obtained through the motor encoder of the rehabilitation robot.

[0089] S43. Obtain weight data of the rehabilitation robot; the weight data is the gravity compensation amount of the mechanical arm of the rehabilitation robot, that is, the weight of the mechanical arm.

[0090] Step S50 specifically includes:

[0091] S51. Control the rehabilitation robot to drive the patient to perform the rehabilitation exercise according to the output torque, the real-time torqu...

Embodiment 3

[0131] This embodiment is further improved on the basis of Embodiment 1, the teaching data includes the teaching motion data of the kinematic joint at multiple teaching trajectory points, such as Figure 5 As shown, step S10 specifically includes:

[0132] S111. Select the target track point with the largest vertical distance from the line connecting the start teaching track point and the end teaching track point in the teaching movement;

[0133] S112. Determine whether the vertical distance between the target track point and the line connecting the start teaching track point and the end teaching track point in the teaching movement is greater than a preset threshold, if so, execute step S113, and then execute step S112. S114, if not, execute step S115;

[0134] S113. Extracting the target track point as a feature point;

[0135] S114. Taking the target trajectory point as a boundary point to divide the teaching movement into segmented teaching movement, return to step S111...

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
Login to view more

PUM

No PUM Login to view more

Abstract

The invention discloses a rehabilitation movement control method and system based on a rehabilitation robot, equipment and a medium. The rehabilitation movement control method comprises the followingsteps of teaching data are obtained, and the teaching data comprise a smooth movement track of at least one movement joint when a patient is driven to carry out teaching movement; the rehabilitation robot drives the patient to do rehabilitation movement according to the smooth movement track, and real-time movement data of each movement joint of the patient are obtained; expected position data ofa next expected track point of each motion joint are obtained based on the smooth motion track; according to the real-time motion data and the expected position data, torque data which the rehabilitation robot is driven to drive each motion joint to move to the next expected track point are calculated; and the rehabilitation robot is controlled to drive the patient to do rehabilitation exercise according to the torque data. According to the rehabilitation movement control method and system based on the rehabilitation robot, the equipment and the medium, a common position control algorithm is replaced with a force control method to achieve teaching training, interaction force between people and equipment is fully considered, and the patient can conduct training more comfortably.

Description

technical field [0001] The invention belongs to the field of rehabilitation instrument control, and in particular relates to a rehabilitation motion control method, system, equipment and medium based on a rehabilitation robot. Background technique [0002] Robot teaching is to demonstrate some actions through robots to achieve the purpose of education, and the combination of robot teaching and rehabilitation robots can more effectively help patients to carry out rehabilitation training. [0003] At present, the teaching mode training of rehabilitation robots basically adopts the position control method, that is, by obtaining the motion track point information preset by the therapist, and directly sending the track point information to the rehabilitation robot controller to control the motion of the rehabilitation robot. Control is actually to receive the position information command of each joint point, and then send the command directly to the motor driver to make the motor...

Claims

the structure of the environmentally friendly knitted fabric provided by the present invention; figure 2 Flow chart of the yarn wrapping machine for environmentally friendly knitted fabrics and storage devices; image 3 Is the parameter map of the yarn covering machine
Login to view more

Application Information

Patent Timeline
no application Login to view more
Patent Type & Authority Applications(China)
IPC IPC(8): A61H1/02A61B5/11
CPCA61H1/0274A61B5/1124A61B5/4836A61H1/0277A61H1/0281A61H2201/1659A61H2201/5041
Inventor 徐颖俊郭凤仙范渊杰
Owner SHANGHAI ELECTRICGROUP CORP
Who we serve
  • R&D Engineer
  • R&D Manager
  • IP Professional
Why Eureka
  • Industry Leading Data Capabilities
  • Powerful AI technology
  • Patent DNA Extraction
Social media
Try Eureka
PatSnap group products