CN113189865A - Rehabilitation robot control method, system, equipment and medium based on kinetic parameter identification - Google Patents

Rehabilitation robot control method, system, equipment and medium based on kinetic parameter identification Download PDF

Info

Publication number
CN113189865A
CN113189865A CN202110107304.8A CN202110107304A CN113189865A CN 113189865 A CN113189865 A CN 113189865A CN 202110107304 A CN202110107304 A CN 202110107304A CN 113189865 A CN113189865 A CN 113189865A
Authority
CN
China
Prior art keywords
rehabilitation robot
moment
vector
parameter identification
sum
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202110107304.8A
Other languages
Chinese (zh)
Other versions
CN113189865B (en
Inventor
夏林清
李福生
范渊杰
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shanghai Electric Intelligent Rehabilitation Medical Technology Co ltd
Original Assignee
Shanghai Electric Intelligent Rehabilitation Medical Technology Co ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Shanghai Electric Intelligent Rehabilitation Medical Technology Co ltd filed Critical Shanghai Electric Intelligent Rehabilitation Medical Technology Co ltd
Priority to CN202110107304.8A priority Critical patent/CN113189865B/en
Publication of CN113189865A publication Critical patent/CN113189865A/en
Application granted granted Critical
Publication of CN113189865B publication Critical patent/CN113189865B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance

Abstract

The invention provides a rehabilitation robot control method, a system, equipment and a medium based on kinetic parameter identification, wherein the rehabilitation robot comprises a rehabilitation robot body and a rehabilitation robot accessory, a training side limb and the rehabilitation robot accessory are fixed together to form a synchronous motion system, and the method comprises the following steps: when a kinetic parameter identification instruction is received, identifying kinetic parameters of the synchronous motion system to obtain a kinetic parameter identification result; acquiring the movement intention of the patient according to the measured interaction torque between the synchronous movement system and the rehabilitation robot body and the kinetic parameter identification result; acquiring driving torque required to be output by the rehabilitation robot body according to the movement intention of the patient; and generating a corresponding control command according to the driving moment, and sending the control command to the rehabilitation robot body. The invention improves the flexibility of the cooperative interaction force control of the rehabilitation robot and the training side limb of the patient.

Description

Rehabilitation robot control method, system, equipment and medium based on kinetic parameter identification
Technical Field
The invention relates to the field of robot control, in particular to a rehabilitation robot control method, a rehabilitation robot control system, rehabilitation robot control equipment and a rehabilitation robot control medium based on kinetic parameter identification.
Background
With the increasing aging degree of population, the incidence of diseases of the aging population is increasing, taking the most serious stroke as an example, according to the data of the national statistical bureau, the number of deaths caused by stroke in China is up to 140.3/10 ten thousand in 2019, even if the patients are timely cured, about 75 percent of the patients still leave a plurality of sequelae with different degrees after the stroke occurs, and the sequelae can greatly reduce the self-care ability of the patients and seriously affect the life quality of the patients and the family members. In such a plurality of sequelae, the probability of hemiplegia of a patient is highest, and clinical application shows that scientific exercise rehabilitation training is matched with operation treatment and drug treatment, so that the probability of the function recovery of the limbs of a patient with hemiplegia due to stroke can be obviously improved, the damaged nervous system of the patient in the stroke disease process can be repaired by timely repeated rehabilitation exercise training, the motor systems such as musculoskeletal system and the like are strengthened, and the rehabilitation of the exercise machine for training the lateral limbs of the patient is facilitated.
With the development of chip technology, cooperative robots have also gained a great deal of development in miniaturization and intellectualization, and rehabilitation robots are gradually replacing traditional rehabilitation training which is dominated by rehabilitation therapists due to the characteristics of flexible and complete rehabilitation modes, high interactivity and interestingness and the like. The existing rehabilitation robots in the market are mainly used for rehabilitating a single affected limb, but the upper limb and the lower limb of the body of most stroke patients need to be rehabilitated and trained simultaneously. In order to realize rehabilitation training of different diseased parts, training systems such as isokinetic muscle strength rehabilitation robots and the like are available. The constant-speed muscle strength training system can realize multi-joint multi-modal rehabilitation training, and can perform constant-speed, equal-length, equal-tension, centrifugal, centripetal, continuous passive, proprioceptive, elastic resistance and other related items of rehabilitation training for six joints such as shoulders, elbows, wrists, hips, knees and ankles. Aiming at multi-joint and multi-mode training modes of different patients, the difficulty that the kinetic parameters of the output end of the rehabilitation robot are changed all the time is inevitably brought, and the control precision of the robot is reduced or even unstable under the force-assisting and other torque modes.
At present, some researches aiming at the control of the isokinetic muscle strength rehabilitation robot are carried out at home and abroad. For example, in the patent application with the application number of 201010301048.8 and the invention name of "isokinetic muscle force testing system and core control algorithm thereof", the interaction force between a patient and the output end of a rehabilitation robot is acquired through a torque sensor, the angle of the output end of the rehabilitation robot is acquired through an angular displacement sensor, and then the robot is controlled to move at the same speed according to the interaction force and the angle; the patent application with the application number of 201810660563.1 and the title of 'a constant velocity muscle strength training system and a control method thereof' obtains interaction force through a resistance strain gauge positioned on an output rotating shaft of a motor so as to complete the compensation of the muscle strength of a patient and the moment in the motion process of the muscle strength. Although the control precision of the rehabilitation robot can be improved to a certain extent by the method for controlling according to the detected interaction force, when a patient is replaced or the training side limb of the patient is replaced, the kinetic parameters are changed, if only the interaction force is relied on and the system kinetic parameters are not considered, the ideal following of the rehabilitation robot on the motion of the training side limb of the patient is difficult to realize, and the stability of the motion control of the rehabilitation robot cannot be ensured.
Disclosure of Invention
In view of the above-mentioned deficiencies of the prior art, an object of the present invention is to provide a method, a system, a device and a medium for controlling a rehabilitation robot based on parameter identification, so as to improve the compliance of the rehabilitation robot and the control of the cooperative interaction force of the lateral limb of the patient training by introducing the kinetic parameter identification, and increase the comfort of the patient during the rehabilitation training process, thereby improving the satisfaction of the patient on the rehabilitation training and improving the rehabilitation effect.
In order to achieve the above object, the present invention provides a rehabilitation robot control method based on kinetic parameter identification, the rehabilitation robot including a rehabilitation robot body and a rehabilitation robot accessory for driving a training side limb of a patient to rotate around an output shaft of the rehabilitation robot body, the training side limb and the rehabilitation robot accessory being fixed together to form a synchronous motion system, the control method including:
when a kinetic parameter identification instruction is received, identifying kinetic parameters of the synchronous motion system to obtain a kinetic parameter identification result;
acquiring the movement intention of the patient according to the measured interaction torque between the synchronous movement system and the rehabilitation robot body and the kinetic parameter identification result;
acquiring driving torque required to be output by the rehabilitation robot body according to the movement intention of the patient;
and generating a corresponding control command according to the driving moment, and sending the control command to the rehabilitation robot body.
In a preferred embodiment of the invention, said kinetic parameters comprise: the sum of the gravity vector and the static friction vector, the viscous friction vector, and the moment of inertia.
In a preferred embodiment of the present invention, the identifying the kinetic parameters of the synchronous motion system to obtain a kinetic parameter identification result includes:
performing online identification on the sum of the gravity vector and the static friction vector;
and according to the online identification result of the sum of the gravity vector and the static friction vector, performing online identification on the viscous friction vector and the rotational inertia.
In a preferred embodiment of the present invention, the online identifying the sum of the gravity vector and the static friction vector includes:
controlling the rehabilitation robot body to drive the synchronous motion system to rotate to a plurality of specific angles, so that the interaction torque measured at each specific angle is equal to the sum of the gravity vector and the static friction vector;
and fitting a relational expression between the sum of the gravity vector and the static friction vector and the angle according to the angle values of the specific angles, thereby obtaining an online identification result of the sum of the gravity vector and the static friction vector.
In a preferred embodiment of the present invention, the online recognizing the viscous friction vector and the moment of inertia according to the online recognition result of the sum of the gravity vector and the static friction vector includes:
establishing a system state equation shown as the formula (1):
Figure RE-GDA0003110730220000031
wherein, ω iskRepresenting the angle of rotation, τ, of the synchronous moving system at the time kkRepresenting the interaction moment between the synchronous motion system and the rehabilitation robot body at the kth moment, k representing the kth sampling moment, fkRepresenting the viscous friction vector, T representing the sampling period, MkRepresents the moment of inertia at time k, (D)k+Gk) Representing the identification result of the sum of the gravity vector and the static friction vector;
measuring the angular velocity omega of the rotation of the synchronous motion system at the kth momentk
Measuring the interaction torque tau between the synchronous motion system and the rehabilitation robot body at the kth momentk
For the measured angular velocity ωkAnd interaction moment taukFiltering to obtain corresponding angular velocity unbiased estimation quantity
Figure RE-GDA0003110730220000041
Unbiased estimation of sum interaction torque
Figure RE-GDA0003110730220000042
Obtaining the identification result of the moment of inertia at the k-th moment according to the following formulas (2) to (4)
Figure RE-GDA0003110730220000043
Figure RE-GDA0003110730220000044
Δωk=ωkk-1 (3)
Figure RE-GDA0003110730220000045
Wherein, Δ τk=(τkk-1) Beta is preset;
unbiased estimation quantity of the obtained interaction torque
Figure RE-GDA0003110730220000046
Unbiased estimate of angular velocity
Figure RE-GDA0003110730220000047
Identification result of moment of inertia
Figure RE-GDA0003110730220000048
And the result (D) of the recognition of the sum of the gravity vector and the static friction vectork+Gk) Substituting formula (1) to obtain the identification result of the viscous friction vector at the k-th moment
Figure RE-GDA0003110730220000049
Judging the identification result of the moment of inertia at the k moment
Figure RE-GDA00031107302200000410
The result of identification of the viscous friction vector
Figure RE-GDA00031107302200000411
If the predetermined condition is met, ending the process when the predetermined condition is met, and if the predetermined condition is not met, enabling k to be k +1 and returning to execute the measurement of the angular speed omega of the rotation of the synchronous motion system at the k momentk
In a preferred embodiment of the invention, said pair of measured angular velocities ω iskAnd interaction moment taukFiltering to obtain corresponding angular velocity unbiased estimation quantity
Figure RE-GDA00031107302200000412
Unbiased estimation of sum interaction torque
Figure RE-GDA00031107302200000413
The method comprises the following steps:
using an extended Kalman filter to measure the angular velocity omegakAnd interaction moment taukFiltering to obtain corresponding angular velocity unbiased estimation quantity
Figure RE-GDA00031107302200000414
Unbiased estimation of sum interaction torque
Figure RE-GDA00031107302200000415
In order to achieve the above object, the present invention further provides a rehabilitation robot control system based on kinetic parameter identification, the rehabilitation robot including a rehabilitation robot body and a rehabilitation robot accessory for driving a training side limb of a patient to rotate around an output shaft of the rehabilitation robot body, the training side limb and the rehabilitation robot accessory being fixed together to form a synchronous motion system, the control system including:
the parameter identification module is used for identifying the kinetic parameters of the synchronous motion system when receiving a kinetic parameter identification instruction to obtain a kinetic parameter identification result;
the exercise intention acquisition module is used for acquiring the exercise intention of the patient according to the measured interaction torque between the synchronous motion system and the rehabilitation robot body and the kinetic parameter identification result;
the driving moment acquisition module is used for acquiring the driving moment required to be output by the rehabilitation robot body according to the movement intention of the patient;
and the control module is used for generating a corresponding control command according to the driving moment and sending the control command to the rehabilitation robot body.
In a preferred embodiment of the invention, said kinetic parameters comprise: the sum of the gravity vector and the static friction vector, the viscous friction vector, and the moment of inertia.
In a preferred embodiment of the present invention, the parameter identification module comprises:
the first online identification unit is used for online identifying the sum of the gravity vector and the static friction vector;
and the second online identification unit is used for online identifying the viscous friction vector and the rotational inertia according to the online identification result of the sum of the gravity vector and the static friction vector.
In a preferred embodiment of the present invention, the first online identification unit is specifically configured to:
controlling the rehabilitation robot body to drive the synchronous motion system to rotate to a plurality of specific angles, so that the interaction torque measured at each specific angle is equal to the sum of the gravity vector and the static friction vector;
and fitting a relational expression between the sum of the gravity vector and the static friction vector and the angle according to the angle values of the specific angles, thereby obtaining an online identification result of the sum of the gravity vector and the static friction vector.
In a preferred embodiment of the present invention, the second online identification unit is specifically configured to:
establishing a system state equation shown as the formula (1):
Figure RE-GDA0003110730220000061
wherein, ω iskRepresenting the angle of rotation, τ, of the synchronous moving system at the time kkRepresenting the interaction moment between the synchronous motion system and the rehabilitation robot body at the kth moment, k representing the kth sampling moment, fkRepresenting the viscous friction vector, T representing the sampling period, MkRepresents the moment of inertia at time k, (D)k+Gk) Representing the identification result of the sum of the gravity vector and the static friction vector;
measuring rotation of the synchronous moving system at time kAngular velocity omegak
Measuring the interaction torque tau between the synchronous motion system and the rehabilitation robot body at the kth momentk
For the measured angular velocity ωkAnd interaction moment taukFiltering to obtain corresponding angular velocity unbiased estimation quantity
Figure RE-GDA0003110730220000062
Unbiased estimation of sum interaction torque
Figure RE-GDA0003110730220000063
Obtaining the identification result of the moment of inertia at the k-th moment according to the following formulas (2) to (4)
Figure RE-GDA0003110730220000064
Figure RE-GDA0003110730220000065
Δωk=ωkk-1 (3)
Figure RE-GDA0003110730220000066
Wherein, Δ τk=(τkk-1) Beta is preset;
unbiased estimation quantity of the obtained interaction torque
Figure RE-GDA0003110730220000067
Unbiased estimate of angular velocity
Figure RE-GDA0003110730220000068
Identification result of moment of inertia
Figure RE-GDA0003110730220000069
And the direction of gravityRecognition of the sum of the quantity and the static friction vector (D)k+Gk) Substituting formula (1) to obtain the identification result of the viscous friction vector at the k-th moment
Figure RE-GDA00031107302200000610
Judging the identification result of the moment of inertia at the k moment
Figure RE-GDA00031107302200000611
The result of identification of the viscous friction vector
Figure RE-GDA0003110730220000071
If the predetermined condition is met, ending the process when the predetermined condition is met, and if the predetermined condition is not met, enabling k to be k +1 and returning to execute the measurement of the angular speed omega of the rotation of the synchronous motion system at the k momentk
In a preferred embodiment of the present invention, the second online identification unit uses an extended kalman filter to measure the angular velocity ω of the pairkAnd interaction moment taukFiltering to obtain corresponding angular velocity unbiased estimation quantity
Figure RE-GDA0003110730220000072
Unbiased estimation of sum interaction torque
Figure RE-GDA0003110730220000073
In order to achieve the above object, the present invention also provides an electronic device, which comprises a memory, a processor and a computer program stored on the memory and executable on the processor, wherein the processor implements the steps of the aforementioned method when executing the computer program.
In order to achieve the above object, the present invention also provides a computer-readable storage medium having stored thereon a computer program which, when executed by a processor, implements the steps of the aforementioned method.
By adopting the technical scheme, the invention has the following beneficial effects:
the invention introduces the kinetic parameter identification, can identify the kinetic parameters of the synchronous motion system formed by the rehabilitation robot accessory and the patient training side limb when the rehabilitation robot carries out patient replacement or the training side limb of the patient, and can accurately acquire the motion intention of the patient by combining the interactive torque between the synchronous motion system and the rehabilitation robot body; and then, according to the movement intention of the patient, obtaining a driving moment of the rehabilitation robot body, generating a corresponding control command according to the driving moment, and sending the control command to the rehabilitation robot body so as to control the rehabilitation robot body to drive the rehabilitation robot accessory and the patient training side limb to move integrally by the driving moment. Because the dynamic parameter identification is introduced, the flexibility of the cooperative interaction force control of the rehabilitation robot and the training side limbs of the patient can be improved, the comfort level of the patient in the rehabilitation training process is increased, the satisfaction degree of the patient on the rehabilitation training is improved, and the rehabilitation effect is improved.
Drawings
Fig. 1 is a flowchart of a rehabilitation robot control method based on kinetic parameter identification in embodiment 1 of the present invention;
fig. 2 is a flowchart of a rehabilitation robot control method based on kinetic parameter identification according to embodiment 2 of the present invention;
FIG. 3 is a graph of drive torque versus theoretical drive torque obtained using the method of example 2 of the present invention;
FIG. 4 is a graph of driving torque versus theoretical driving torque identified using a prior art kinetic parameter identification method;
fig. 5 is a block diagram of a rehabilitation robot control system based on kinetic parameter identification according to embodiment 3 of the present invention;
fig. 6 is a block diagram of a rehabilitation robot control system based on kinetic parameter identification according to embodiment 4 of the present invention;
fig. 7 is a hardware architecture diagram of an electronic device in embodiment 5 of the present invention.
Detailed Description
In order to make the objects, technical solutions and advantages of the present invention more apparent, the present invention is described in further detail below with reference to the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are merely illustrative of the invention and are not intended to limit the invention. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.
The terminology used herein is for the purpose of describing particular embodiments only and is not intended to be limiting of the disclosure. As used in this disclosure and the appended claims, the singular forms "a," "an," and "the" are intended to include the plural forms as well, unless the context clearly indicates otherwise. It should also be understood that the term "and/or" as used herein refers to and encompasses any and all possible combinations of one or more of the associated listed items.
Example 1
The embodiment provides a rehabilitation robot control method based on kinetic parameter identification. In this embodiment, the rehabilitation robot includes the rehabilitation robot body and the rehabilitation robot accessory, and this rehabilitation robot accessory includes ties up structure and rehabilitation arm. When the rehabilitation robot is used, a physical therapist firstly adjusts the rehabilitation robot to a position matched with a patient, and fixes the training side limbs of the patient and the rehabilitation mechanical arm through a binding structure, so that the training side limbs and the rehabilitation mechanical arm form a synchronous motion system (the relative motion between the training side limbs and the rehabilitation mechanical arm can be ignored), and the rehabilitation mechanical arm drives the training side limbs of the patient to rotate around an output shaft of the rehabilitation robot body; then, the rehabilitation robot is adjusted to a corresponding training mode, a man-machine cooperative interaction self-adaptive control periodic cycle is started, meanwhile, prompts, games and the like related to rehabilitation can appear in a man-machine interaction interface configured on the rehabilitation robot body, and a patient can select from the interface according to own requirements.
In the present embodiment, the rehabilitation robot is preferably an isokinetic muscle strength rehabilitation robot.
Based on the rehabilitation robot described above, the control method of the present embodiment is shown in fig. 1, and specifically includes the following steps:
and S1, when a kinetic parameter identification instruction is received, identifying the kinetic parameters of the synchronous motion system formed by the patient training side limb and the rehabilitation robot to obtain a kinetic parameter identification result.
S2, acquiring the movement intention of the patient according to the interactive moment and the kinetic parameter identification result;
s3, acquiring the driving moment of the rehabilitation robot body according to the movement intention of the patient;
and S4, generating a corresponding control command according to the driving moment, and sending the control command to the rehabilitation robot body so as to control the rehabilitation robot body to drive the rehabilitation robot accessory and the patient training side limb to integrally move by the driving moment.
The embodiment identifies by introducing the kinetic parameters, improves the flexibility of the cooperative interaction force control of the rehabilitation robot and the training side limbs of the patient, increases the comfort level of the patient in the rehabilitation training process, improves the satisfaction degree of the patient on the rehabilitation training, and improves the rehabilitation effect.
Example 2
This example is a further improvement over example 1, and specifically provides a preferred implementation for the foregoing step S1.
In the prior art, in order to realize the kinetic parameter identification, a fixed kinetic parameter identification model is generally established in advance, so as to perform parameter identification through the model. However, an accurate model is difficult to establish for a time-varying system with complex man-machine interaction, such as rehabilitation training, and the scheme has complex data processing and higher requirement on hardware; moreover, when a patient is replaced or a training side limb is replaced, because the weight of different people or different limbs and the difference of the rotational inertia around the output shaft are extremely large, the traditional fixed dynamic parameter identification model is difficult to realize ideal following of the rehabilitation robot to the motion of the training side limb of the patient and ensure the stability of the motion control of the rehabilitation robot under a multi-person or multi-joint constant-speed rehabilitation training model.
In this regard, the present embodiment provides an online identification method for identifying the kinetic parameters of the synchronous motion system formed by the patient training side limb and the rehabilitation robot, so as to obtain the kinetic parameter identification result.
In general, the kinetic system can be described using the euler-lagrange kinetic model as follows:
Figure RE-GDA0003110730220000101
wherein M (q) represents a rotational inertia matrix,
Figure RE-GDA0003110730220000102
representing a matrix of coriolis forces and centrifugal forces, g (q) representing a gravity vector, f representing a viscous friction vector, D representing a static friction vector,
Figure RE-GDA0003110730220000103
indicating angular velocity and tau the interaction moment.
Since the application scenario of the embodiment is a single-degree-of-freedom low-speed rehabilitation robot, the coriolis force and the centrifugal force of the rehabilitation robot may not be considered, so the model may be simplified as follows:
Figure RE-GDA0003110730220000104
in order to realize the modeling of the dynamic characteristics of the training side limbs of the patient and the accessories of the rehabilitation robot, the interactive moment tau between the synchronous motion system and the rehabilitation robot body can be measured by a moment sensor in the parameter identification process and used as input in the parameter identification process, and the angular speed of the motion of the system
Figure RE-GDA0003110730220000105
As system input, order
Figure RE-GDA0003110730220000106
According to the standardThe simplified model can be linearized by the semantic input and output and rewritten into a state space equation
Figure RE-GDA0003110730220000107
In the form of (a), it is possible to obtain:
Figure RE-GDA0003110730220000108
at the same time, the output equation is also written in terms of the canonical form of the state space equation, y ═ cx + v
Figure RE-GDA0003110730220000109
Where w and v represent the system noise and the measurement noise vector, respectively, and the covariance matrix of the two can be represented by the formula Q ═ cov (w) ═ E { wwTAnd R ═ cov (v) ═ E { vv }TGet, respectively, where E { } represents the desired calculation.
It should be understood that the goal of parameter identification is to determine the identification results of the three items M, f, (D + G).
As shown in fig. 2, the present embodiment realizes parameter identification by the following steps:
s11, when receiving the dynamic parameter identification instruction, carrying out online identification on the sum of the gravity vector and the static friction vector in the dynamic parameter, specifically realizing the following process:
firstly, controlling the rehabilitation robot body to drive the synchronous motion system to rotate to a plurality of specific angles thetakSuch that the interaction torque measured at each of said specific angles is entirely generated by said gravity vector and said static friction vector, i.e. (D)k+Gk)=τk
Then, the sum (D) of the gravity vector and the static friction vector is fitted according to the angle values of the specific anglesk+Gk) And angle thetakThe online identification result of the sum of the gravity vector and the static friction vector can be obtained through the relational expression between the gravity vector and the static friction vector.
S12, performing online identification on the viscous friction vector and the rotational inertia according to the online identification result of the sum of the gravity vector and the static friction vector, wherein the online identification is specifically realized by the following steps:
s121, configuring initial values M of the sum of the gravity vector and the static friction vector, the viscous friction vector and the moment of inertia at the 0 th moment0、f0、D0+G0
S122, writing the system model of the state space equation mode
Figure RE-GDA0003110730220000111
Discretizing by taking the sampling period T as a time scale, a system state equation shown as a formula (1) can be obtained:
Figure RE-GDA0003110730220000112
wherein, ω iskRepresenting the angle of rotation, τ, of the synchronous moving system at the time kkRepresenting the interaction moment between the synchronous motion system and the rehabilitation robot body at the kth moment, k representing the kth sampling moment, fkRepresenting the viscous friction vector, T representing the sampling period, MkRepresents the moment of inertia at time k, (D)k+Gk) Representing the previously obtained identification result of the sum of the gravity vector and the static friction vector.
Likewise, the system output equation may also be discretized into yk=ωkAnd k represents the specific moment of the kth sampling, and the interaction moment tau is introduced into a system state equation, which can also be expressed as:
Figure RE-GDA0003110730220000113
s123, measuring the angular speed omega of the rotation of the synchronous motion system at the kth momentk
Specifically, the present embodiment measures the angular velocity ω by an encoderk
S124, measuring the kth moment, wherein the synchronous motion system and the rehabilitation machineInteraction moment tau between human bodiesk
Specifically, the present embodiment measures the interaction torque τ through a torque sensork
S125, measuring the obtained angular velocity omegakAnd interaction moment taukFiltering to obtain corresponding angular velocity unbiased estimation quantity
Figure RE-GDA0003110730220000121
Unbiased estimation of sum interaction torque
Figure RE-GDA0003110730220000122
It should be understood that the measured values of the encoder and the torque sensor may have errors, and in order to eliminate the errors, the embodiment preferably uses the extended kalman filter to measure the angular velocity ωkAnd interaction moment taukAnd filtering, wherein the specific working process of the Kalman filter is as follows:
parameter initialization is performed by the following formula:
Figure RE-GDA0003110730220000123
Figure RE-GDA0003110730220000124
parameter prediction is performed by the following formula:
Figure RE-GDA0003110730220000125
Figure RE-GDA0003110730220000126
the parameter update is performed by the following formula:
Figure RE-GDA0003110730220000127
Figure RE-GDA0003110730220000128
Figure RE-GDA0003110730220000129
wherein, as mentioned above, Q ═ cov (w) ═ E { wwTW represents a system noise vector, and the value thereof is preset, R ═ cov (v) ═ E { vv }TV denotes a measurement noise vector, the value of which is preconfigured.
S126, in the motion process, the angular acceleration change value can be defined by the quadratic difference of the angular velocity, and simultaneously, the angular acceleration change value and the interaction torque tau are in physical significancekRate of change Δ τ ofk=(τkk-1) And the set adaptive law
Figure RE-GDA00031107302200001210
In a linear relationship, i.e. can be expressed as ωk=2ωk-1k-2+bk-1Δτk-1Referring to a dynamic system rotational inertia identification method of Landau discrete time method, the self-adaptive law of the dynamic system inertia is deduced to be:
Figure RE-GDA00031107302200001211
wherein beta is the variation coefficient of the adaptive law, the value of which is configured in advance, and the angular speed variation rate can be defined as delta omegak=ωkk-1. Will be provided with
Figure RE-GDA0003110730220000131
Δωk=ωkk-1Substitution equation
Figure RE-GDA0003110730220000132
The identification result of the moment of inertia at the kth moment can be solved
Figure RE-GDA0003110730220000133
S127, mixing the obtained
Figure RE-GDA0003110730220000134
Substituting formula (1) to obtain the identification result of the viscous friction vector at the k-th moment
Figure RE-GDA0003110730220000135
Thus, the identification of the dynamic parameters of the system in a sampling period T is completed, and the system inertia is obtained by estimation at the moment k
Figure RE-GDA0003110730220000136
And viscous friction force
Figure RE-GDA0003110730220000137
Will continue to be used as a variable in the parameter estimation at the next moment, i.e. at the moment k +1, at each moment the sum (D) of the gravity vector and the static friction vectork+Gk) The online identification result is not changed.
S128, judging the identification result of the moment of inertia at the k moment
Figure RE-GDA0003110730220000138
The result of identification of the viscous friction vector
Figure RE-GDA0003110730220000139
And if the predetermined condition is satisfied, ending the identification process, saving the identification result, and if the predetermined condition is not satisfied, setting k to k +1, and returning to execute the step S223.
In this embodiment, the predetermined condition is configured to: identification result of the moment of inertia at the k-th moment
Figure RE-GDA00031107302200001310
The result of identification of the viscous friction vector
Figure RE-GDA00031107302200001311
Are all converged, i.e
Figure RE-GDA00031107302200001312
And
Figure RE-GDA00031107302200001313
wherein epsilonMAnd εfAre each MkAnd fkAllowed recognition error.
According to the embodiment, kinetic parameters are identified step by step according to characteristics of the kinetic parameters, an extended Kalman filter is introduced when the rotational inertia and viscous friction vectors are identified, the rotational inertia obtained through a self-adaptive estimation algorithm is used as a parameter of an extended Kalman filter load torque identification algorithm to participate in system parameter evaluation, so that decoupling of driving torque to the rotational inertia is achieved, the problem that the online identification precision of system parameters is reduced after the rotational inertia of a kinetic system is changed in a traditional method can be solved, and the requirements of multi-joint rehabilitation training of a constant velocity muscle force rehabilitation platform are completely met.
The graph of the driving torque and the theoretical driving torque obtained by the method of the embodiment is shown in fig. 3, and the graph of the driving torque and the theoretical driving torque obtained by the identification by the conventional kinetic parameter identification method is shown in fig. 4.
Example 3
The present embodiment provides a rehabilitation robot control system based on kinetic parameter identification, as shown in fig. 5, the control system specifically includes: a parameter identification module 11, an exercise intention acquisition module 12, a driving torque acquisition module 13, and a control module 14, wherein:
the parameter identification module 11 is used for identifying the kinetic parameters of the synchronous motion system formed by the patient training side limb and the rehabilitation robot to obtain the kinetic parameter identification result.
The exercise intention acquisition module 12 is configured to acquire an exercise intention of the patient according to the interaction moment and the kinetic parameter identification result;
the driving moment acquisition module 13 is used for acquiring the driving moment of the rehabilitation robot body according to the movement intention of the patient;
the control module 14 is configured to generate a corresponding control instruction according to the driving torque, and send the control instruction to the rehabilitation robot body, so as to control the rehabilitation robot body to drive the rehabilitation robot accessory and the patient training side limb to integrally move with the driving torque.
The embodiment identifies by introducing the kinetic parameters, improves the flexibility of the cooperative interaction force control of the rehabilitation robot and the training side limbs of the patient, increases the comfort level of the patient in the rehabilitation training process, improves the satisfaction degree of the patient on the rehabilitation training, and improves the rehabilitation effect.
Example 4
This embodiment is a further improvement of embodiment 3, and specifically, this embodiment provides a preferred implementation for the aforementioned parameter identification module 11.
In the prior art, in order to realize the kinetic parameter identification, a fixed kinetic parameter identification model is generally established in advance, so as to perform parameter identification through the model. However, an accurate model is difficult to establish for a time-varying system with complex man-machine interaction, such as rehabilitation training, and the scheme has complex data processing and higher requirement on hardware; moreover, when a patient is replaced or a training side limb is replaced, because the weight of different people or different limbs and the difference of the rotational inertia around the output shaft are extremely large, the traditional fixed dynamic parameter identification model is difficult to realize ideal following of the rehabilitation robot to the motion of the training side limb of the patient and ensure the stability of the motion control of the rehabilitation robot under a multi-person or multi-joint constant-speed rehabilitation training model.
In this regard, the present embodiment provides an online identification method for identifying the kinetic parameters of the synchronous motion system formed by the patient training side limb and the rehabilitation robot, so as to obtain the kinetic parameter identification result.
In general, the kinetic system can be described using the euler-lagrange kinetic model as follows:
Figure RE-GDA0003110730220000151
wherein M (q) represents a rotational inertia matrix,
Figure RE-GDA0003110730220000152
representing a matrix of coriolis forces and centrifugal forces, g (q) representing a gravity vector, f representing a viscous friction vector, D representing a static friction vector,
Figure RE-GDA0003110730220000153
indicating angular velocity and tau the interaction moment.
Since the application scenario of the embodiment is a single-degree-of-freedom low-speed rehabilitation robot, the coriolis force and the centrifugal force of the rehabilitation robot may not be considered, so the model may be simplified as follows:
Figure RE-GDA0003110730220000154
in order to realize the modeling of the dynamic characteristics of the training side limbs of the patient and the accessories of the rehabilitation robot, the interactive moment tau between the synchronous motion system and the rehabilitation robot body can be measured by a moment sensor in the parameter identification process and used as input in the parameter identification process, and the angular speed of the motion of the system
Figure RE-GDA0003110730220000155
As system input, order
Figure RE-GDA0003110730220000156
The simplified model can be linearized according to defined input and output and rewritten into a state space equation
Figure RE-GDA0003110730220000157
In the form of (a), it is possible to obtain:
Figure RE-GDA0003110730220000158
at the same time, the output equation is also written in terms of the canonical form of the state space equation, y ═ cx + v
Figure RE-GDA0003110730220000159
Where w and v represent the system noise and the measurement noise vector, respectively, and the covariance matrix of the two can be represented by the formula Q ═ cov (w) ═ E { wwTAnd R ═ cov (v) ═ E { vv }TGet, respectively, where E { } represents the desired calculation.
It should be understood that the goal of parameter identification is to determine the identification results of the three items M, f, (D + G). As shown in fig. 6, the parameter identification module of the present embodiment specifically includes a first online identification unit 111 and a second online identification unit 112.
The first online identification unit 111 is configured to perform online identification on a sum of a gravity vector and a static friction vector in the dynamic parameter, and the implementation process is as follows:
firstly, controlling the rehabilitation robot body to drive the synchronous motion system to rotate to a plurality of specific angles thetakSuch that the interaction torque measured at each of said specific angles is entirely generated by said gravity vector and said static friction vector, i.e. (D)k+Gk)=τk
Then, the sum (D) of the gravity vector and the static friction vector is fitted according to the angle values of the specific anglesk+Gk) And angle thetakThe online identification result of the sum of the gravity vector and the static friction vector can be obtained through the relational expression between the gravity vector and the static friction vector.
The second online identification unit 112 is configured to perform online identification on the viscous friction vector and the inertia moment according to an online identification result of a sum of the gravity vector and the static friction vector, and the foregoing steps S121 to S128 are referred to in the implementation process.
According to the embodiment, kinetic parameters are identified step by step according to characteristics of the kinetic parameters, an extended Kalman filter is introduced when the rotational inertia and viscous friction vectors are identified, the rotational inertia obtained through a self-adaptive estimation algorithm is used as a parameter of an extended Kalman filter load torque identification algorithm to participate in system parameter evaluation, so that decoupling of driving torque to the rotational inertia is achieved, the problem that the online identification precision of system parameters is reduced after the rotational inertia of a kinetic system is changed in a traditional method can be solved, and the requirements of multi-joint rehabilitation training of a constant velocity muscle force rehabilitation platform are completely met.
Example 5
The present embodiment provides an electronic device, which may be represented in the form of a computing device (for example, may be a server device), including a memory, a processor, and a computer program stored in the memory and executable on the processor, where the processor, when executing the computer program, may implement the rehabilitation robot control method based on kinetic parameter identification provided in embodiment 1 or 2.
Fig. 7 shows a schematic diagram of a hardware structure of the present embodiment, and as shown in fig. 7, the electronic device 9 specifically includes:
at least one processor 91, at least one memory 92, and a bus 93 for connecting the various system components (including the processor 91 and the memory 92), wherein:
the bus 93 includes a data bus, an address bus, and a control bus.
Memory 92 includes volatile memory, such as Random Access Memory (RAM)921 and/or cache memory 922, and can further include Read Only Memory (ROM) 923.
Memory 92 also includes a program/utility 925 having a set (at least one) of program modules 924, such program modules 924 including, but not limited to: an operating system, one or more application programs, other program modules, and program data, each of which, or some combination thereof, may comprise an implementation of a network environment.
The processor 91 executes various functional applications and data processing, such as the rehabilitation robot control method based on kinetic parameter identification provided in embodiment 1 or 2 of the present invention, by running a computer program stored in the memory 92.
The electronic device 9 may further communicate with one or more external devices 94 (e.g., a keyboard, a pointing device, etc.). Such communication may be through an input/output (I/O) interface 95. Also, the electronic device 9 may communicate with one or more networks (e.g., a Local Area Network (LAN), a Wide Area Network (WAN), and/or a public network, such as the Internet) via the network adapter 96. The network adapter 96 communicates with the other modules of the electronic device 9 via the bus 93. It should be understood that although not shown in the figures, other hardware and/or software modules may be used in conjunction with the electronic device 9, including but not limited to: microcode, device drivers, redundant processors, external disk drive arrays, RAID (disk array) systems, tape drives, and data backup storage systems, etc.
It should be noted that although in the above detailed description several units/modules or sub-units/modules of the electronic device are mentioned, such a division is merely exemplary and not mandatory. Indeed, the features and functionality of two or more of the units/modules described above may be embodied in one unit/module, according to embodiments of the application. Conversely, the features and functions of one unit/module described above may be further divided into embodiments by a plurality of units/modules.
Example 6
The present embodiment provides a computer-readable storage medium on which a computer program is stored, the program, when executed by a processor, implementing the steps of the rehabilitation robot control method based on kinetic parameter identification provided in embodiment 1 or 2.
More specific examples, among others, that the readable storage medium may employ may include, but are not limited to: a portable disk, a hard disk, random access memory, read only memory, erasable programmable read only memory, optical storage device, magnetic storage device, or any suitable combination of the foregoing.
In a possible implementation manner, the present invention can also be implemented in the form of a program product comprising program code for causing a terminal device to perform the steps of implementing the rehabilitation robot control method based on kinetic parameter identification described in embodiment 1 or 2, when the program product is run on the terminal device.
Where program code for carrying out the invention is written in any combination of one or more programming languages, the program code may be executed entirely on the user device, partly on the user device, as a stand-alone software package, partly on the user device and partly on a remote device or entirely on the remote device.
While specific embodiments of the invention have been described above, it will be appreciated by those skilled in the art that this is by way of example only, and that the scope of the invention is defined by the appended claims. Various changes and modifications to these embodiments may be made by those skilled in the art without departing from the spirit and scope of the invention, and these changes and modifications are within the scope of the invention.

Claims (9)

1. A rehabilitation robot control method based on kinetic parameter identification, the rehabilitation robot comprises a rehabilitation robot body and a rehabilitation robot accessory used for driving a training side limb of a patient to rotate around an output shaft of the rehabilitation robot body, the training side limb and the rehabilitation robot accessory are fixed together to form a synchronous motion system, and the control method is characterized by comprising the following steps:
when a kinetic parameter identification instruction is received, identifying kinetic parameters of the synchronous motion system to obtain a kinetic parameter identification result;
acquiring the movement intention of the patient according to the measured interaction torque between the synchronous movement system and the rehabilitation robot body and the kinetic parameter identification result;
acquiring driving torque required to be output by the rehabilitation robot body according to the movement intention of the patient;
and generating a corresponding control command according to the driving moment, and sending the control command to the rehabilitation robot body.
2. The rehabilitation robot control method based on kinetic parameter identification as claimed in claim 1, wherein the kinetic parameters include: the sum of the gravity vector and the static friction vector, the viscous friction vector, and the moment of inertia.
3. The rehabilitation robot control method based on kinetic parameter identification as claimed in claim 1, wherein said identifying kinetic parameters of the synchronous motion system comprises:
performing online identification on the sum of the gravity vector and the static friction vector;
and according to the online identification result of the sum of the gravity vector and the static friction vector, performing online identification on the viscous friction vector and the rotational inertia.
4. The rehabilitation robot control method based on kinetic parameter identification as claimed in claim 1, wherein said identifying kinetic parameters of the synchronous motion system comprises:
controlling the rehabilitation robot body to drive the synchronous motion system to rotate to a plurality of specific angles, so that the interaction torque measured at each specific angle is equal to the sum of the gravity vector and the static friction vector;
and fitting a relational expression between the sum of the gravity vector and the static friction vector and the angle according to the angle values of the specific angles, thereby obtaining an online identification result of the sum of the gravity vector and the static friction vector.
5. The rehabilitation robot control method based on kinetic parameter identification as claimed in claim 3, wherein the online identification of the viscous friction vector and the moment of inertia according to the online identification result of the sum of the gravity vector and the static friction vector comprises:
establishing a system state equation shown as the formula (1):
Figure RE-FDA0003110730210000021
wherein, ω iskRepresenting the angle of rotation, τ, of the synchronous moving system at the time kkRepresenting the interaction moment between the synchronous motion system and the rehabilitation robot body at the kth moment, k representing the kth sampling moment, fkRepresenting the viscous friction vector, T representing the sampling period, MkRepresents the moment of inertia at time k, (D)k+Gk) Representing the identification result of the sum of the gravity vector and the static friction vector;
measuring the angular velocity omega of the rotation of the synchronous motion system at the kth momentk
Measuring the interaction torque tau between the synchronous motion system and the rehabilitation robot body at the kth momentk
For the measured angular velocity ωkAnd interaction moment taukFiltering to obtain corresponding angular velocity unbiased estimation quantity
Figure RE-FDA0003110730210000022
Unbiased estimation of sum interaction torque
Figure RE-FDA0003110730210000023
Obtaining the identification result of the moment of inertia at the k-th moment according to the following formulas (2) to (4)
Figure RE-FDA0003110730210000024
Figure RE-FDA0003110730210000025
Δωk=ωkk-1 (3)
Figure RE-FDA0003110730210000026
Wherein, Δ τk=(τkk-1) Beta is preset;
unbiased estimation quantity of the obtained interaction torque
Figure RE-FDA0003110730210000027
Unbiased estimate of angular velocity
Figure RE-FDA0003110730210000028
Identification result of moment of inertia
Figure RE-FDA0003110730210000029
And the result (D) of the recognition of the sum of the gravity vector and the static friction vectork+Gk) Substituting formula (1) to obtain the identification result of the viscous friction vector at the k-th moment
Figure RE-FDA0003110730210000031
Judging the identification result of the moment of inertia at the k moment
Figure RE-FDA0003110730210000032
The result of identification of the viscous friction vector
Figure RE-FDA0003110730210000033
If the predetermined condition is met, ending the process when the predetermined condition is met, and if the predetermined condition is not met, enabling k to be k +1 and returning to execute the measurement of the angular speed omega of the rotation of the synchronous motion system at the k momentk
6. The rehabilitation robot control method based on kinetic parameter identification as claimed in claim 5, characterized in that said angular velocities obtained by said pair of measurementsDegree omegakAnd interaction moment taukFiltering to obtain corresponding angular velocity unbiased estimation quantity
Figure FDA0002918050810000033
Unbiased estimation of sum interaction torque
Figure FDA0002918050810000034
The method comprises the following steps:
using an extended Kalman filter to measure the angular velocity omegakAnd interaction moment taukFiltering to obtain corresponding angular velocity unbiased estimation quantity
Figure FDA0002918050810000035
Unbiased estimation of sum interaction torque
Figure FDA0002918050810000036
7. The utility model provides a recovered robot control system based on kinetic parameter discerns, recovered robot includes recovered robot body and is used for driving the training side limb of patient around recovered robot body's output shaft pivoted recovered robot accessory, the training side limb with recovered robot accessory is fixed together and is formed synchronous motion system, its characterized in that, control system includes:
the parameter identification module is used for identifying the kinetic parameters of the synchronous motion system when receiving a kinetic parameter identification instruction to obtain a kinetic parameter identification result;
the exercise intention acquisition module is used for acquiring the exercise intention of the patient according to the measured interaction torque between the synchronous motion system and the rehabilitation robot body and the kinetic parameter identification result;
the driving moment acquisition module is used for acquiring the driving moment required to be output by the rehabilitation robot body according to the movement intention of the patient;
and the control module is used for generating a corresponding control command according to the driving moment and sending the control command to the rehabilitation robot body.
8. An electronic device comprising a memory, a processor and a computer program stored on the memory and executable on the processor, characterized in that the steps of the method according to any of claims 1 to 6 are implemented when the computer program is executed by the processor.
9. A computer-readable storage medium, on which a computer program is stored, which, when being executed by a processor, carries out the steps of the method according to any one of claims 1 to 6.
CN202110107304.8A 2021-01-27 2021-01-27 Rehabilitation robot control system based on dynamic parameter identification Active CN113189865B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110107304.8A CN113189865B (en) 2021-01-27 2021-01-27 Rehabilitation robot control system based on dynamic parameter identification

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110107304.8A CN113189865B (en) 2021-01-27 2021-01-27 Rehabilitation robot control system based on dynamic parameter identification

Publications (2)

Publication Number Publication Date
CN113189865A true CN113189865A (en) 2021-07-30
CN113189865B CN113189865B (en) 2024-03-26

Family

ID=76972674

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110107304.8A Active CN113189865B (en) 2021-01-27 2021-01-27 Rehabilitation robot control system based on dynamic parameter identification

Country Status (1)

Country Link
CN (1) CN113189865B (en)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114848391A (en) * 2022-04-28 2022-08-05 北京邮电大学 Compliance control method for lower limb rehabilitation robot
CN114948586A (en) * 2022-04-28 2022-08-30 北京邮电大学 Man-machine system kinematic parameter identification and control method of lower limb rehabilitation robot
CN116259401A (en) * 2023-01-17 2023-06-13 重庆电子工程职业学院 Humanized energy analysis method for rehabilitation machine

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6477445B1 (en) * 1999-04-01 2002-11-05 Abb Ab Method and apparatus for controlling an industrial robot
JP2009147875A (en) * 2007-12-18 2009-07-02 Nikon Corp Image reading and displaying device
CN109676607A (en) * 2018-12-30 2019-04-26 江苏集萃智能制造技术研究所有限公司 A kind of zero-g control method of non-moment sensing
JP2019088456A (en) * 2017-11-14 2019-06-13 株式会社国際電気通信基礎技術研究所 Power assist device and control method of power assist device
WO2019171516A1 (en) * 2018-03-07 2019-09-12 株式会社Fuji Inertial parameter identification system of vertically articulated robot, inertial parameter identification method, and control device and control method for vertically articulated robot
CN110334411A (en) * 2019-06-16 2019-10-15 武汉理工大学 A kind of underwater robot kinetic parameters discrimination method based on Huber M estimation
WO2020133270A1 (en) * 2018-12-28 2020-07-02 深圳配天智能技术研究院有限公司 Dynamic parameter identification method for robot, robot and storage device
CN111671615A (en) * 2020-06-01 2020-09-18 上海电气集团股份有限公司 Training method and system of rehabilitation robot and storage medium
CN111956452A (en) * 2020-08-29 2020-11-20 上海电气集团股份有限公司 Control method and device for upper limb rehabilitation robot

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP5288418B2 (en) * 2008-06-04 2013-09-11 国立大学法人 東京大学 Identification of mechanical parameters

Patent Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6477445B1 (en) * 1999-04-01 2002-11-05 Abb Ab Method and apparatus for controlling an industrial robot
JP2009147875A (en) * 2007-12-18 2009-07-02 Nikon Corp Image reading and displaying device
JP2019088456A (en) * 2017-11-14 2019-06-13 株式会社国際電気通信基礎技術研究所 Power assist device and control method of power assist device
WO2019171516A1 (en) * 2018-03-07 2019-09-12 株式会社Fuji Inertial parameter identification system of vertically articulated robot, inertial parameter identification method, and control device and control method for vertically articulated robot
WO2020133270A1 (en) * 2018-12-28 2020-07-02 深圳配天智能技术研究院有限公司 Dynamic parameter identification method for robot, robot and storage device
CN109676607A (en) * 2018-12-30 2019-04-26 江苏集萃智能制造技术研究所有限公司 A kind of zero-g control method of non-moment sensing
CN110334411A (en) * 2019-06-16 2019-10-15 武汉理工大学 A kind of underwater robot kinetic parameters discrimination method based on Huber M estimation
CN111671615A (en) * 2020-06-01 2020-09-18 上海电气集团股份有限公司 Training method and system of rehabilitation robot and storage medium
CN111956452A (en) * 2020-08-29 2020-11-20 上海电气集团股份有限公司 Control method and device for upper limb rehabilitation robot

Non-Patent Citations (6)

* Cited by examiner, † Cited by third party
Title
ADAM B.ZOSS 等: "Biomechanical Design of the Berkeley Lower Extremity Exoskeleton (BLEEX)", IEEE/ASME TRANSACTIONS ON MECHATRONICS, vol. 11, no. 2, pages 128 - 138 *
H.P.CHAPA SIRITHUNGE 等: "A Wizard of Oz Study of Human Interest Towards Robot Initiated Human-Robot Interaction", 2018 27TH IEEE INTERNATIONAL SYMPOSIUM ON ROBOT AND HUMAN INTERACTIVE COMMUNICATION, 31 December 2018 (2018-12-31), pages 515 - 521 *
LIN-QING XIA 等: "Development of a novel autonomous lower extremity exoskeleton robot forwalking assistance", FRONTIERS OF INFORMATION TECHNOLOGY & ELECTRONIC ENGINEERING, pages 318 - 329 *
MORITZ MATTHIAE 等: "Escape routes, weak links, and desynchronization in fluctuation-driven networks", AMERICAN PHYSICAL SOCIETY, pages 1 - 5 *
YUANJIE FAN: "The internet of things in healthcare: An overview", JOURNAL OF INDUSTRIAL INFORMATION INTEGRATION, pages 3 - 13 *
范渊杰: "基于 sEMG 与交互力等多源信号融合的下肢外骨骼康复机器人及其临床实验研究", 信息科技, pages 1 - 136 *

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114848391A (en) * 2022-04-28 2022-08-05 北京邮电大学 Compliance control method for lower limb rehabilitation robot
CN114948586A (en) * 2022-04-28 2022-08-30 北京邮电大学 Man-machine system kinematic parameter identification and control method of lower limb rehabilitation robot
CN114948586B (en) * 2022-04-28 2023-04-28 北京邮电大学 Human-machine system kinematics parameter identification and control method of lower limb rehabilitation robot
CN114848391B (en) * 2022-04-28 2023-08-29 北京邮电大学 Flexible control method of lower limb rehabilitation robot
CN116259401A (en) * 2023-01-17 2023-06-13 重庆电子工程职业学院 Humanized energy analysis method for rehabilitation machine
CN116259401B (en) * 2023-01-17 2023-10-27 重庆电子工程职业学院 Humanized energy analysis method for rehabilitation machine

Also Published As

Publication number Publication date
CN113189865B (en) 2024-03-26

Similar Documents

Publication Publication Date Title
CN113189865A (en) Rehabilitation robot control method, system, equipment and medium based on kinetic parameter identification
CN111281743B (en) Self-adaptive flexible control method for exoskeleton robot for upper limb rehabilitation
JP6734944B2 (en) Computerized exercise equipment
CN111956452B (en) Control method and device for upper limb rehabilitation robot
Rauter et al. A tendon-based parallel robot applied to motor learning in sports
CN110394784B (en) Manipulator under-actuated structure applied to piano teaching and design method
CN109330819B (en) Master-slave type upper limb exoskeleton rehabilitation robot control system and control method thereof
CN112932897B (en) Method and device for rehabilitation robot to move and rehabilitation robot
Mayetin et al. Design and experimental evaluation of a low cost, portable, 3-dof wrist rehabilitation robot with high physical human–robot interaction
CN113031579A (en) Walking control method and device of biped robot and biped robot
CN112140110A (en) Method and system for calculating actual moment of patient of rehabilitation robot
CN108538381B (en) Interaction force detection method and system of wrist rehabilitation training device
Flanders et al. Using arm configuration to learn the effects of gyroscopes and other devices
CN113995629A (en) Upper limb double-arm rehabilitation robot admittance control method and system based on mirror force field
Aggogeri et al. Design and development of a mechanism for lower limb movement
Assad Uz Zaman et al. Robot sensor system for supervised rehabilitation with real-time feedback
Li et al. A novel end-effector upper limb rehabilitation robot: Kinematics modeling based on dual quaternion and low-speed spiral motion tracking control
WO2022125017A1 (en) A system for a wearable ankle rehabilitation robot and a method thereof
CN117116459B (en) Active rehabilitation training control method and device for rehabilitation robot
CN117085301B (en) Rehabilitation robot multi-feedback rehabilitation training method and system based on virtual reality
Gourishankar et al. Hapstick: a high fidelity haptic simulation for billiards
Zhang et al. Design of finger exoskeleton rehabilitation robot using the flexible joint and the myo armband
CN114918914B (en) Simulation control system and simulation device for human musculature
Jalaeian-F et al. Internal Model impedance control for a lower limb rehabilitation robot in the presence of uncertainty
Mirrashid et al. New Super-twisting Sliding Mode Control of an‎ Upper Limb Rehabilitation Robot Based on the‎ TLBO Algorithm

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
CB02 Change of applicant information
CB02 Change of applicant information

Country or region after: China

Address after: 200070 1st floor, building 104, 960 Zhongxing Road, Jing'an District, Shanghai

Applicant after: Shanghai Jizhi Medical Technology Co.,Ltd.

Address before: 200070 1st floor, building 104, 960 Zhongxing Road, Jing'an District, Shanghai

Applicant before: SHANGHAI ELECTRIC INTELLIGENT REHABILITATION MEDICAL TECHNOLOGY Co.,Ltd.

Country or region before: China

GR01 Patent grant
GR01 Patent grant