A control method and device for Tai Chi rehabilitation robot

By introducing Tai Chi movements into the rehabilitation robot, using the movement data set and pre-designed calculation parameters to calculate joint torque, and controlling joint operation, the problem of poor training results of existing rehabilitation robots is solved, and more efficient rehabilitation training effects are achieved.

CN118649402BActive Publication Date: 2024-11-12SHENZHEN WISEMEN MEDICAL TECH CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411124792.3
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2024-08-16
Publication Date
2024-11-12
Estimated Expiration
2044-08-16

AI Technical Summary

Technical Problem

The lack of standards in the design of rehabilitation training movements by existing rehabilitation robots, resulting in poor rehabilitation training results and difficulty in meeting the growing medical needs.

Method used

By introducing Tai Chi movements into the rehabilitation robot, the joint torque is calculated using the movement data set and pre-designed calculation parameters, the joints are controlled to operate according to the current command, and assisting the patients in completing Tai Chi movements, thereby enriching the training plan and improving the rehabilitation effect.

Benefits of technology

It has realized the introduction of Tai Chi movements into rehabilitation robots, enriched the training plan, improved the rehabilitation training effect, and was suitable for patients with stroke and reduced the treatment cost and labor intensity.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118649402B_ABST
    Figure CN118649402B_ABST
Patent Text Reader

Abstract

The present invention provides a control method and device for a Tai Chi rehabilitation robot; wherein the Tai Chi rehabilitation robot stores a plurality of motion data sets corresponding to Tai Chi movements, and the method comprises: obtaining the gravity item of an arm to be trained and the actual operation data of each joint in the current Tai Chi movement; wherein the actual operation data comprises the actual angle and the actual angular velocity; for each joint, the torque of the joint is calculated according to the actual operation data of the joint, the target motion data corresponding to the joint in the current Tai Chi movement, the gravity item of the arm to be trained and preset calculation parameters; a target current instruction is calculated according to the torque, and the joint is controlled to operate according to the current instruction to assist the arm to be trained to complete the current Tai Chi movement, thereby realizing the introduction of Tai Chi movement into the Tai Chi rehabilitation robot, enriching the training scheme of the Tai Chi rehabilitation robot, and improving the rehabilitation training effect of the Tai Chi rehabilitation robot.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of rehabilitation robots, and in particular to a control method and device for a Tai Chi rehabilitation robot. Background Art

[0002] Cerebral stroke, commonly known as stroke, is an acute cerebrovascular circulatory disorder caused by blockage or rupture of cerebral blood vessels. The resulting motor nerve damage can cause hemiplegia in patients, resulting in motor dysfunction of the patient's limbs, which seriously endangers the patient's physical and mental health. Therefore, rehabilitation treatment for patients is of great significance. In traditional rehabilitation treatment, physicians usually provide one-on-one rehabilitation treatment to patients manually. Since the physician's personal treatment methods, experience differences, subjective consciousness, and fatigue level will affect the treatment effect, the treatment process is labor-intensive and the nursing cost is high. In addition, the ratio of the number of physicians to patients is seriously unbalanced, making it difficult to meet the growing medical needs.

[0003] Based on this, most existing rehabilitation treatment programs use rehabilitation robots, which can not only alleviate the shortage of rehabilitation medical human resources, but also record the patient's treatment data in real time, providing an objective basis for disease assessment and program improvement. However, existing rehabilitation robots lack standards when designing rehabilitation training movements, and most of them design simple movements such as grasping for rehabilitation training. Therefore, how to enrich the training program of rehabilitation robots and improve the rehabilitation training effect of rehabilitation robots is an urgent problem to be solved. Summary of the invention

[0004] In view of this, the purpose of the present invention is to provide a Tai Chi rehabilitation robot control method and device to alleviate the above-mentioned problems. By introducing Tai Chi movements into the Tai Chi rehabilitation robot, the training program of the Tai Chi rehabilitation robot is enriched and the rehabilitation training effect of the Tai Chi rehabilitation robot is improved.

[0005] In a first aspect, an embodiment of the present invention provides a control method for a Tai Chi rehabilitation robot, wherein the Tai Chi rehabilitation robot stores a plurality of motion data sets corresponding to Tai Chi movements, each motion data set including target motion data of each joint of the Tai Chi rehabilitation robot in the Tai Chi movement; the method comprises:

[0006] Obtaining the gravity item of the arm to be trained and the actual operation data of each joint in the current Tai Chi action; wherein the actual operation data includes the actual angle and the actual angular velocity;

[0007] For each joint, the torque of the joint is calculated according to the actual operation data of the joint, the target motion data corresponding to the current Tai Chi action of the joint, the gravity term of the arm to be trained, and the preset calculation parameters; wherein the target motion data includes the target angle and the target angular velocity, and the preset calculation parameters include: the inertia matrix of the Tai Chi rehabilitation robot, the gravity term of the Tai Chi rehabilitation robot, the proportional control coefficient and the differential control coefficient corresponding to each joint;

[0008] The target current command is obtained according to the torque calculation, and the joint is controlled to operate according to the current command.

[0009] Preferably, the step of calculating the torque of the joint according to the actual operation data of the joint, the target motion data of the joint corresponding to the current Tai Chi action, the gravity term of the arm to be trained and the preset calculation parameters includes:

[0010] The torque is calculated as follows:

[0011]

[0012] in, Indicates i The torque of the joint, , n represents the total number of joints, Representation vector No. i item, They represent the Tai Chi rehabilitation robot n The vector composed of the actual angle and angular acceleration of each joint, represents the inertia matrix of the Tai Chi rehabilitation robot, represents the gravity term of the Tai Chi rehabilitation robot, represents the gravity term of the arm to be trained, Indicates i The friction term of each joint, Indicates i The target angle of each joint, Indicates i The target angular velocity of each joint, Indicates i The actual angle of each joint, Indicates i The actual angular velocity of each joint, Indicates i The proportional control coefficient corresponding to each joint is Indicates i The differential control coefficient corresponding to each joint.

[0013] Preferably, the method further comprises: in the data collection stage, controlling the Tai Chi rehabilitation robot to operate in an active mode, so that the Tai Chi professional wearing the Tai Chi rehabilitation robot can complete a plurality of Tai Chi movements; and collecting the angle and angular velocity of each joint in each Tai Chi movement in real time, and using the angle and angular velocity as the target angle and target angular velocity of each joint in the Tai Chi movement;

[0014] The calculation formula of each joint torque of the Tai Chi rehabilitation robot in the active mode is as follows:

[0015]

[0016] in, Indicates i The torque of the joint, , n represents the total number of joints, Representation vector No. i item; Tai Chi rehabilitation robot n The vector composed of the actual angle and angular acceleration of each joint; represents the inertia matrix of the Tai Chi rehabilitation robot, represents the gravity term of the Tai Chi rehabilitation robot; represents the gravity term of the arm to be trained; Indicates i The friction term of each joint; Indicates i The actual angle of each joint, Indicates i The actual angular velocity of each joint; represents the damping force depending on the joint angle, where the negative sign indicates the opposite direction of the motion. Indicates the preset i The position damping coefficient of each joint, Indicates i The maximum joint angle allowed for each joint along the current direction of movement; represents the damping force that depends on the joint angular velocity, where the negative sign indicates the opposite direction of motion. Indicates the preset i The velocity damping coefficient of each joint, Indicates i The maximum joint angular velocity allowed for each joint along the current direction of motion, max() represents the maximum value function.

[0017] Preferably, before the step of calculating the torque of the joint according to the actual operation data of the joint, the target motion data of the joint corresponding to the current Tai Chi action, the gravity term of the arm to be trained and the preset calculation parameters, the method further comprises: calculating the gravity term of the arm to be trained according to the weight and fixed position of the upper arm and the forearm corresponding to the arm to be trained;

[0018] The calculation formula of the gravity term of the arm to be trained is as follows:

[0019]

[0020] in, The Jacobian matrix representing the fixed point of the boom, express Transpose; Represents the rotation matrix from the inertial coordinate system to the boom link coordinate system; , represents the upper arm mass of the arm to be trained, and g=-9.81 represents the acceleration due to gravity; A vector representing the center of mass of the upper arm of the arm to be trained pointing to the fixed point of the upper arm; The Jacobian matrix representing the fixed point of the forearm, express Transpose; Represents the rotation matrix from the inertial coordinate system to the forearm link coordinate system; , represents the forearm mass of the arm to be trained, Represents the vector from the forearm mass center of the arm to be trained to the forearm fixed point.

[0021] Preferably, before the step of calculating the torque of the joint according to the actual operation data of the joint, the target motion data of the joint corresponding to the current Tai Chi action, the gravity term of the arm to be trained and the preset calculation parameters, the method further comprises: i The actual angular velocity of each joint and the preset friction parameters are calculated to obtain the i The friction item of each joint; wherein the preset friction parameters include: i Coulomb friction coefficient, viscous friction coefficient, Stribeck friction coefficient and Stribeck friction constant corresponding to each joint;

[0022] Among them, i The calculation formula for the friction term of each joint is as follows:

[0023]

[0024] in, Indicates i The friction term of each joint, Indicates i The Coulomb friction coefficient corresponding to each joint is: Indicates i The viscous friction coefficient corresponding to each joint is Indicates i The Stribeck friction coefficient corresponding to each joint is: Indicates i The actual angular velocity of each joint, represents a constant, Indicates i The Stribeck friction constant corresponding to each joint.

[0025] Preferably, the Tai Chi movements include at least one of the following: starting posture, wild horse splitting its mane, single whip, cloud hands, single whip, reverse arm roll, left embracing the sparrow's tail, right embracing the sparrow's tail, cross hands and closing posture.

[0026] In a second aspect, an embodiment of the present invention further provides a Tai Chi rehabilitation robot control device, wherein the Tai Chi rehabilitation robot stores motion data sets corresponding to a plurality of Tai Chi movements, each motion data set including target motion data of each joint of the Tai Chi rehabilitation robot in the Tai Chi movement; the device comprises:

[0027] An acquisition module is used to acquire the gravity item of the arm to be trained and the actual operation data of each joint in the current Tai Chi action; wherein the actual operation data includes the actual angle and the actual angular velocity;

[0028] A calculation module is used to calculate the torque of each joint according to the actual operation data of the joint, the target motion data corresponding to the joint in the current Tai Chi action, the gravity term of the arm to be trained, and preset calculation parameters; wherein the target motion data includes a target angle and a target angular velocity, and the preset calculation parameters include: an inertia matrix of the Tai Chi rehabilitation robot, a gravity term of the Tai Chi rehabilitation robot, a proportional control coefficient and a differential control coefficient corresponding to each joint;

[0029] The operation module is used to obtain the target current instruction according to the torque calculation, and control the joint to operate according to the target current instruction.

[0030] Preferably, the calculation module further includes:

[0031] The torque is calculated as follows:

[0032]

[0033] in, Indicates i The torque of the joint, , n represents the total number of joints, Representation vector No. i item, Respectively represent the Tai Chi rehabilitation robot n The vector composed of the actual angle and angular acceleration of each joint, represents the inertia matrix of the Tai Chi rehabilitation robot, represents the gravity term of the Tai Chi rehabilitation robot, represents the gravity term of the arm to be trained, Indicates i The friction term of each joint, Indicates i The target angle of each joint, Indicates i The target angular velocity of each joint, Indicates i The actual angle of each joint, Indicates i The actual angular velocity of each joint, Indicates i The proportional control coefficient corresponding to each joint is Indicates i The differential control coefficient corresponding to each joint.

[0034] In a third aspect, an embodiment of the present invention further provides a Tai Chi rehabilitation robot, comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor implements the steps of the method of the first aspect when executing the computer program.

[0035] In a fourth aspect, an embodiment of the present invention further provides a computer-readable storage medium, on which a computer program is stored, and when the computer program is executed by a processor, the steps of the method of the first aspect are executed.

[0036] The embodiments of the present invention bring the following beneficial effects:

[0037] The embodiment of the present invention provides a Tai Chi rehabilitation robot control method and device, in which a plurality of motion data sets corresponding to Tai Chi movements are stored in the Tai Chi rehabilitation robot, and during the rehabilitation training process, the gravity item of the arm to be trained and the actual operation data of each joint in the current Tai Chi movement are obtained; wherein the actual operation data include the actual angle and the actual angular velocity; for each joint, the torque of the joint is calculated according to the actual operation data of the joint, the target motion data corresponding to the joint in the current Tai Chi movement, the gravity item of the arm to be trained and the preset calculation parameters; the target current instruction is calculated according to the torque, and the joint is controlled to operate according to the current instruction to assist the arm to be trained to complete the current Tai Chi movement, thereby realizing the introduction of Tai Chi movements into the Tai Chi rehabilitation robot. Compared with the existing rehabilitation robots that perform rehabilitation training through simple movements such as grasping, the training scheme of the Tai Chi rehabilitation robot is enriched and the rehabilitation training effect of the Tai Chi rehabilitation robot is improved.

[0038] Other features and advantages of the present invention will be described in the following description, and partly become apparent from the description, or understood by practicing the present invention. The purpose and other advantages of the present invention are realized and obtained by the structures particularly pointed out in the description and the drawings.

[0039] In order to make the above-mentioned objects, features and advantages of the present invention more obvious and easy to understand, preferred embodiments are given below and described in detail with reference to the accompanying drawings. BRIEF DESCRIPTION OF THE DRAWINGS

[0040] In order to more clearly illustrate the specific implementation methods of the present invention or the technical solutions in the prior art, the drawings required for use in the specific implementation methods or the description of the prior art will be briefly introduced below. Obviously, the drawings described below are some implementation methods of the present invention. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.

[0041] Figure 1 A schematic diagram of the structure of a Tai Chi rehabilitation robot provided by an embodiment of the present invention;

[0042] Figure 2 A flow chart of a Tai Chi rehabilitation robot control method provided by an embodiment of the present invention;

[0043] Figure 3 A schematic diagram of the structure of an upper limb exoskeleton provided by an embodiment of the present invention;

[0044] Figure 4 A schematic diagram of the calculation principle of the joint torque of a Tai Chi rehabilitation robot in the data collection stage provided by an embodiment of the present invention;

[0045] Figure 5A schematic diagram of the calculation principle of the joint torque of a Tai Chi rehabilitation robot during the rehabilitation training stage provided by an embodiment of the present invention;

[0046] Figure 6 A schematic diagram of a gravity item of an arm to be trained provided by an embodiment of the present invention;

[0047] Figure 7 A schematic diagram of an interface of a display device provided by an embodiment of the present invention;

[0048] Figure 8 A schematic diagram of a Tai Chi rehabilitation robot control device provided by an embodiment of the present invention;

[0049] Fig. 9 A schematic structural diagram of another Tai Chi rehabilitation robot provided in an embodiment of the present invention. DETAILED DESCRIPTION

[0050] In order to make the purpose, technical solution and advantages of the embodiments of the present invention clearer, the technical solution of the present invention will be clearly and completely described below in conjunction with the accompanying drawings. Obviously, the described embodiments are part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0051] To facilitate understanding of this embodiment, a Tai Chi rehabilitation robot control method provided by an embodiment of the present invention is first described in detail below. Figure 1 As shown, the Tai Chi rehabilitation robot includes a control device 10, an execution device 20 and a display device 30. In actual applications, the control device 10 includes but is not limited to a controller, the display device 30 includes but is not limited to a display screen, etc. The execution device 20 is preferably in the form of an exoskeleton to better fit the human arm, so as to assist the user (or patient) in performing rehabilitation training on the arm to be trained.

[0052] In addition, both the execution device 20 and the display device 30 are communicatively connected to the control device 10. The execution device 20 is used to assist the arm to be trained in rehabilitation training under the drive of the control device 10; the display device 30 is used to display the training tasks corresponding to the rehabilitation training, including but not limited to: the starting position and end position of the training task, the animation corresponding to the training task and other content. This not only makes it convenient for patients to complete the rehabilitation training tasks according to the displayed tasks to be trained, but also increases the interest of patients in rehabilitation training. The specific content displayed by the display device 30 can be set according to actual conditions.

[0053] In addition, in actual applications, the control device 10 is also used to control the Tai Chi rehabilitation robot to execute the following Tai Chi rehabilitation robot control method, so that the Tai Chi rehabilitation robot assists the arm to be trained to complete the current Tai Chi movement, thereby introducing Tai Chi movements into rehabilitation training. Compared with the existing rehabilitation robots that perform rehabilitation training through simple movements such as grasping, the training plan of the Tai Chi rehabilitation robot is enriched and the rehabilitation training effect of the Tai Chi rehabilitation robot is improved.

[0054] Embodiment 1

[0055] The embodiment of the present invention provides a control method for a Tai Chi rehabilitation robot, wherein the Tai Chi rehabilitation robot stores a plurality of motion data sets corresponding to Tai Chi movements, each of which includes target motion data of each joint of the Tai Chi rehabilitation robot in the Tai Chi movement. In practical applications, sitting Tai Chi, also known as wheelchair Tai Chi, is performed in a sitting position to practice Tai Chi. The external characteristics of its movements are mainly upper limb movements, but each movement can drive the lower limbs through mental activities, thereby achieving the effect of full-body exercise. Therefore, for people with lower limb obstacles such as stroke and lower limb disability who have difficulty standing, sitting Tai Chi can improve their sitting balance ability, daily activity ability and quality of life. The embodiment of the present invention introduces Tai Chi movements into the Tai Chi rehabilitation robot. Compared with the existing rehabilitation robots that perform rehabilitation training through simple movements such as grabbing, the training scheme of the Tai Chi rehabilitation robot is enriched and the rehabilitation training effect of the Tai Chi rehabilitation robot is improved.

[0056] like Figure 2 As shown, the method comprises the following steps:

[0057] Step S202, obtaining the actual operation data of the gravity item of the arm to be trained and each joint in the current Tai Chi movement;

[0058] In practical applications, the actuator is usually in the form of an exoskeleton to fit the human arm, so as to assist the arm to be trained in rehabilitation training. The actuator includes multiple joints and is configured with multiple degrees of freedom of the joints, such as Figure 3 As shown, the following six degrees of freedom are included: shoulder joint swing / adduction degree of freedom 201, flexion / extension degree of freedom 202, internal rotation / external rotation degree of freedom 203, elbow joint flexion / extension degree of freedom 204, forearm pronation / supination degree of freedom 205, wrist joint dorsiflexion / palmar flexion degree of freedom 206. Rehabilitation training of the arm to be trained is achieved through the joint degrees of freedom of multiple joints.

[0059] In addition, detection devices, such as encoders, are installed at each joint degree of freedom to detect actual operating data of each joint, wherein the actual operating data includes actual angles and actual angular velocities, so as to control the joint according to the actual operating data of each joint and the target motion data of the joint in each Tai Chi movement until the joint completes the corresponding Tai Chi movement. Thus, through the mutual cooperation of various joints, the Tai Chi rehabilitation robot assists the arm to be trained to complete rehabilitation training including Tai Chi movements, enriches the rehabilitation training program of the Tai Chi rehabilitation robot, and improves the rehabilitation training effect of the Tai Chi rehabilitation robot.

[0060] In addition, for different users or patients, the gravity items of the arm to be trained are different due to the different weights and fixed positions of the arm to be trained. Therefore, during the rehabilitation training process, it is also necessary to obtain the gravity item of the arm to be trained of the Tai Chi rehabilitation robot user (patient or user), so as to determine the torque of each joint based on the gravity item of the arm to be trained and the actual operating data of each joint in the current Tai Chi movement, thereby ensuring the accuracy of the arm to be trained in completing the current Tai Chi movement and improving the rehabilitation training effect of the Tai Chi rehabilitation robot.

[0061] Step S204, for each joint, the torque of the joint is calculated according to the actual operation data of the joint, the target motion data of the joint corresponding to the current Tai Chi action, the gravity term of the arm to be trained and the preset calculation parameters;

[0062] Among them, the target motion data includes a target angle and a target angular velocity, and the preset calculation parameters include: the inertia matrix of the Tai Chi rehabilitation robot, the gravity term of the Tai Chi rehabilitation robot, the proportional control coefficient and the differential control coefficient corresponding to each joint; thereby, the torque of the joint can be calculated according to the actual operation data of each joint, the target motion data corresponding to the joint in the current Tai Chi action, the gravity term of the arm to be trained and the preset calculation parameters, and the joint is controlled to assist the arm to be trained to complete the current Tai Chi action according to the torque, thereby ensuring the accuracy of each joint in assisting the arm to be trained to complete the Tai Chi action, thereby improving the rehabilitation training effect of the arm to be trained and the Tai Chi rehabilitation robot.

[0063] Step S206, obtaining a target current instruction according to the torque calculation, and controlling the joint to operate according to the current instruction.

[0064] Specifically, for each joint, after calculating the torque of the joint, the control device also calculates the joint current instruction corresponding to the joint, that is, the target current instruction, based on the torque. When the joint is controlled to operate according to the current instruction, an auxiliary torque can be applied to the joint execution unit corresponding to the joint, so that the joint assists the arm to be trained to perform rehabilitation training movements according to the current Tai Chi movements, thereby introducing Tai Chi movements into the Tai Chi rehabilitation robot. Compared with the existing rehabilitation robots that perform rehabilitation training through simple movements such as grasping, the training plan of the Tai Chi rehabilitation robot is enriched and the rehabilitation training effect of the Tai Chi rehabilitation robot is improved.

[0065] In practical applications, the Tai Chi rehabilitation robot provided by the embodiment of the present invention may also be referred to as a sitting Tai Chi rehabilitation robot, and its workflow includes a data collection phase and a rehabilitation training phase; for ease of understanding, the two phases are described in detail below:

[0066] (1) Data collection stage; at this stage, the method further includes: controlling the Tai Chi rehabilitation robot to operate in an active mode so that Tai Chi professionals can wear the Tai Chi rehabilitation robot to complete multiple Tai Chi movements; and collecting the angle and angular velocity of each joint in each Tai Chi movement in real time, and using the angle and angular velocity as the target angle and target angular velocity of each joint in the Tai Chi movement.

[0067] Specifically, in the data collection stage, the control device controls the Tai Chi rehabilitation robot to operate in the active mode to collect the motion data of Tai Chi professionals. That is, at this time, the user is a Tai Chi professional, and after wearing the Tai Chi rehabilitation robot, the Tai Chi professional completes multiple Tai Chi movements in sequence according to the sequence of moves. The Tai Chi rehabilitation robot collects the motion data (i.e., angle and angular velocity) of each joint in all Tai Chi movements in real time, and stores it in the Tai Chi rehabilitation robot as the target operation data of each joint in the corresponding Tai Chi movement.

[0068] Among them, in the active mode, the Tai Chi rehabilitation robot includes a zero torque state and a damping state, and switches the state of the Tai Chi rehabilitation robot according to the motion data of each joint collected in real time. Specifically, when the motion data of each joint of the Tai Chi rehabilitation robot meets the corresponding safety range, such as the angle of each joint is in the corresponding angle range, and the angular velocity of each joint is in the corresponding angular velocity range, at this time, the Tai Chi rehabilitation robot is controlled to work in the zero torque state; conversely, when there is at least one motion data of each joint of the Tai Chi rehabilitation robot that does not meet the corresponding safety range, the Tai Chi rehabilitation robot is controlled to work in the damping state.

[0069] In addition, when the Tai Chi rehabilitation robot works in a zero-torque state, the actuator compensates for its own gravity, friction, inertia and the gravity of the arm to be trained; when the Tai Chi rehabilitation robot works in a damping state, the actuator, in addition to compensating for its own gravity, friction, inertia and the gravity of the arm to be trained, also needs to apply a force opposite to the direction of movement to the joints of the upper limbs of the arm to be trained, so as to make the angles of the joints of the upper limbs of the arm to be trained leave the extreme position or reduce the angular velocity of each joint to a safe range. Therefore, when determining the target operating data of each joint, it is also necessary to ensure that the joint can safely complete the corresponding Tai Chi movements in the process of assisting the arm to be trained in rehabilitation training according to the target operating data.

[0070] In active mode, for the torque of each joint, such as Figure 4 As shown, it can be calculated according to the following formula:

[0071] (1)

[0072] in, Indicates i The torque of the joint, , n represents the total number of joints, Representation vector No. i item; Tai Chi rehabilitation robot n The vector composed of the actual angle and angular acceleration of each joint; represents the inertia matrix of the Tai Chi rehabilitation robot, represents the gravity term of the Tai Chi rehabilitation robot, represents the gravity term of the arm to be trained (here refers to the arm of the Tai Chi professional), Indicates i It should be noted that the inertia matrix of the Tai Chi rehabilitation robot is and the gravity term Reference may be made to existing rehabilitation robot technologies, and the embodiments of the present invention will not be described in detail herein.

[0073] In addition, since the upper limb movement speed of stroke patients is slower, the Christoffel term with a smaller value is ignored in formula (1); Depends on the i The damping force of the joint angle, where the negative sign indicates the opposite direction of the movement, Indicates the preset i The position damping coefficient of each joint, Indicates i The maximum joint angle allowed for each joint along the current direction of motion, Indicates i The actual angle of each joint, Depends on the i The damping force of the joint angular velocity, where the negative sign indicates the opposite direction of the movement; Indicates i The velocity damping coefficient of each joint, Indicates i The maximum joint angular velocity allowed for each joint along the current direction of motion, Indicates i The actual angular velocity of each joint, max() represents the maximum value function.

[0074] And, for the angular acceleration vector of the Tai Chi rehabilitation robot , the angular acceleration corresponding to each joint can be calculated based on the actual angular velocity differential of each joint in the active mode, and n The angular acceleration vector is obtained by combining the angular accelerations of the joints. In particular, in order to reduce differential noise, filtering processing is usually required. For details, reference may be made to the prior art, and the embodiments of the present invention will not be described in detail here.

[0075] According to the above formula (1), during the data collection phase, when the joint angle is far away from the maximum allowed joint angle, the denominator Larger, at this time, Small values ​​can be ignored and will not hinder joint movement; when the joint angle is close to the maximum allowed joint angle, the denominator Smaller, at this time, A larger value will hinder joint movement, and the closer the joint angle is to the maximum allowed joint angle, The larger the value, the stronger the damping effect. In actual use, you can adjust the position damping coefficient such as , in order to obtain the best position damping effect.

[0076] Similarly, when the joint angular velocity is less than the maximum allowed joint angular velocity, , will not hinder joint movement; when the joint angular velocity is greater than the maximum allowed joint angular velocity, at this time, , will hinder joint movement, and the greater the joint angular velocity, The larger the value, the stronger the damping effect. In actual use, you can adjust the speed damping coefficient such as , in order to obtain the best speed damping effect.

[0077] Therefore, after the Tai Chi rehabilitation robot collects the motion data (i.e., angle and angular velocity) of each joint in all Tai Chi movements in real time, it uses the motion data of each joint as the target operation data of the joint in the corresponding Tai Chi movement while ensuring the optimal position damping effect and speed damping effect, and stores them in the Tai Chi rehabilitation robot for subsequent assistance to the patient's (or user's) arm to be trained to complete the rehabilitation training of Tai Chi movements according to the target operation data, thereby improving the rehabilitation training effect of the Tai Chi rehabilitation robot.

[0078] (2) Rehabilitation training stage: In this stage, the user is a patient or user, who controls the Tai Chi rehabilitation robot to work in passive mode, so that the Tai Chi rehabilitation robot drives the patient's arm to be trained to complete Tai Chi movements. At the same time, the display device displays the current corresponding Tai Chi move animation in real time.

[0079] Specifically, after the patient wears the Tai Chi rehabilitation robot, the control execution device drives the patient to complete Tai Chi movements according to the target motion data of each joint collected during the data collection phase. Figure 5 As shown, the calculation formula of the torque of each joint is as follows:

[0080] (2)

[0081] in, represents the torque of the ith joint, , n represents the total number of joints, Representation vector No. i item, They represent the Tai Chi rehabilitation robot n The vector composed of the actual angle and angular acceleration of each joint, represents the inertia matrix of the Tai Chi rehabilitation robot, represents the gravity term of the Tai Chi rehabilitation robot, represents the gravity term of the arm to be trained (here the patient or user's arm), Indicates i The friction term of each joint. Since the upper limb movement speed of stroke patients is slower, the Christoffel term with a smaller value is ignored in the formula here. Indicates i The target angle of the joint is the first angle saved in the data collection phase. i The angle of each joint in the current Tai Chi movement, Indicates i The target angular velocity of the joint is the first i The angular velocity of each joint in the current Tai Chi movement, Indicates i The actual angle of each joint, Indicates i The actual angular velocity of each joint, Indicates i The proportional control coefficient corresponding to each joint is Indicates i The differential control coefficient corresponding to each joint.

[0082] Optionally, before the step of calculating the torque of the joint according to formula (2), the method further comprises: calculating the gravity term of the arm to be trained according to the weight and fixed position of the upper arm and the forearm corresponding to the arm to be trained.

[0083] Specifically, Figure 6 As shown, set the upper arm gravity of the arm to be trained to The center of gravity of the upper arm is represented by point A, and the position of the center of gravity can be calculated in proportion to the height of the patient or user. The upper arm is fixed to the upper arm connecting rod U by Velcro, and the center of the upper arm fixed position is represented by point B. The position of the upper arm fixed point B depends on the structural design of the Tai Chi rehabilitation robot. Represents the vector from point A to point B. Similarly, set the forearm gravity of the arm to be trained to The center of gravity of the forearm is represented by point C. The forearm is fixed to the lower arm link L by Velcro. The center of the fixed position of the forearm is represented by point D. Represents the vector pointing from point C to point D. The boom link U and the arm link L can rotate around the connection point E.

[0084] At this point, the calculation formula for the gravity term of the arm to be trained is as follows:

[0085] (3)

[0086] in, Represents the Jacobian matrix of the fixed point of the big arm (i.e. point B), express Transpose; Represents the rotation matrix from the inertial coordinate system to the coordinate system of the boom link U; , It represents the upper arm mass of the arm to be trained, which can be calculated in proportion to the height and weight of the patient or user. g=﹣9.81 represents the acceleration due to gravity; Represents the vector from the center of mass of the upper arm of the arm to be trained to the fixed point of the upper arm, that is, the vector from point A to point B; Represents the Jacobian matrix of the forearm fixed point (i.e. point D), express Transpose; Represents the rotation matrix from the inertial coordinate system to the coordinate system of the arm link L; , Indicates the forearm mass of the arm to be trained, which can be calculated in proportion to the height and weight of the patient or user. represents the vector from the center of mass of the forearm to be trained to the fixed point of the forearm, that is, the vector from point C to point D. It should be noted that the above rotation matrix and Reference may be made to existing rehabilitation robot technology, and the embodiments of the present invention will not be described in detail here.

[0087] Therefore, in rehabilitation training, for different users or patients, the corresponding gravity item of the arm to be trained is determined according to their height and weight, and the torque of each joint is determined according to the precise gravity item of the arm to be trained and the actual operation data of each joint in the current Tai Chi movement, thereby ensuring the accuracy of the arm to be trained in completing the current Tai Chi movement and improving the rehabilitation training effect of the Tai Chi rehabilitation robot.

[0088] Optionally, before the step of calculating the moment of the joint according to formula (2), the method further comprises: i The actual angular velocity of each joint and the preset friction parameters are calculated to obtain the i The friction item of each joint; wherein the preset friction parameters include: i The Coulomb friction coefficient, viscous friction coefficient, Stribeck friction coefficient and Stribeck friction constant corresponding to each joint.

[0089] Among them, i The calculation formula for the friction term of each joint is as follows:

[0090] (4)

[0091] in, Indicates i The friction term of each joint, Indicates i The Coulomb friction coefficient corresponding to each joint is: Indicates i The viscous friction coefficient corresponding to each joint is Indicates i The Stribeck friction coefficient corresponding to each joint is: Indicates i The actual angular velocity of each joint, represents a constant, Indicates i is the Stribeck friction constant corresponding to the joint, and tanh represents the hyperbolic tangent function.

[0092] And, after the control device calculates the torque of each joint, it calculates the current required for each joint to generate the torque, that is, the target current instruction, according to the torque. For example, for the first i The calculation formula for the corresponding target current command is as follows:

[0093] (5)

[0094] in, Indicates i The torque of the joint, Indicates i The target current command for each joint, Indicates i The motor torque constant corresponding to each joint is given by the motor manufacturer and represents the proportional relationship between the motor current and the output torque. , n Represents the total number of joints.

[0095] Therefore, after the control device calculates the target current instruction corresponding to each joint, it applies the target current instruction to the joint execution unit (i.e., the motor) of the joint, so that the joint assists the arm to be trained to complete the Tai Chi movement according to the corresponding torque, thereby introducing Tai Chi movements into the Tai Chi rehabilitation robot, enriching the training plan of the Tai Chi rehabilitation robot, and improving the rehabilitation training effect of the Tai Chi rehabilitation robot.

[0096] Preferably, the Tai Chi movements in the embodiment of the present invention include at least one of the following: starting posture, wild horse parting its mane, single whip, cloud hands, single whip, reverse arm roll, left embracing the tail of a peacock, right embracing the tail of a peacock, cross hands and closing posture. Multiple Tai Chi movements can be used for rehabilitation training individually or in combination in sequence, such as rehabilitation training for ten Tai Chi movements in the order of moves, so as to further enrich the training plan of the Tai Chi rehabilitation robot and improve the rehabilitation training effect of the Tai Chi rehabilitation robot.

[0097] In addition, during rehabilitation training, the display device also displays the current Tai Chi moves animation in real time, such as Figure 7 As shown, it includes: current move name 301, current move progress 302 and various joint angle data 303, etc., so that patients or users can perform rehabilitation training according to the displayed Tai Chi move animation. At the same time, it is also convenient for patients to grasp the training progress in time, thereby improving the rehabilitation training experience.

[0098] In addition, when a certain Tai Chi movement training is completed, the Tai Chi rehabilitation robot also generates an evaluation result, such as an evaluation score (i.e., score), based on the completion status of the arm to be trained. At this time, the display device can also display the evaluation score, so as to analyze the patient's current training results according to the completion score of each Tai Chi movement, and thus adjust the patient's subsequent training tasks in time according to the analysis results, thereby further improving the rehabilitation training effect of the Tai Chi rehabilitation robot.

[0099] In some cases, the Tai Chi rehabilitation robot can also score the current Tai Chi movements of the arm to be trained. For example, it can generate a score based on the actual operating data of each joint detected in real time and the corresponding target operating data. The score is used to indicate the degree of completion of the current Tai Chi movement by the arm to be trained. The lower the score, the less completed the current Tai Chi movement is. This allows users to adjust the Tai Chi movements in time according to the score, further improving the rehabilitation training effect of the Tai Chi rehabilitation robot.

[0100] In summary, the control method of a Tai Chi rehabilitation robot provided by the embodiment of the present invention introduces sitting Tai Chi movements into the Tai Chi rehabilitation robot. Compared with the existing rehabilitation robots that perform rehabilitation training through simple movements such as grasping, the training program of the Tai Chi rehabilitation robot is enriched, thereby improving the rehabilitation training effect of the Tai Chi rehabilitation robot. In addition, in the data collection stage, by collecting the motion data of Tai Chi professionals and using it as a reference trajectory in the rehabilitation training stage, it is possible to ensure that the sitting Tai Chi rehabilitation training movements are within the safety range of the Tai Chi rehabilitation robot, meet the physical constraints of the Tai Chi rehabilitation robot, avoid the position and speed of each joint of the Tai Chi rehabilitation robot exceeding the safety range during the rehabilitation training process, resulting in some Tai Chi movements being unable to fully achieve the reduced rehabilitation training effect, and further improve the rehabilitation training effect of the Tai Chi rehabilitation robot.

[0101] Embodiment 2

[0102] Corresponding to the above method embodiment, the embodiment of the present invention also provides a Tai Chi rehabilitation robot control device, the Tai Chi rehabilitation robot stores motion data sets corresponding to multiple Tai Chi movements, each motion data set includes target motion data of each joint of the Tai Chi rehabilitation robot in the Tai Chi movement.

[0103] like Figure 8 As shown, the device includes: an acquisition module 81, a calculation module 82 and an operation module 83; wherein the functions of each module are as follows:

[0104] The acquisition module 81 is used to acquire the gravity item of the arm to be trained and the actual operation data of each joint in the current Tai Chi action; wherein the actual operation data includes the actual angle and the actual angular velocity;

[0105] The calculation module 82 is used to calculate the torque of each joint according to the actual operation data of the joint, the target motion data corresponding to the joint in the current Tai Chi action, the gravity term of the arm to be trained and the preset calculation parameters; wherein the target motion data includes the target angle and the target angular velocity, and the preset calculation parameters include: the inertia matrix of the Tai Chi rehabilitation robot, the gravity term of the Tai Chi rehabilitation robot, the proportional control coefficient and the differential control coefficient corresponding to each joint;

[0106] The operation module 83 is used to obtain a target current instruction according to the torque calculation, and control the joint to operate according to the target current instruction.

[0107] The Tai Chi rehabilitation robot control device provided by the embodiment of the present invention stores a plurality of motion data sets corresponding to Tai Chi movements in the Tai Chi rehabilitation robot. During the rehabilitation training process, the gravity item of the arm to be trained and the actual operation data of each joint in the current Tai Chi movement are obtained; wherein the actual operation data include the actual angle and the actual angular velocity; for each joint, the torque of the joint is calculated according to the actual operation data of the joint, the target motion data corresponding to the joint in the current Tai Chi movement, the gravity item of the arm to be trained and the preset calculation parameters; the target current instruction is calculated according to the torque, and the joint is controlled to operate according to the current instruction to assist the arm to be trained to complete the current Tai Chi movement, thereby realizing the introduction of Tai Chi movements into the Tai Chi rehabilitation robot. Compared with the existing rehabilitation robots that perform rehabilitation training through simple movements such as grasping, the training scheme of the Tai Chi rehabilitation robot is enriched and the rehabilitation training effect of the Tai Chi rehabilitation robot is improved.

[0108] Preferably, the calculation module 82 further includes: the calculation formula of the torque is as follows:

[0109]

[0110] in, Indicates i The torque of the joint, , n represents the total number of joints, Representation vector No. i item, They represent the Tai Chi rehabilitation robot n The vector composed of the actual angle and angular acceleration of each joint, represents the inertia matrix of the Tai Chi rehabilitation robot, represents the gravity term of the Tai Chi rehabilitation robot, represents the gravity term of the arm to be trained, Indicates i The friction term of each joint, Indicatesi The target angle of each joint, Indicates i The target angular velocity of each joint, Indicates i The actual angle of each joint, Indicates i The actual angular velocity of each joint, Indicates i The proportional control coefficient corresponding to each joint is Indicates i The differential control coefficient corresponding to each joint.

[0111] Preferably, the device further comprises: in the data collection stage, controlling the Tai Chi rehabilitation robot to operate in an active mode so that the Tai Chi professional wears the Tai Chi rehabilitation robot to complete a plurality of Tai Chi movements; and collecting the angle and angular velocity of each joint in each Tai Chi movement in real time, and using the angle and angular velocity as the target angle and target angular velocity of each joint in the Tai Chi movement;

[0112] Among them, the calculation formula of each joint torque of the Tai Chi rehabilitation robot in the active mode is as follows:

[0113]

[0114] in, Indicates i The torque of the joint, , n represents the total number of joints, Representation vector No. i item; Tai Chi rehabilitation robot n The vector composed of the actual angle and angular acceleration of each joint; represents the inertia matrix of the Tai Chi rehabilitation robot, represents the gravity term of the Tai Chi rehabilitation robot; represents the gravity term of the arm to be trained; Indicates i The friction term of each joint; Indicates i The actual angle of each joint, Indicates i The actual angular velocity of each joint; represents the damping force depending on the joint angle, where the negative sign indicates the opposite direction of the motion. Indicates the preset i The position damping coefficient of each joint, Indicates i The maximum joint angle allowed for each joint along the current direction of movement; represents the damping force that depends on the joint angular velocity, where the negative sign indicates the opposite direction of motion. Indicates the preset i The velocity damping coefficient of each joint, Indicates i The maximum joint angular velocity allowed for each joint along the current direction of motion, max() represents the maximum value function.

[0115] Preferably, before the calculation module 82, the device further comprises: calculating the gravity item of the arm to be trained according to the weight and fixed position of the upper arm and the lower arm corresponding to the arm to be trained;

[0116] Among them, the calculation formula of the gravity term of the arm to be trained is as follows:

[0117]

[0118] in, The Jacobian matrix representing the fixed point of the boom, express Transpose; Represents the rotation matrix from the inertial coordinate system to the boom link coordinate system; , represents the mass of the upper arm to be trained, g=﹣9.81 represents the acceleration due to gravity; Represents the vector from the center of mass of the upper arm of the arm to be trained to the fixed point of the upper arm; The Jacobian matrix representing the fixed point of the forearm, express Transpose; Represents the rotation matrix from the inertial coordinate system to the forearm link coordinate system; , represents the forearm mass of the arm to be trained, Represents the vector from the center of mass of the forearm to be trained to the fixed point of the forearm.

[0119] Preferably, before the calculation module 82, the device further comprises: i The actual angular velocity of each joint and the preset friction parameters are calculated to obtain the i The friction item of each joint; wherein the preset friction parameters include: i Coulomb friction coefficient, viscous friction coefficient, Stribeck friction coefficient and Stribeck friction constant corresponding to each joint;

[0120] Among them, i The calculation formula for the friction term of each joint is as follows:

[0121]

[0122] in, Indicates i The friction term of each joint, Indicates i The Coulomb friction coefficient corresponding to each joint is: Indicates i The viscous friction coefficient corresponding to each joint is Indicates i The Stribeck friction coefficient corresponding to each joint is: Indicates i The actual angular velocity of each joint, represents a constant, Indicates i The Stribeck friction constant corresponding to each joint.

[0123] Preferably, the Tai Chi movements include at least one of the following: starting posture, wild horse splitting its mane, single whip, cloud hands, single whip, reverse roll of the arm, left embracing the tail of a sparrow, right embracing the tail of a sparrow, cross hands and closing posture.

[0124] The Tai Chi rehabilitation robot control device provided in the embodiment of the present invention has the same technical features as the Tai Chi rehabilitation robot control method provided in the above embodiment, so it can also solve the same technical problems and achieve the same technical effects.

[0125] An embodiment of the present invention also provides a Tai Chi rehabilitation robot, including a processor and a memory, wherein the memory stores machine executable instructions that can be executed by the processor, and the processor executes the machine executable instructions to implement the above-mentioned Tai Chi rehabilitation robot control method.

[0126] See also Fig. 9 As shown, the Tai Chi rehabilitation robot includes a processor 100 and a memory 101. The memory 101 stores machine executable instructions that can be executed by the processor 100. The processor 100 executes the machine executable instructions to implement the above-mentioned Tai Chi rehabilitation robot control method.

[0127] Further, Fig. 9 The Tai Chi rehabilitation robot shown also includes a bus 102 and a communication interface 103 , and the processor 100 , the communication interface 103 and the memory 101 are connected via the bus 102 .

[0128] Among them, the memory 101 may include a high-speed random access memory (RAM), and may also include a non-volatile memory (non-volatile memory), such as at least one disk storage. The communication connection between the system network element and at least one other network element is realized through at least one communication interface 103 (which can be wired or wireless), and the Internet, wide area network, local area network, metropolitan area network, etc. can be used. The bus 102 can be an ISA (Industrial Standard Architecture) bus, a PCI (Peripheral Component Interconnect) bus or an EISA (Enhanced Industry Standard Architecture) bus, etc. The above-mentioned bus can be divided into an address bus, a data bus, a control bus, etc. For ease of representation, Fig. 9 Only one bidirectional arrow is used in the diagram, but this does not mean that there is only one bus or only one type of bus.

[0129] The processor 100 may be an integrated circuit chip with signal processing capabilities. In the implementation process, each step of the above method can be completed by the hardware integrated logic circuit or software instructions in the processor 100. The above processor 100 can be a general-purpose processor, including a central processing unit (CPU), a network processor (NP), etc.; it can also be a digital signal processor (DSP), an application-specific integrated circuit (ASIC), a field-programmable gate array (FPGA) or other programmable logic devices, discrete gates or transistor logic devices, discrete hardware components. The methods, steps and logic block diagrams disclosed in the embodiments of the present invention can be implemented or executed. The general-purpose processor can be a microprocessor or the processor can also be any conventional processor, etc. The steps of the method disclosed in conjunction with the embodiments of the present invention can be directly embodied as a hardware decoding processor for execution, or a combination of hardware and software modules in the decoding processor for execution. The software module may be located in a storage medium mature in the art, such as a random access memory, a flash memory, a read-only memory, a programmable read-only memory, or an electrically erasable programmable memory, a register, etc. The storage medium is located in the memory 101, and the processor 100 reads the information in the memory 101 and completes the steps of the method of the above embodiment in combination with its hardware.

[0130] This embodiment also provides a machine-readable storage medium, which stores machine-executable instructions. When the machine-executable instructions are called and executed by a processor, the machine-executable instructions prompt the processor to implement the above-mentioned Tai Chi rehabilitation robot control method.

[0131] The embodiments of the present invention provide a Tai Chi rehabilitation robot control method, device and computer program product of the Tai Chi rehabilitation robot, including a computer-readable storage medium storing program code. The instructions included in the program code can be used to execute the methods described in the previous method embodiments. The specific implementation can be found in the method embodiments, which will not be repeated here.

[0132] Those skilled in the art can clearly understand that, for the convenience and brevity of description, the specific working process of the system and device described above can refer to the corresponding process in the aforementioned method embodiment, and will not be repeated here.

[0133] In addition, in the description of the embodiments of the present invention, unless otherwise clearly specified and limited, the terms "installed", "connected", and "connected" should be understood in a broad sense, for example, it can be a fixed connection, a detachable connection, or an integral connection; it can be a mechanical connection or an electrical connection; it can be a direct connection or an indirect connection through an intermediate medium, or it can be the internal communication of two components. For ordinary technicians in this field, the specific meanings of the above terms in the present invention can be understood according to specific circumstances.

[0134] If the functions are implemented in the form of software functional units and sold or used as independent products, they can be stored in a non-volatile computer-readable storage medium that can be executed by a processor. Based on this understanding, the technical solution of the present invention, or the part that contributes to the prior art, or the part of the technical solution, can be embodied in the form of a software product. The computer software product is stored in a storage medium, including several instructions for enabling a computer device (which can be a personal computer, server, or network device, etc.) to perform all or part of the steps of the method described in each embodiment of the present invention. The aforementioned storage medium includes: U disk, mobile hard disk, read-only memory (ROM, Read-Only Memory), random access memory (RAM, Random Access Memory), disk or optical disk, etc., various media that can store program codes.

[0135] In the description of the present invention, it should be noted that the terms "center", "upper", "lower", "left", "right", "vertical", "horizontal", "inner", "outer", etc., indicating the orientation or positional relationship, are based on the orientation or positional relationship shown in the drawings, and are only for the convenience of describing the present invention and simplifying the description, rather than indicating or implying that the device or element referred to must have a specific orientation, be constructed and operated in a specific orientation, and therefore cannot be understood as limiting the present invention. In addition, the terms "first", "second", and "third" are used for descriptive purposes only, and cannot be understood as indicating or implying relative importance.

[0136] Finally, it should be noted that the above-described embodiments are only specific implementations of the present invention, which are used to illustrate the technical solutions of the present invention, rather than to limit them. The protection scope of the present invention is not limited thereto. Although the present invention is described in detail with reference to the above-described embodiments, ordinary technicians in the field should understand that any technician familiar with the technical field can still modify the technical solutions recorded in the above-described embodiments within the technical scope disclosed by the present invention, or can easily think of changes, or make equivalent replacements for some of the technical features therein; and these modifications, changes or replacements do not make the essence of the corresponding technical solutions deviate from the spirit and scope of the technical solutions of the embodiments of the present invention, and should be included in the protection scope of the present invention. Therefore, the protection scope of the present invention shall be subject to the protection scope of the claims.

Claims

1. A control method for a Tai Chi rehabilitation robot, wherein the Tai Chi rehabilitation robot stores a plurality of motion data sets corresponding to Tai Chi movements, each of which includes target motion data of each joint of the Tai Chi rehabilitation robot in the Tai Chi movement; characterized in that: The method comprises: Obtaining the gravity item of the arm to be trained and the actual operation data of each joint in the current Tai Chi action; wherein the actual operation data includes the actual angle and the actual angular velocity; For each of the joints, the torque of the joint is calculated according to the actual operation data of the joint, the target motion data corresponding to the joint in the current Tai Chi action, the gravity term of the arm to be trained, and preset calculation parameters; wherein the target motion data includes a target angle and a target angular velocity, and the preset calculation parameters include: the inertia matrix of the Tai Chi rehabilitation robot, the gravity term of the Tai Chi rehabilitation robot, and the proportional control coefficient and the differential control coefficient corresponding to each of the joints; Calculating a target current command according to the torque, and controlling the joint to operate according to the target current command; The calculation formula of the torque is as follows: in, Indicates i The torque of the joint, , n represents the total number of joints, Representation vector No. i item, Respectively represent the Tai Chi rehabilitation robot n The vector composed of the actual angle and angular acceleration of each joint, represents the inertia matrix of the Tai Chi rehabilitation robot, represents the gravity term of the Tai Chi rehabilitation robot, represents the gravity term of the arm to be trained, Indicates i The friction term of each joint, Indicates i The target angle of each joint, Indicates i The target angular velocity of each joint, Indicates i The actual angle of each joint, Indicates i The actual angular velocity of each joint, Indicates i The proportional control coefficient corresponding to each joint is Indicates i The differential control coefficient corresponding to each joint; And, according to the weight and fixed position of the upper arm and the lower arm corresponding to the arm to be trained, the gravity item of the arm to be trained is calculated; wherein the calculation formula of the gravity item of the arm to be trained is as follows: in, The Jacobian matrix representing the fixed point of the boom, express Transpose; Represents the rotation matrix from the inertial coordinate system to the boom link coordinate system; , represents the upper arm mass of the arm to be trained, and g=-9.81 represents the acceleration due to gravity; A vector representing the center of mass of the upper arm of the arm to be trained pointing to the fixed point of the upper arm; The Jacobian matrix representing the fixed point of the forearm, express Transpose; Represents the rotation matrix from the inertial coordinate system to the forearm link coordinate system; , represents the forearm mass of the arm to be trained, Represents the vector from the forearm mass center of the arm to be trained to the forearm fixed point.

2. The method according to claim 1, characterized in that: The method further comprises: In the data collection stage, the Tai Chi rehabilitation robot is controlled to operate in an active mode so that Tai Chi professionals wearing the Tai Chi rehabilitation robot can complete a plurality of Tai Chi movements; and the angle and angular velocity of each joint in each Tai Chi movement are collected in real time, and the angle and angular velocity are used as the target angle and target angular velocity of each joint in the Tai Chi movement; The calculation formula of each joint torque of the Tai Chi rehabilitation robot in the active mode is as follows: in, Indicates i The torque of the joint, , n represents the total number of joints, Representation vector No. i item; Tai Chi rehabilitation robot n The vector composed of the actual angle and angular acceleration of each joint; represents the inertia matrix of the Tai Chi rehabilitation robot, represents the gravity term of the Tai Chi rehabilitation robot; represents the gravity term of the arm to be trained; Indicates i The friction term of each joint; Indicates i The actual angle of each joint, Indicates i The actual angular velocity of each joint; represents the damping force depending on the joint angle, where the negative sign indicates the opposite direction of the motion. Indicates the preset i The position damping coefficient of each joint, Indicates i The maximum joint angle allowed for each joint along the current direction of movement; represents the damping force that depends on the joint angular velocity, where the negative sign indicates the opposite direction of motion. Indicates the preset i The velocity damping coefficient of each joint, Indicates i The maximum joint angular velocity allowed for each joint along the current direction of motion, max() represents the maximum value function.

3. The method according to claim 1, characterized in that Before the step of calculating the torque of the joint according to the actual operation data of the joint, the target motion data of the joint corresponding to the current Tai Chi action, the gravity item of the arm to be trained and the preset calculation parameters, the method further includes: According to the said i The actual angular velocity of the joint and the preset friction parameter are calculated to obtain the i The friction force item of each joint; wherein the preset friction parameters include: i Coulomb friction coefficient, viscous friction coefficient, Stribeck friction coefficient and Stribeck friction constant corresponding to each joint; Among them, the i The calculation formula for the friction term of each joint is as follows: in, Indicates i The friction term of each joint, Indicates i The Coulomb friction coefficient corresponding to each joint is: Indicates i The viscous friction coefficient corresponding to each joint is Indicates i The Stribeck friction coefficient corresponding to each joint is: Indicates i The actual angular velocity of each joint, represents a constant, Indicates i The Stribeck friction constant corresponding to each joint.

4. The method according to claim 1 or 2, characterized in that: The Tai Chi movements include at least one of the following: starting posture, wild horse splitting its mane, single whip, cloud hands, single whip, reverse arm roll, left embracing the sparrow's tail, right embracing the sparrow's tail, cross hands and closing posture.

5. A control device for a Tai Chi rehabilitation robot, wherein the Tai Chi rehabilitation robot stores a plurality of motion data sets corresponding to Tai Chi movements, each of which includes target motion data of each joint of the Tai Chi rehabilitation robot in the Tai Chi movement; characterized in that: The device comprises: An acquisition module, used to acquire the gravity item of the arm to be trained and the actual operation data of each joint in the current Tai Chi action; wherein the actual operation data includes the actual angle and the actual angular velocity; A calculation module, for calculating the torque of each joint according to the actual operation data of the joint, the target motion data corresponding to the joint in the current Tai Chi action, the gravity term of the arm to be trained and preset calculation parameters; wherein the target motion data includes a target angle and a target angular velocity, and the preset calculation parameters include: the inertia matrix of the Tai Chi rehabilitation robot, the gravity term of the Tai Chi rehabilitation robot, and the proportional control coefficient and the differential control coefficient corresponding to each joint; An operation module, used to obtain a target current instruction according to the torque calculation, and control the joint to operate according to the target current instruction; The calculation formula of the torque is as follows: in, Indicates i The torque of the joint, , n represents the total number of joints, Representation vector No. i item, Respectively represent the Tai Chi rehabilitation robot n The vector composed of the actual angle and angular acceleration of each joint, represents the inertia matrix of the Tai Chi rehabilitation robot, represents the gravity term of the Tai Chi rehabilitation robot, represents the gravity term of the arm to be trained, Indicates i The friction term of each joint, Indicates i The target angle of each joint, Indicates i The target angular velocity of each joint, Indicates i The actual angle of each joint, Indicates i The actual angular velocity of each joint, Indicates i The proportional control coefficient corresponding to each joint is Indicates i The differential control coefficient corresponding to each joint; And, according to the weight and fixed position of the upper arm and the lower arm corresponding to the arm to be trained, the gravity item of the arm to be trained is calculated; wherein the calculation formula of the gravity item of the arm to be trained is as follows: in, The Jacobian matrix representing the fixed point of the boom, express Transpose; Represents the rotation matrix from the inertial coordinate system to the boom link coordinate system; , represents the upper arm mass of the arm to be trained, and g=-9.81 represents the acceleration due to gravity; A vector representing the center of mass of the upper arm of the arm to be trained pointing to the fixed point of the upper arm; The Jacobian matrix representing the fixed point of the forearm, express Transpose; Represents the rotation matrix from the inertial coordinate system to the forearm link coordinate system; , represents the forearm mass of the arm to be trained, Represents the vector from the forearm mass center of the arm to be trained to the forearm fixed point.

6. A Tai Chi rehabilitation robot, comprising a memory, a processor, and a computer program stored in the memory and executable on the processor, characterized in that: When the processor executes the computer program, the steps of the method according to any one of claims 1 to 4 are implemented.

7. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a computer program, and when the computer program is executed by a processor, the steps of the method described in any one of claims 1 to 4 are executed.