CN104492066A - Task-oriented active training control method and corresponding rehabilitation robot - Google Patents
Task-oriented active training control method and corresponding rehabilitation robot Download PDFInfo
- Publication number
- CN104492066A CN104492066A CN201410799839.6A CN201410799839A CN104492066A CN 104492066 A CN104492066 A CN 104492066A CN 201410799839 A CN201410799839 A CN 201410799839A CN 104492066 A CN104492066 A CN 104492066A
- Authority
- CN
- China
- Prior art keywords
- patient
- active
- body part
- represent
- moment
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 43
- 230000007246 mechanism Effects 0.000 claims abstract description 23
- 230000007274 generation of a signal involved in cell-cell signaling Effects 0.000 claims abstract description 4
- 230000001133 acceleration Effects 0.000 claims description 20
- 230000035876 healing Effects 0.000 claims description 16
- 230000008569 process Effects 0.000 claims description 12
- 230000003993 interaction Effects 0.000 claims description 5
- 230000008485 antagonism Effects 0.000 claims description 4
- 238000004364 calculation method Methods 0.000 claims description 3
- 238000001514 detection method Methods 0.000 claims description 3
- 230000001105 regulatory effect Effects 0.000 abstract description 4
- 210000003141 lower extremity Anatomy 0.000 description 12
- 210000003205 muscle Anatomy 0.000 description 8
- 230000006378 damage Effects 0.000 description 7
- 208000005392 Spasm Diseases 0.000 description 6
- 206010044565 Tremor Diseases 0.000 description 6
- 230000000694 effects Effects 0.000 description 5
- 206010008190 Cerebrovascular accident Diseases 0.000 description 4
- 208000006011 Stroke Diseases 0.000 description 4
- 230000002159 abnormal effect Effects 0.000 description 4
- 210000003414 extremity Anatomy 0.000 description 4
- 230000007659 motor function Effects 0.000 description 4
- 208000020431 spinal cord injury Diseases 0.000 description 4
- 206010033799 Paralysis Diseases 0.000 description 3
- 230000006870 function Effects 0.000 description 3
- 230000001771 impaired effect Effects 0.000 description 3
- 208000012661 Dyskinesia Diseases 0.000 description 2
- 230000001154 acute effect Effects 0.000 description 2
- 230000006978 adaptation Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 2
- 230000002490 cerebral effect Effects 0.000 description 2
- 208000014674 injury Diseases 0.000 description 2
- 239000011159 matrix material Substances 0.000 description 2
- 230000004118 muscle contraction Effects 0.000 description 2
- 230000007996 neuronal plasticity Effects 0.000 description 2
- 208000019553 vascular disease Diseases 0.000 description 2
- 206010019468 Hemiplegia Diseases 0.000 description 1
- 206010033892 Paraplegia Diseases 0.000 description 1
- 206010037714 Quadriplegia Diseases 0.000 description 1
- 208000027418 Wounds and injury Diseases 0.000 description 1
- 230000003044 adaptive effect Effects 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000009514 concussion Effects 0.000 description 1
- 230000001276 controlling effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000002452 interceptive effect Effects 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 230000036651 mood Effects 0.000 description 1
- 210000005036 nerve Anatomy 0.000 description 1
- 230000035484 reaction time Effects 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 229910052709 silver Inorganic materials 0.000 description 1
- 239000004332 silver Substances 0.000 description 1
- 230000004083 survival effect Effects 0.000 description 1
- 230000008733 trauma Effects 0.000 description 1
Landscapes
- Rehabilitation Tools (AREA)
Abstract
The invention discloses a task-oriented active training control method applied to a rehabilitation robot. The rehabilitation robot is provided with a sensor, a control system and a driving mechanism, the control system is used for receiving a signal generation control command collected by the sensor and sending the control command to the driving mechanism, and the driving mechanism can be worn on the body part of a patient and is used for receiving the control command and applying and regulating acting force on the body part of the patient according to the control command so as to control rehabilitation training of the patient. The control method includes the steps: S1, detecting an active movement signal of the body part of the patient; S2, regulating the acting force applied by the driving mechanism of the rehabilitation robot on the body part of the patient according to the active movement signal of the body part of the patient.
Description
Technical field
The present invention relates to a kind of task orientation formula active training control method and corresponding healing robot, belong to rehabilitation appliances technical field.
Background technology
Apoplexy and spinal cord injury cause two of lower extremity motor function obstacle large main causes.Apoplexy, also known as cerebral apoplexy, is a kind of acute cranial vascular disease, and it is fallen ill suddenly and is difficult to prediction; permanent cerebral nerve can be caused to damage; disability rate remains high always, and the patient of survival usually can suffer the torment of sequelae, hemiplegia to be exactly wherein common one.Spinal cord injury is normally caused by serious spinal trauma, and various contingency all likely causes the generation of spinal cord injury.The same with apoplexy, spinal cord injury has very high disability rate, may cause the illness such as paraplegia, tetraplegia, the serious daily life campaign hindering patient.Due to high incidence and the frequent various contingencies occurred of cranial vascular disease, the paralysed patient quantity of China grows with each passing day.For paralysed patient, after the Clinical Processing through acute stages such as such as operations, rehabilitation becomes main a kind of auxiliary treatment means.According to neural plasticity principle, the extremity motor function that it can help patient to recover impaired to a certain extent, relearns ADL, thus as much as possible helps patient to return normal life.
Although training has facilitation to neural plasticity, the extremity motor function that paralysed patient recovers impaired to a certain extent can be helped, but rehabilitation is all a quite long-term time-continuing process usually, sometimes even may run through the time of patient lifetime.
In traditional rehabilitation means, the training of patient mainly relies on Physical Therapist one to one sometimes or even many-to-one manually auxiliary, and generally compare loss time and medical resource, cost is also therefore relatively high; In addition, because active training is difficult to manual realization, so the motion of patient body part is all passive substantially, Training strategy is more single, deceives and turns round and look at concrete condition and adopt machine-made passive exercise pattern to be unfavorable for the rehabilitation of patient.Because motion process is primarily of Physical Therapist's Non-follow control, therefore rehabilitation training is very easily subject to the experience of Physical Therapist, the impact of the subjective factor such as mood and muscle power, the movement locus of patient body part, mutual being often difficult to be applied between dynamics on patient body part and patient-Physical Therapist keeps good uniformity, and this subjectivity and inconsistency often cause the not reproducible of rehabilitation efficacy.
Healing robot is that the patient body part impaired with motor function interacts, and patient is the object possessing autokinetic movement consciousness, current healing robot is in passive exercise mode, be difficult to the interactive controlling realized between robot and patient, if patient body part is because of spasm, the abnormal muscle activity such as to tremble and creating antagonism with robot, patient body part may suffer secondary damage, increases the weight of the condition of the injury; And passive exercise is difficult to the active movement intention obtaining patient, causes patient to participate in enthusiasm and greatly reduces, affect rehabilitation training effect.
Summary of the invention
(1) technical problem that will solve
The object of the invention is the defect adopting passive exercise control method for existing rehabilitation equipment, propose a kind of task orientation formula active training control method, to provide safe, comfortable, natural and to possess the training environment of active compliance, improve the training enthusiasm of patient, improve the efficiency of rehabilitation.
(2) technical scheme
The present invention proposes a kind of task orientation formula active training control method, be applied in healing robot, described healing robot has sensing device, control system and driving mechanism, the signal generation control instruction that control system gathers for receiving sensing device, and control instruction is sent to driving mechanism, driving mechanism can wear the body part in patient, receive described control instruction, apply according to control instruction and regulate the active force to patient body part, to control the rehabilitation training of patient, described control method comprises the steps:
The active movement signal of S1, detection patient body part;
S2, active movement signal according to patient body part, regulate the driving mechanism of healing robot to the active force of patient body part.
According to a kind of detailed description of the invention of the present invention, described active movement signal is the active joint moment of patient, and described step S2 comprises:
S21, set up the directed walk corresponding with the motor task of patient, its closest approach of distance on the joint position of body part and this directed walk according to patient, sets up a virtual channel as reference position around specified path;
S22, convert active joint moment to corresponding actual motion, according to the position calculation position of virtual tunnel, speed and acceleration adjustment amount, obtain the control instruction of position, speed and acceleration, and it can be used as control signal to control driving mechanism;
S23, the active joint moment of patient body part to be decomposed along just tangential and positive normal, according to two components and the position offset of active moment, adopt the method for fuzzy logic to regulate impedance parameter.
According to a kind of detailed description of the invention of the present invention, described step S21 comprises:
Step S211: specify directed walk by a two-dimensional sequence Q in the joint space shown in following formula
srepresent:
Q
s:{q
i=[q
i,1q
i,2]
T|i=1,...,L}
Wherein, q
irepresent Q
si-th element, q
i, jrepresent q
ia jth element, L is Q
sthe number of middle element;
Step S212: by intermediate variable equally spaced uniform discrete in its domain of definition, obtain terminal position sequence by parametrization equation, utilize inverse kinematics equation that end sequence is transformed into joint space;
Step S213: find the point that distance current location in position sequence is nearest
I
*=argmin
i=1 ..., L-1|| q
i-q||, wherein i
*represent the sequence number of closest approach;
Step S214: use closest approach
with the next point in sequence
determine straight line, this straight line is used as the tangent line at closest approach place on specified path approx:
Wherein
Represent straight line
slope,
represent the intercept of this straight line; q
pbe used to replace
be used as the closest approach of distance current joint position on specified path;
Step S215: according to its closest approach of distance on real-time joint position and specified path, determine the reference position q in training process
r:
Thus around specified path, establish a virtual tunnel to limit the active movement of patient.
According to a kind of detailed description of the invention of the present invention, described step S22 comprises:
Step S221: by reverse impedance equation, according to the joint moment τ that patient self produces
hproduce position, speed and acceleration adjustment amount, revise reference locus, to regulate the Interaction Force of patient body part and driving mechanism;
Step S222: after utilizing position, speed, acceleration adjustment amount to revise reference movement locus, obtain position, speed and acceleration instruction, and it can be used as the reference signal of position servo control.
According to a kind of detailed description of the invention of the present invention, described step S23 comprises:
Step S231: according to the directed walk of specifying and real-time joint position, the active moment of patient body part is decomposed into two components:
τ
h=τ
td
t+τ
ed
e,
Wherein, d
trepresent and specify subpoint q on directed walk
pthat locates is just tangential, d
erepresent subpoint place positive normal, q is departed from it and position
edirection consistent, point to current actual positions by subpoint, τ
tand τ
erepresent τ respectively
halong the component of above-mentioned both direction;
Step S232: the tangent line of the subpoint on specified path can by straight line
be similar to, the just tangential column vector in order to lower 2 × 1 represents:
Step S233: the initiatively projection of joint moment on positive normal, under nonsingular state, namely || q
e|| ≠ 0, time, it can according to q
etry to achieve, otherwise, be set to d
tone of them normal direction:
Wherein, d
tirepresent d
ti-th element, q
ebe orthogonal to straight line
d can be obtained
t⊥ d
e, || d
t||=1 and || d
e||=1, wherein ⊥ is orthogonal symbols, thus initiatively joint moment can respectively by formula in the projection just tangentially and on positive normal
with
try to achieve;
Step S234: by decomposing initiatively moment, obtain patient in the motion intention tangentially and in normal direction, when patient is intended to antagonism specified path, increases the impedance of active movement, otherwise reduces impedance.
According to a kind of detailed description of the invention of the present invention, in step S234, fuzzy logic is adopted to carry out impedance adjustment, initiatively two component τ of joint moment
tand τ
eand positional offset amount || q
e|| as the input variable of fuzzy logic, wherein || || represent Euclid 2-norm operator.
(3) beneficial effect
Task orientation formula active training control method of the present invention obtains patient's active movement intention, can guarantee the movement locus of rehabilitation training, is applied to dynamics on patient body part and possesses good uniformity alternately between patient and robot.
The present invention can for patient provide one safe, comfortable, natural and possess the training environment of active compliance, avoid patient body part due to spasm, the abnormal secondary damage caused of muscle activity such as tremble.
The present invention focuses on the participating actively consciousness exciting patient in rehabilitation exercise process, encourages patient to control the contraction of muscle of patient body part energetically, effectively improves the rehabilitation efficacy of training.
Accompanying drawing explanation
Fig. 1 is the flow chart being applied to the task orientation formula active training control method of healing robot of the present invention;
Fig. 2 is the closest approach searching distance current location on specified path;
Fig. 3 is the virtual channel around specified path;
Fig. 4 is location-based impedance Control double circle structure;
Fig. 5 is for initiatively moment decomposition--current location is positioned at specified path inside;
Fig. 6 is that initiatively moment is divided--current location is positioned at specified path outside;
Fig. 7 is the membership function of input variable obfuscation;
Fig. 8 A ~ 8D is task orientation formula active training result under fuzzy logic.
Detailed description of the invention
Healing robot has sensing device, control system and driving mechanism, the signal generation control instruction that control system gathers for receiving sensing device, and control instruction is sent to driving mechanism, driving mechanism can wear the body part in patient, receive described control instruction, apply and regulate the active force to patient body part according to control instruction, to control the rehabilitation training of patient.Because the mechanical realization of healing robot and the control method of routine thereof are prior aries, therefore do not illustrate in the description of the invention.
What the present invention proposed is a kind of task orientation formula active training control method being applied to healing robot.Fig. 1 is the flow chart being applied to the task orientation formula active training control method of healing robot of the present invention, and as shown in Figure 1, the method mainly comprises the steps:
The active movement signal of S1, detection patient body part.
The active movement signal of the body part of patient can be the active joint moment of patient, i.e. the moment in the joint relative to this part that produces when active movement of the body part of patient.
S2, active movement signal according to patient body part, regulate the driving mechanism of healing robot to the active force of patient body part.
Active movement signal due to patient body part embodies patient's active movement intention, the movement locus of rehabilitation training can be regulated according to this intention pointedly, make to be applied to dynamics on patient body part and possess good uniformity alternately between patient and robot.
When active movement signal is the active joint moment of patient, step S2 can comprise as follows step by step:
S21, set up the directed walk corresponding with the motor task of patient, its closest approach of distance on the joint position of body part and this directed walk according to patient, sets up a virtual channel as reference position around specified path.
In step S21, described motor task is predefined as a directed walk, only comprises positional information and does not have speed and acceleration information; Described motor task the most directly represents the path of body part (such as lower limb) end in normally cartesian space, typically such as { x
s(v) | v ∈ Ω
s, wherein, v is intermediate variable, Ω
sit is the domain of definition; For obtaining joint space position sequence, first by intermediate variable equally spaced uniform discrete in its domain of definition, then obtaining terminal position sequence by parametrization equation, finally utilizing reverse movement equation that end sequence is transformed into joint space; When task training is a shuttling movement, for ensureing sequential element uniqueness, Ω
sto be set in the period of motion, when training mission is a back and forth movement, Ω
sto be set in half period of motion;
S22, convert active joint moment to corresponding actual motion, according to the position calculation position of virtual tunnel, speed and acceleration adjustment amount, obtain the control instruction of position, speed and acceleration, and it can be used as control signal to control driving mechanism.
In step S22, utilize impedance adjustment, convert the active joint moment embodying patient motion intention to corresponding actual motion: in joint space, adopt location-based impedance adjustment, realized by double-closed-loop control structure, impedance Control outer shroud produces the adjustment amount of position, speed and acceleration by reverse impedance equation, revise reference locus, regulate the Interaction Force of the driving mechanism of patient body part and rehabilitation equipment; Set up the man-machine interface possessing active compliance; make the moment that the motion Initial adaption patient body part of driving mechanism produces; guarantee that patient comfort completes active training naturally; even if in emergency; abnormal movement-the spasm of such as body muscle, to tremble, also can guarantee patient's safety in the training process
S23, the active joint moment of patient body part to be decomposed along just tangential and positive normal, according to two components and the position offset of active moment, adopt the method for fuzzy logic to regulate impedance parameter.
Step S23 sets up self adaptation active compliance environment, with in the training process for patient provides tactile feedback, encourages patient to move according to appointment directed walk; First by the active joint moment of patient body part, along both direction-just, tangential and positive normal decomposes, and then according to two components and the position offset of active moment, adopts the method adjustment impedance parameter of fuzzy logic.
For making the object, technical solutions and advantages of the present invention clearly understand, below in conjunction with specific embodiment, and with reference to accompanying drawing, the present invention is described in further detail.
This embodiment in conjunction with treadmill movement as training mission, can for patient provide one safe, comfortable, natural and possess the training environment of active compliance, avoid patient body part due to spasm, the abnormal secondary damage caused of muscle activity such as tremble; Focus on the participating actively consciousness exciting patient in rehabilitation exercise process, encourage patient to control the contraction of muscle of patient body part energetically, the rehabilitation efficacy of training can be improved, possess rehabilitation training, prevent the functions such as secondary damage.
Step S21: described motor task is predefined as a directed walk, only comprises positional information and does not have speed and acceleration information; Described motor task the most directly represents the path of lower limb end in normally cartesian space, typically such as { x
s(v) | v ∈ Ω
s, wherein, v is intermediate variable, Ω
sit is the domain of definition.The terminal end path x of treadmill movement system
sv () is by following parametrization the Representation Equation:
This path only comprises movement position and directional information, is a clockwise circumference, and the center of circle is [0.62,0], and radius is 0.1m.For realizing task orientation formula active training, need terminal end path to be transformed into joint space position sequence.For this reason, first by the domain of definition [0 of terminal end path, 2 π) discretely equably turn to 5000 points, obtain the sequence of a strictly monotone increasing, then these 5000 points are substituted into above formula and try to achieve the terminal position sequence that comprises 5000 elements, convert terminal position sequence to joint position sequence finally by inverse kinematics.Obviously the joint position sequence Q obtained thus
scome from smooth terminal end path curve, 5000 elements are also enough intensive.
Step S211: specify directed walk by a two-dimensional sequence Q in the joint space shown in following formula
srepresent:
Q
s:{q
i=[q
i,1q
i,2]
T|i=1,...,L}
Wherein, q
irepresent Q
si-th element, q
i, jrepresent q
ia jth element, L is Q
sthe number of middle element, in order to represent that the joint position sequence of specified path is that the smooth curve discretization can led by single order obtains, and all elements in sequence is all unique; Training starts front joint position and is initialized as Q
sstarting point q
0, joint velocity and acceleration are all initialized as 0;
Step S212: by intermediate variable equally spaced uniform discrete in its domain of definition, obtain terminal position sequence by parametrization equation, utilize inverse kinematics equation that end sequence is transformed into joint space;
Step S213: in training process, the real time position of task path and the system of specifying is depended in the reference position in each moment; Find the point that distance current location in position sequence is nearest
i
*=argmin
i=1,...,L-1||q
i-q||
Wherein i
*represent the sequence number of closest approach;
Step S214: closest approach
with the next point in sequence
2 determine unique straight line, and because position sequence is that the smooth curve discretization can led by single order obtains, thus when the element in sequence is enough intensive, this straight line can be used as the tangent line at closest approach place on specified path approx; As shown in Figure 2, dot represents a part of position sequence on specified path, and large circle point represents the joint position of current reality, and orbicular spot represents that a q is at straight line
on projection, q
prepresent that current location q is at straight line
on projection:
Wherein
Represent straight line
slope,
represent the intercept of this straight line; q
pbe used to replace
be used as the closest approach of distance current joint position on specified path, the necessity doing so to replace is, when q distance specified path is sufficiently near, when the element especially in sequence is relatively sparse,
to distance will arrive close to being even less than it
distance, cause near-tangential
with approximate normal
no longer meet approximately perpendicular relation, thus considerable influence is produced to active moment afterwards.
Step S215: according to its closest approach of distance on real-time joint position and specified path, determine the reference position q in training process
r:
Thus around specified path, establish a virtual tunnel to limit the active movement of patient, as shown in Figure 3, middle line represents desirable motion path, and external boundary represents the outer wall in tunnel, and inner boundary represents inwall.Wherein, w
trepresent the width in tunnel, it is a constant, is set to 0.04m in this tunnel width.Q
e=q-q
prepresent that position is departed from, it is the column vector of 2 × 1; Because of q
pbe the subpoint of q on tangent line, thus position is departed from tangent line mutually orthogonal; If current location is positioned at tunnel internal, so reference position is current location, otherwise reference position is just arranged in tunnel wall.
Step S22: utilize impedance adjustment, converts the active joint moment embodying patient motion intention to corresponding actual motion: in joint space, adopt location-based impedance adjustment, realized, as shown in Figure 4 by double-closed-loop control structure.Impedance Control outer shroud produces the adjustment amount of position, speed and acceleration by reverse impedance equation, revises reference locus, regulates the Interaction Force of lower limb and pedipulator; Set up the man-machine interface possessing active compliance; make the moment that the motion Initial adaption lower limb of pedipulator produce; guarantee that patient comfort completes active training naturally; even if in emergency; abnormal movement-the spasm of such as lower limb muscles, to tremble, also can guarantee patient's safety in the training process.
Step S221: impedance Control, by reverse impedance equation, shrinks the joint moment τ produced according to lower limb muscles
hproduce position, speed and acceleration adjustment amount, revise reference locus, reach the object of the Interaction Force regulating lower limb and pedipulator;
Step S222: after utilizing position, speed, acceleration adjustment amount to revise reference movement locus, obtain position, speed and acceleration instruction, and it can be used as the reference signal of position servo control, position control is by the PD algorithm realization with BP neural networks compensate; When lower limb do not produce any active moment, i.e. τ
h=0, system will keep inactive state at tunnel internal, and when system motion is to tunnel outer, elasticity wall can be attempted to be withdrawn into tunnel internal.
Step S23: set up self adaptation active compliance environment, with in the training process for patient provides tactile feedback, encourages patient to move according to appointment directed walk; First by the active joint moment of patient's lower limb, along both direction-just, tangential and positive normal decomposes, and then according to two components and the position offset of active moment, adopts the method adjustment impedance parameter of fuzzy logic.
Step S231: be the motion intention of clear and definite patient, according to the directed walk of specifying and real-time joint position, the active moment of lower limb will be broken down into two components:
τ
h=τ
td
t+τ
ed
e
Wherein, d
trepresent and specify subpoint q on directed walk
pthat locates is just tangential, and it is actually the designated movement direction at subpoint place on task path, d
erepresent subpoint place positive normal, q is departed from it and position
edirection consistent, point to current actual positions by subpoint, τ
tand τ
erepresent τ respectively
halong the component of above-mentioned both direction; If τ
tbe one on the occasion of, show the positive direction of the motion intention of patient on tangential along specified path, negative value then shows along negative direction; If τ
ebe greater than zero, show that the motion intention of patient in normal direction is away from specified path, be less than zero and represent that intention is close; Null value on any one direction represents that the party does not upwards have active movement to be intended to, as shown in Figure 5, current physical location is positioned at the inside of specified path, initiatively moment is negative at tangent component upwards, represent that patient is intended to resist the direction of specifying and moves, initiatively the component of moment on positive normal is just, represents that patient is intended to principle specified path.As shown in Figure 6, current physical location is positioned at outside specified path, and initiatively moment is just at tangent component upwards, represents that patient's intention is moved along the direction of specifying, initiatively the component of moment on positive normal is negative, represents that patient is intended near specified path.
Step S232: the tangent line of the subpoint on specified path can by straight line
be similar to, therefore the just tangential column vector in order to lower 2 × 1 represents:
Because each element in position sequence is unique, so
always set up, above formula there will not be unusual state;
Step S233: the initiatively projection of joint moment on positive normal, under nonsingular state, namely || q
e|| ≠ 0, time, it can according to a
etry to achieve, otherwise, be set to d
tone of them normal direction:
Wherein, d
tirepresent d
ti-th element.Q
ebe orthogonal to straight line
d can be obtained
t⊥ d
e, || d
t||=1 and || d
e||=1, wherein ⊥ is orthogonal symbols, thus initiatively joint moment can respectively by formula in the projection just tangentially and on positive normal
with
try to achieve.
Step S234: by decomposing initiatively moment, obtain patient in the motion intention tangentially and in normal direction, when patient is intended to antagonism specified path, increases the impedance of active movement, otherwise reduces impedance, thus set up an adaptive haptic interface; Fuzzy logic is adopted to carry out impedance adjustment, initiatively two component τ of joint moment
tand τ
eand positional offset amount || q
e|| as the input variable of fuzzy logic, wherein || || represent Euclid 2-norm operator; Three input variables define three fuzzy set: N (Negative), Z (Zero) and P (Positive) separately.As shown in Figure 7, Triangleshape grade of membership function is used to carry out obfuscation to input variable, in figure, τ
tmin, τ
minwith || q
e||
minrepresent the lower limit of input variable, and τ
tmax, τ
emaxwith || q
e||
maxthen represent its upper limit, its value is as shown in table 1.
Table 1 pair fuzzy logic input variable carries out the upper lower limit value of obfuscation
τ tmax | τ emax | ||q e|| max | τ tmin | τ emin | ||q e|| min |
8(Nm) | 40(Nm) | 0.03(rad) | -8(Nm) | -40(Nm) | -0.03(rad) |
Step S235: adopt zeroth order Sugeno model as fuzzy reasoning method, the output item of fuzzy rule is a constant, as shown in table 2.Wherein, z represents the output variable of fuzzy rule, and U represents fuzzy complete or collected works,
with
represent the supplementary set of N and Z respectively.
Table 2 fuzzy inference rule
Because the output of every bar fuzzy rule is the real number determined, adopt weighted mean method to carry out defuzzification to fuzzy logic output variable at this, obtain well-determined output quantity z; The output of every rule is using the degree of membership of this rule self as weight:
Wherein, z
jrepresent the output of jth rule, use Zadeh operator to derive the degree of membership of this rule:
μ(z
j)=min(μ
j(τ
t),μ
j(τ
e),μ
j(||q
e||)
Wherein μ
j(τ
t), μ
j(τ
e) and μ
j(|| q
e|| be illustrated respectively in input variable τ in regular j
t, τ
ewith || q
e||.Impedance parameter is calculated as follows:
Wherein, coefficient z is an arithmetic number being less than or equal to 1, the positive definite diagonal matrix M of 3 × 3
max, B
maxand K
maxrepresent the upper limit of impedance parameter, M
min, B
minand K
minrepresent its lower limit, be all the positive definite diagonal matrix of 3 × 3, its upper lower limit value is as shown in table 3.
Table 3 impedance parameter upper lower limit value
For avoiding the vibration of movement position, impedance parameter must meet inequality
wherein m
i, b
ii-th diagonal element of M, B and K is represented respectively with k; Therefore, the bound of impedance parameter meets constraint:
Wherein, m
imax, b
imaxand k
imaxrepresent M respectively
max, B
maxand K
maxi-th diagonal element, m
imin, b
iminand k
iminrepresent M respectively
min, B
minand K
mini-th diagonal element.
Joint space puts on the active moment τ of pedipulator
hform by two, be respectively tangentially with the moment of normal direction, as follows:
Wherein direction vector d
c=[d
t2-d
t1]
t, it is by just tangential d
tturn clockwise 90 ° and obtain; According to the reaction time of most people, direction vector d
tand d
cupdate cycle is 0.2s; Sinusoidal silver in normal direction moment item is used for simulating the shake of lower limb, and its frequency is 1Hz.
Fig. 8 A-8D is the result adopting task orientation formula active training, and the movement resistance in the method is determined jointly by the active moment of position deviation and patient.As shown in the 13s < t < 14s period, when patient attempts to move in the other direction, impedance adjustment factor increases, and the active movement of patient becomes difficulty, provides passive tactile feedback.As be labeled as " A " in figure period shown in, position deviation continues to reduce, but there is the change first reducing to increase afterwards in impedance adjustment factor, this is because original position deviation is larger, and normal direction active moment is negative, namely along the direction that deviation reduces, now movement resistance reduces to be supplied to patient's tactile feedback energetically; But along with the reduction of deviation and the increase of negative normal direction active moment, need to increase movement resistance and significantly surmount specified path to avoid hybrid system, cause larger position deviation.As be labeled as " B " in figure period shown in, originally hybrid system crosses specified path, and position deviation continues to increase, and normal direction initiatively moment just be, namely depart from the direction of increase along position, so movement resistance increase is with the tactile feedback being supplied to patient's passiveness; But along with normal direction active moment reduces gradually, and from just becoming negative (normal direction moment becomes towards specified path from deviating from specified path), movement resistance reduces again.At " B " in the period, in Fig. 8 C, the concussion of position deviation is interacted by the wall of hybrid system and virtual channel and produced equally.In 0s < t < 13s, impedance adjustment factor mean value under task orientation formula active training method is 0.3949, position deviation mean-square value is 0.0130, achieves and completes active training task more accurately with less movement resistance.
Therefore guarantee the movement locus of rehabilitation training, be applied to and possess good uniformity alternately between dynamics in suffering limb and patient-robot; For patient create one safe, comfortable, natural and possess the training environment of active compliance, avoid suffering limb due to spasm, the abnormal secondary damage caused of muscle activity such as tremble; Can obtain patient's active movement intention, encourage patient to play an active part in motion, realize so-called active training, thus raising rehabilitation efficacy is the break-through point in rehabilitation medical.
Above-described specific embodiment; object of the present invention, technical scheme and beneficial effect are further described; be understood that; the foregoing is only specific embodiments of the invention; be not limited to the present invention; within the spirit and principles in the present invention all, any amendment made, equivalent replacement, improvement etc., all should be included within protection scope of the present invention.
Claims (6)
1. a task orientation formula active training control method, be applied in healing robot, described healing robot has sensing device, control system and driving mechanism, the signal generation control instruction that control system gathers for receiving sensing device, and control instruction is sent to driving mechanism, driving mechanism can wear the body part in patient, receive described control instruction, apply according to control instruction and regulate the active force to patient body part, to control the rehabilitation training of patient, it is characterized in that, described control method comprises the steps:
The active movement signal of S1, detection patient body part;
S2, active movement signal according to patient body part, regulate the driving mechanism of healing robot to the active force of patient body part.
2. task orientation formula active training control method as claimed in claim 1, it is characterized in that, described active movement signal is the active joint moment of patient, and described step S2 comprises:
S21, set up the directed walk corresponding with the motor task of patient, its closest approach of distance on the joint position of body part and this directed walk according to patient, sets up a virtual channel as reference position around specified path;
S22, convert active joint moment to corresponding actual motion, according to the position calculation position of virtual tunnel, speed and acceleration adjustment amount, obtain the control instruction of position, speed and acceleration, and it can be used as control signal to control driving mechanism;
S23, the active joint moment of patient body part to be decomposed along just tangential and positive normal, according to two components and the position offset of active moment, adopt the method for fuzzy logic to regulate impedance parameter.
3. task orientation formula active training control method as claimed in claim 2, it is characterized in that, described step S21 comprises:
Step S211: specify directed walk by a two-dimensional sequence Q in the joint space shown in following formula
srepresent:
Q
s:{q
i=[q
i,1q
i,2]
T|i=1,...,L}
Wherein, q
irepresent Q
si-th element, q
i, jrepresent q
ia jth element, L is Q
sthe number of middle element;
Step S212: by intermediate variable equally spaced uniform discrete in its domain of definition, obtain terminal position sequence by parametrization equation, utilize inverse kinematics equation that end sequence is transformed into joint space;
Step S213: find the point that distance current location in position sequence is nearest
I
*=argmin
i=1 ..., L-1|| q
i-q||, wherein i
*represent the sequence number of closest approach;
Step S214: use closest approach
with the next point in sequence
determine straight line, this straight line is used as the tangent line at closest approach place on specified path approx:
Wherein
Represent straight line
slope,
represent the intercept of this straight line; q
pbe used to replace
be used as the closest approach of distance current joint position on specified path;
Step S215: according to its closest approach of distance on real-time joint position and specified path, determine the reference position q in training process
r:
Thus around specified path, establish a virtual tunnel to limit the active movement of patient.
4. task orientation formula active training control method as claimed in claim 2, it is characterized in that, described step S22 comprises:
Step S221: by reverse impedance equation, according to the joint moment τ that patient self produces
hproduce position, speed and acceleration adjustment amount, revise reference locus, to regulate the Interaction Force of patient body part and driving mechanism;
Step S222: after utilizing position, speed, acceleration adjustment amount to revise reference movement locus, obtain position, speed and acceleration instruction, and it can be used as the reference signal of position servo control.
5. task orientation formula active training control method as claimed in claim 2, it is characterized in that, described step S23 comprises:
Step S231: according to the directed walk of specifying and real-time joint position, the active moment of patient body part is decomposed into two components:
τ
h=τ
td
t+τ
ed
e,
Wherein, d
trepresent and specify subpoint q on directed walk
pthat locates is just tangential, d
erepresent subpoint place positive normal, q is departed from it and position
edirection consistent, point to current actual positions by subpoint, τ
tand τ
erepresent τ respectively
halong the component of above-mentioned both direction;
Step S232: the tangent line of the subpoint on specified path can by straight line
be similar to, the just tangential column vector in order to lower 2 × 1 represents:
Step S233: the initiatively projection of joint moment on positive normal, under nonsingular state, namely || q
e|| ≠ 0, time, it can according to q
etry to achieve, otherwise, be set to d
tone of them normal direction:
Wherein, d
tirepresent d
ti-th element, q
ebe orthogonal to straight line
d can be obtained
t⊥ d
e, || d
t||=1 and || d
e||=1, wherein ⊥ is orthogonal symbols, thus initiatively joint moment can respectively by formula in the projection just tangentially and on positive normal
with
try to achieve;
Step S234: by decomposing initiatively moment, obtain patient in the motion intention tangentially and in normal direction, when patient is intended to antagonism specified path, increases the impedance of active movement, otherwise reduces impedance.
6. task orientation formula active training control method as claimed in claim 5, is characterized in that, in step S234, adopts fuzzy logic to carry out impedance adjustment, initiatively two component τ of joint moment
tand τ
eand positional offset amount || q
e|| as the input variable of fuzzy logic, wherein || || represent Euclid 2-norm operator.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410799839.6A CN104492066B (en) | 2014-12-18 | 2014-12-18 | Task-oriented active training control method |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410799839.6A CN104492066B (en) | 2014-12-18 | 2014-12-18 | Task-oriented active training control method |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104492066A true CN104492066A (en) | 2015-04-08 |
CN104492066B CN104492066B (en) | 2017-02-22 |
Family
ID=52933571
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410799839.6A Active CN104492066B (en) | 2014-12-18 | 2014-12-18 | Task-oriented active training control method |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104492066B (en) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106475999A (en) * | 2016-12-23 | 2017-03-08 | 东南大学 | The acceleration control method of the Dual-Arm Coordination based on impedance model under hard conditions |
CN110265112A (en) * | 2019-07-17 | 2019-09-20 | 北京航空航天大学 | A kind of three-dimensional gait recovery training method of lower limb rehabilitation robot |
CN110355780A (en) * | 2018-04-09 | 2019-10-22 | 中国科学院宁波材料技术与工程研究所 | The output torque calculation method of integrated flexible joint of robot |
CN110639177A (en) * | 2019-09-25 | 2020-01-03 | 深圳市丞辉威世智能科技有限公司 | Rehabilitation training method, device, equipment and medium |
CN110730934A (en) * | 2018-08-01 | 2020-01-24 | 深圳市大疆创新科技有限公司 | Method and device for switching track |
CN112274865A (en) * | 2020-10-30 | 2021-01-29 | 中国科学院自动化研究所 | On-demand auxiliary adaptive control method and system for lower limb rehabilitation robot |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101061984A (en) * | 2006-04-29 | 2007-10-31 | 香港理工大学 | Recovery robot system for providing mechanical assistant by using myoelectric signal and the training method thereof |
CN101301250A (en) * | 2008-07-08 | 2008-11-12 | 哈尔滨工业大学 | Five-freedom degree dermaskeleton type upper limb rehabilitation robot interactive rehabilitation training control policy |
WO2009040808A1 (en) * | 2007-09-25 | 2009-04-02 | Ilan Mandil | Abdominal muscle exercise apparatus and method |
CN102698411A (en) * | 2012-06-29 | 2012-10-03 | 中国科学院自动化研究所 | Recumbent lower limb rehabilitation robot and corresponding active exercise control method |
CN104027218A (en) * | 2014-06-05 | 2014-09-10 | 电子科技大学 | Rehabilitation robot control system and method |
-
2014
- 2014-12-18 CN CN201410799839.6A patent/CN104492066B/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101061984A (en) * | 2006-04-29 | 2007-10-31 | 香港理工大学 | Recovery robot system for providing mechanical assistant by using myoelectric signal and the training method thereof |
WO2009040808A1 (en) * | 2007-09-25 | 2009-04-02 | Ilan Mandil | Abdominal muscle exercise apparatus and method |
CN101301250A (en) * | 2008-07-08 | 2008-11-12 | 哈尔滨工业大学 | Five-freedom degree dermaskeleton type upper limb rehabilitation robot interactive rehabilitation training control policy |
CN102698411A (en) * | 2012-06-29 | 2012-10-03 | 中国科学院自动化研究所 | Recumbent lower limb rehabilitation robot and corresponding active exercise control method |
CN104027218A (en) * | 2014-06-05 | 2014-09-10 | 电子科技大学 | Rehabilitation robot control system and method |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106475999A (en) * | 2016-12-23 | 2017-03-08 | 东南大学 | The acceleration control method of the Dual-Arm Coordination based on impedance model under hard conditions |
CN106475999B (en) * | 2016-12-23 | 2018-11-09 | 东南大学 | The acceleration control method of Dual-Arm Coordination based on impedance model under hard conditions |
CN110355780A (en) * | 2018-04-09 | 2019-10-22 | 中国科学院宁波材料技术与工程研究所 | The output torque calculation method of integrated flexible joint of robot |
CN110730934A (en) * | 2018-08-01 | 2020-01-24 | 深圳市大疆创新科技有限公司 | Method and device for switching track |
CN110265112A (en) * | 2019-07-17 | 2019-09-20 | 北京航空航天大学 | A kind of three-dimensional gait recovery training method of lower limb rehabilitation robot |
CN110639177A (en) * | 2019-09-25 | 2020-01-03 | 深圳市丞辉威世智能科技有限公司 | Rehabilitation training method, device, equipment and medium |
CN112274865A (en) * | 2020-10-30 | 2021-01-29 | 中国科学院自动化研究所 | On-demand auxiliary adaptive control method and system for lower limb rehabilitation robot |
Also Published As
Publication number | Publication date |
---|---|
CN104492066B (en) | 2017-02-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104492066A (en) | Task-oriented active training control method and corresponding rehabilitation robot | |
KR102550887B1 (en) | Method and apparatus for updatting personalized gait policy | |
Wang et al. | α-Variable adaptive model free control of iReHave upper-limb exoskeleton | |
EP2011551B1 (en) | Exercise management system | |
EP2011552A1 (en) | Exercise management system, exercise management method, and exercise management program | |
CN109223453B (en) | Power-assisted exoskeleton device based on regular walking gait learning | |
Sun et al. | Automatic navigation for rat-robots with modeling of the human guidance | |
Taha et al. | A hybrid active force control of a lower limb exoskeleton for gait rehabilitation | |
Duenas et al. | Distributed repetitive learning control for cooperative cadence tracking in functional electrical stimulation cycling | |
Zhang et al. | Motion generation for walking exoskeleton robot using multiple dynamic movement primitives sequences combined with reinforcement learning | |
Lv et al. | Model reference adaptive impedance control in lower limbs rehabilitation robot | |
Xu et al. | Learning robotic motion with mirror therapy framework for hemiparesis rehabilitation | |
Taherifar et al. | Assistive-compliant control of wearable robots for partially disabled individuals | |
Hao et al. | Hierarchical Task-Oriented Whole-Body Locomotion of a Walking Exoskeleton Using Adaptive Dynamic Motion Primitive for Cart Pushing | |
Huq et al. | Development of a fuzzy logic based intelligent system for autonomous guidance of post-stroke rehabilitation exercise | |
Chen et al. | Step length adaptation for walking assistance | |
Ueyama | System identification of neural mechanisms from trial-by-trial motor behaviour: modelling of learning, impairment and recovery | |
KR102544549B1 (en) | Simulation method for designing a wearable device supporting the human body and devices performing the same | |
Moon et al. | Hybrid half-Gaussian selectively adaptive fuzzy control of an actuated ankle–foot orthosis | |
Wannawas et al. | Towards ai-controlled fes-restoration of arm movements: Controlling for progressive muscular fatigue with gaussian state-space models | |
Kalani et al. | Assistive Control of a Hip Exoskeleton Robot, using a DQN-Adjusted Delayed Output Feedback Method | |
Boudville et al. | GA-tuned fuzzy logic control of knee-FES-ergometer for knee swinging exercise | |
Wang et al. | Probabilistic movement primitive based motion learning for a lower limb exoskeleton with black-box optimization | |
Dong et al. | A Motion Planning Method Based on HRL for Autonomous Exoskeleton | |
Zhang et al. | A human-robot interaction based coordination control framework for walking assist |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |