CN105326627A - Trunk center-of-gravity shift based rehabilitation device walking triggering control method - Google Patents
Trunk center-of-gravity shift based rehabilitation device walking triggering control method Download PDFInfo
- Publication number
- CN105326627A CN105326627A CN201510834976.3A CN201510834976A CN105326627A CN 105326627 A CN105326627 A CN 105326627A CN 201510834976 A CN201510834976 A CN 201510834976A CN 105326627 A CN105326627 A CN 105326627A
- Authority
- CN
- China
- Prior art keywords
- trunk
- motor
- user
- hip
- lower limb
- 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
Classifications
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H3/00—Appliances for aiding patients or disabled persons to walk about
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H3/00—Appliances for aiding patients or disabled persons to walk about
- A61H2003/005—Appliances for aiding patients or disabled persons to walk about with knee, leg or stump rests
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H3/00—Appliances for aiding patients or disabled persons to walk about
- A61H2003/007—Appliances for aiding patients or disabled persons to walk about secured to the patient, e.g. with belts
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H2201/00—Characteristics of apparatus not provided for in the preceding codes
- A61H2201/50—Control means thereof
- A61H2201/5007—Control means thereof computer controlled
-
- A—HUMAN NECESSITIES
- A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
- A61H—PHYSICAL THERAPY APPARATUS, e.g. DEVICES FOR LOCATING OR STIMULATING REFLEX POINTS IN THE BODY; ARTIFICIAL RESPIRATION; MASSAGE; BATHING DEVICES FOR SPECIAL THERAPEUTIC OR HYGIENIC PURPOSES OR SPECIFIC PARTS OF THE BODY
- A61H2230/00—Measuring physical parameters of the user
- A61H2230/62—Posture
- A61H2230/625—Posture used as a control parameter for the apparatus
Landscapes
- Health & Medical Sciences (AREA)
- Epidemiology (AREA)
- Pain & Pain Management (AREA)
- Physical Education & Sports Medicine (AREA)
- Rehabilitation Therapy (AREA)
- Life Sciences & Earth Sciences (AREA)
- Animal Behavior & Ethology (AREA)
- General Health & Medical Sciences (AREA)
- Public Health (AREA)
- Veterinary Medicine (AREA)
- Rehabilitation Tools (AREA)
Abstract
The invention discloses a trunk center-of-gravity shift based rehabilitation device walking triggering control method. The method comprises the following steps: (1) judging a parallel standing posture; (2) judging walking triggering conditions, namely analyzing and processing, by a control module, data acquired by a sensor to judge whether the following conditions are met: if the conditions C5 and C7 are met at the same time, a triggering condition for striding a right leg is met; if the conditions C6 and C8 are met at the same time, a triggering condition of striding a left leg is met; and if the conditions C5 and C7 or the conditions C6 and C8 are not met at the same time, the control module continuously detects the data of the sensor so as to judge the user posture; (3) controlling walking triggering; and (4) continuously detecting the data by the control module to judge the inclination angle of the trunk, the pressure of the sole of a foot and the data of a crutch pressure sensor so as to enter a walking maintenance state. According to the method disclosed by the invention, a trunk inclination angle sensor is adopted, a crutch touchdown pressure sensor judges the gravity center of a user, and then under the premise of ensuring the safety of the user, the triggering control from the parallel standing posture to a walking state is realized.
Description
Technical field
The present invention relates to a kind of convalescence device ambulation control method, particularly relate to a kind of walking trigger control method of the bionic exoskeleton convalescence device based on trunk centre-of gravity shift, belong to rehabilitative engineering technology field.Wearable bionic exoskeleton pedipulator convalescence device is called for short convalescence device.
Background technology
In recent years, due to the fast development of economic technology, transport facility gets more and more, and shows according to correlation study data, the road accident rate of China is 8 times of developed country, causes the number of nerve centre damage or limb injury always in rising trend because of vehicle accident.Meanwhile, along with the raising of living standards of the people, the people suffering from cardiovascular and cerebrovascular disease or nervous system disease at present gets more and more, and also presents rejuvenation trend in years, and this kind of most patients is with hemiplegia symptom.For the patient paralysed completely, pure Drug therapy and operative treatment cannot make the thorough rehabilitation of patient, therefore, need the means by rehabilitation engineering to go the function improved or replacement paralytic loses.Wearable bionic exoskeleton pedipulator convalescence device; be worn on user lower limb and lower back; the functions such as such as power-assisted, protection, body-support are provided for user; the roboticses such as sensing, control, acquisition of information, mobile computing have been merged again simultaneously; making this convalescence device can complete certain function and task under control of the user, is typical human-machine system.This walking power assisting device can reduce the disease such as pressure ulcer and amyotrophy that paralyses patient long-term bed or wheelchair cause, help them to stand and walk, improve its quality of life, and alleviating the financial burden of patient home and society, the wearable bionic exoskeleton pedipulator convalescence device that research and development more meet the safety and reliability of Consumer's Experience has very important practical significance.
Summary of the invention
The object of the invention is to the safety for ensureing user, a kind of walking trigger control method of the bionic exoskeleton pedipulator based on trunk centre-of gravity shift being provided, the transformation process of the parallel midstance of user to walking states is controlled.
The object of the invention is to be achieved through the following technical solutions:
Based on the convalescence device walking trigger control method of trunk centre-of gravity shift, comprise the steps:
1) judgement of parallel midstance: the data that control module analyzing and processing sensor acquisition arrives, judges whether to meet following 4 condition: C1 simultaneously:
c2:
c3:|F
pl?F
pr|/F
p<10%; C4:F
c>0, | F
cl?F
cr|/F
c<5%; If control module detects sensing data and to satisfy condition C1, C2, C3, C4, user is in parallel midstance; If do not meet the arbitrary condition in above-mentioned 4 conditions, then it not parallel midstance;
2) judgement of trigger condition of walking: the data that control module analyzing and processing sensor acquisition arrives, judge whether to meet the following conditions: C5:
or C6:
c7:F
c>0, F
cl>F
cror C8:F
c>0, F
cl<F
cr; If satisfy condition C5, C7 simultaneously, then meet the trigger condition first stepping right lower limb; If satisfy condition C6, C8 simultaneously, then meet the trigger condition first stepping left lower limb; C5, C7 or do not satisfy condition C6, C8 if do not satisfy condition simultaneously simultaneously, control module continues detecting sensor data, judges user's attitude;
3) walking trigging control: if control module detects that user meets the trigger condition of right lower limb advanced in years, control module to the right hip motor and right knee joint motor sends instruction, performs and steps right lower limb action: hip motor starts with acceleration a
0evenly speed v is accelerated to from static
0, then with speed v
0rotate, drive user's trunk and thigh to produce relative angular movement, make angle ∠ between trunk support and thigh support frame
right hipreduce; Knee motor starts with acceleration a simultaneously
1evenly speed v is accelerated to from static
1, then with speed v
1rotate, drive thigh and shank to produce relative angular movement, make the angle ∠ between thigh support frame and little leg support
right knee jointreduce, until control module detects
control knee motor with acceleration-a
1even be decelerated to static; Hip motor continues to rotate, until control module detects
control knee motor to rotate backward, with acceleration a
1the even speed that accelerates to is to v
1, then with speed v
1rotate, drive thigh and shank to produce relative angular movement, make the angle ∠ between thigh support frame and little leg support
right knee jointincrease; Control module continues to detect ∠
right hip, until detect
control hip motor with acceleration-a
0even be decelerated to static; Knee motor continues with speed v
1rotate, until control module detects
control knee motor with acceleration-a
1even be decelerated to static, release of taking a step, user to enter before right crus of diaphragm attitude after left foot;
If control module detects that user meets the trigger condition of left lower limb advanced in years, control module left hip motor and left knee joint motor sends instruction, performs and steps left lower limb action, until release, to enter before left foot state after right crus of diaphragm; Execution left lower limb action advanced in years is all left and right lower limb mutually with right lower limb action advanced in years and exchanges, and control mode is identical;
4) control module continues to detect the data judging trunk inclination angle, foot force and crutch pressure transducer, enters gait maintenance state;
Described ∠
front and backfor inclination angle before and after trunk; Described ∠
left and rightfor inclination angle, trunk left and right; F
plfor the independent pressure of left foot; F
prfor the independent pressure of right crus of diaphragm; F
clfor cane pressure of turning left; F
cr.for cane pressure of turning right; F
cfor remove two crutch pressure after crutch self gravitation and; ∠
knee jointfor the angle between thigh support frame and little leg support; ∠
hipfor the angle between thigh support frame and trunk support; ∠
left knee jointfor left knee joint angle; ∠
right knee jointfor right knee joint angle; ∠
left hipfor left Hip Angle; ∠
right hipfor right Hip Angle.
For realizing the object of the invention further, preferably, described ∠
front and backfor with trunk vertical ground for benchmark, the angle that trunk tilts forward and back, lean forward as just, hypsokinesis is negative.Described ∠
left and rightfor with trunk vertical ground for benchmark, the angle that trunk tilts; "Left"-deviationist is just, Right deviation is negative.
Preferably, if original state does not meet the condition of parallel midstance, control centre initiates a message to voice module, and reminding user adjustment attitude, until detect that user is parallel midstance; User guides adjustment body posture according to the concrete operations in voice message; If condition C 1 does not meet, voice module prompting user " please keep trunk upright, not tilt to the left and right or tilt forwards, backwards "; If condition C 2 does not meet, voice module prompting user " please keep both legs upright, adjust the left knee joint of left hip or the right knee joint angle of right hip "; If condition C 3 does not meet, voice module shows that user " please make double-legged uniform stressed "; If condition C 4 does not meet, voice module prompting user " please use crutch, and make two crutch uniform stresseds ".
A
0for hip motor start rotate acceleration , ?a
0for hip motor terminates the acceleration of rotation, a
1for knee motor start rotate acceleration , ?a
1for knee motor terminates the acceleration of rotation, v
0for the velocity of rotation of hip motor, v
1for the velocity of rotation of knee motor, a
0, a
1, v
0, v
1numerical value by the joint rotating speed gained measured in lower limb able-bodied walking process, and relevant with the parameter of electric machine that wearable bionic exoskeleton pedipulator convalescence device uses.Preferably, described a
0value be
a
1value be
v
0value be
v
1value be
Preferably, described control module is connected with left lower limb hip motor angle sensor, right lower limb hip motor angle sensor, left lower limb knee motor angle sensor, right lower limb knee motor angle sensor, left foot foot bottom pressure sensor, right crus of diaphragm foot bottom pressure sensor, left lower limb hip motor, trunk obliquity sensor, right lower limb hip motor, left lower limb knee motor and right lower limb knee motor respectively.
Preferably, the trunk support of described convalescence device is bundled in user's upper body; Thigh support frame is bundled on user's thigh, and little leg support is bundled on user's shank; Foot support plate is arranged at the bottom of user's foot; Trunk support is connected by hip motor with thigh support frame; Stator and the trunk support of hip motor are fixed, and rotor and the thigh support frame of hip motor are fixed; The stators and rotators of thigh support frame and little leg support difference knee motor is connected; Knee motor is connected to thigh support frame and little leg support and relative angular movement both controlling; Little leg support is flexibly connected with foot support plate.
Convalescence device of the present invention is wearable bionic exoskeleton pedipulator convalescence device, comprises trunk support, thigh support frame, little leg support, hip motor, hip motor angle sensor, knee motor, knee motor angle sensor, foot bottom pressure sensor, trunk obliquity sensor, bandage, control module, watch, crutch, the pressure transducer that contacts to earth, foot support plate, voice cue module.The present invention, according to current kinetic pattern, gather various sensor signal identification user current pose, and drive motors performs the action that meets user's current pose.
Relative to prior art, tool of the present invention has the following advantages:
1) principle that the present invention uses trunk obliquity synchronous with centre-of gravity shift position triggers walks.The present invention adds crutch especially and to contact to earth pressure transducer, and this sensor transmits data by the mode of radio communication to control module.When control module detects that the data of trunk obliquity sensor meet centre-of gravity shift, also must judge whether the contact to earth data of pressure transducer of crutch exceed threshold value, if crutch contacts to earth, the data of pressure transducer also exceed threshold value, then judge that user meets trigger condition, just travel commands is sent to motor, otherwise continue keeping parallelism midstance.
2) the present invention adopts trunk obliquity sensor to turn to contact to earth with cane the attitude of pressure transducer coordinated to user to detect in real time, and this pair of Rule of judgment triggering method avoids the false triggering risk of single triggering mode, has ensured the safety of user.
3), the process that the present invention controls from parallel midstance to the conversion of walking states user, adopt trunk obliquity sensor and crutch to contact to earth pressure two Rule of judgment, add the reliability of trigging control.
Accompanying drawing explanation
Fig. 1 is wearable bionic exoskeleton pedipulator convalescence device integral mechanical structure figure;
Fig. 2 is wearable bionic exoskeleton pedipulator convalescence device corn module block diagram;
Fig. 3 (a) is the support angle schematic diagram observed from right front;
Fig. 3 (b) is the support angle schematic diagram observed from right;
Fig. 4 (a) is the trunk forward angle schematic diagram observed from right;
Fig. 4 (b) is the trunk back rake angle schematic diagram observed from right;
Fig. 4 (c) is from the left-leaning angle of the trunk of forward observation and Right deviation angle schematic diagram;
Fig. 5 is the decomposition of movement figure that takes a step;
Fig. 6 is the flow chart of the walking trigger control method of wearable bionic exoskeleton pedipulator convalescence device based on trunk centre-of gravity shift.
Shown in figure: trunk support 1, thigh support frame 2, little leg support 3, hip motor 4, hip motor angle sensor 5, knee motor 6, knee motor angle sensor 7, foot bottom pressure sensor 8, trunk obliquity sensor 9, bandage 10, control module 11, watch 12, crutch 13, contact to earth pressure transducer 14, foot support plate 15, voice module 16, left lower limb hip motor angle sensor 5_1, right lower limb hip motor angle sensor 5_2, left lower limb knee motor angle sensor 7_1, right lower limb knee motor angle sensor 7_2, left foot foot bottom pressure sensor 8_1, right crus of diaphragm foot bottom pressure sensor 8_2, cane of turning left contacts to earth pressure transducer 14_1, cane of turning right contacts to earth pressure transducer 14_2, left lower limb hip motor 4_1, right lower limb hip motor 4_2, left lower limb knee motor 6_1 and right lower limb knee motor 6_2.
Detailed description of the invention
Below in conjunction with accompanying drawing, the present invention is described further, but embodiment does not form limiting the scope of the present invention.
Fig. 1 is the integral mechanical structure schematic diagram of wearable bionic exoskeleton pedipulator convalescence device.As shown in Figure 1, ectoskeleton pedipulator convalescence device mainly comprises trunk support 1, thigh support frame 2, little leg support 3, hip motor 4, hip motor angle sensor 5, knee motor 6, knee motor angle sensor 7, foot bottom pressure sensor 8, trunk obliquity sensor 9, control module 11, watch 12, crutch 13, the pressure transducer 14 that contacts to earth, foot support plate 15, voice cue module 16; Wherein, hip motor 4 comprises left lower limb hip motor 4_1 and right lower limb hip motor 4_2; Hip motor angle sensor 5 comprises left lower limb hip motor angle sensor 5_1 and right lower limb hip motor angle sensor 5_2; Knee motor 6 comprises left lower limb knee motor 6_1 and right lower limb knee motor 6_2; Knee motor angle sensor 7 comprises left lower limb knee motor angle sensor 7_1 and right lower limb knee motor angle sensor 7_2; Foot bottom pressure sensor 8 comprises left foot foot bottom pressure sensor 8_1 and right crus of diaphragm foot bottom pressure sensor 8_2; The pressure transducer 14 that contacts to earth comprises contact to earth pressure transducer 14_1 and cane of turning right of cane of turning left and to contact to earth pressure transducer 14_2; Crutch 13 has two, and the right-hand man respectively by user holds.Control module 11 is arranged on the back of user.
Trunk support 1 is bundled in user's upper body; Thigh support frame 2 is bundled on user's thigh, and little leg support 3 is bundled on user's shank; Foot support plate 15 is arranged at the bottom of user's foot; Described binding is bound by bandage 10; Trunk support 1 is connected by hip motor 4 with thigh support frame 2; Stator and the trunk support 1 of hip motor 4 are fixed, and rotor and the thigh support frame 2 of hip motor 4 are fixed; When hip motor 4 rotates, be fixed on trunk support on stator 1 and be fixed on epitrochanterian thigh support frame 2 by the driven by motor of rotating and produce relative angular movement; Relative angular movement both hip motor 4 controls; The stators and rotators of thigh support frame 2 and little leg support 3 difference knee motor 6 is connected; Knee motor 6 is connected to thigh support frame 2 with little leg support 3 and relative angular movement both controlling; Little leg support 3 is flexibly connected with foot support plate 15.
Left lower limb hip motor angle sensor 5_1 and right lower limb hip motor angle sensor 5_2 is separately positioned on left lower limb hip motor 4_1 and right lower limb hip motor 4_2; Left lower limb knee motor angle sensor 7_1 and right lower limb knee motor angle sensor 7_2 arranges on left lower limb knee motor 6_1 and right lower limb knee motor 6_ respectively; Left foot foot bottom pressure sensor 8_1 and right crus of diaphragm foot bottom pressure sensor 8_2 is separately positioned in the two foot's gripper shoes 15 of left and right; Cane of turning left contact to earth pressure transducer 14_1 and turn right cane contact to earth pressure transducer 14_2 be separately positioned on left and right two crutch 13 lower ends.Trunk inclination sensor 9 is arranged on trunk support 1.
As shown in Figure 2, control module 11 contacts to earth that pressure transducer 14_1, cane of turning right contact to earth that pressure transducer 14_2, watch 12 are connected respectively with left lower limb hip motor angle sensor 5_1, right lower limb hip motor angle sensor 5_2, left lower limb knee motor angle sensor 7_1, right lower limb knee motor angle sensor 7_2, left foot foot bottom pressure sensor 8_1, right crus of diaphragm foot bottom pressure sensor 8_2, trunk inclination sensor 9, cane of turning left, left lower limb hip motor 4_1, right lower limb hip motor 4_2, left lower limb knee motor 6_1 and right lower limb knee motor 6_2 connect.Watch 12 is used for manually selecting motor pattern; Trunk obliquity sensor 9 detects the angle of inclination of user's trunk; Knee motor angle sensor 7 is in order to detect the corner of knee motor corner; Hip motor angle sensor 5 is in order to detect hip motor corner; Foot bottom pressure sensor 8 detects sole pressure size; Crutch 13, for body support, keeps balance etc. during walking; The pressure transducer 14 that contacts to earth detects crutch 13 pressure size.
Control module 11 can select the i.MX6 serial application processor of Freescale company, adopts USB to carry out, adopts CAN to carry out with the communication of various sensor, adopt less radio-frequency to carry out with the communication of watch with hip motor 4 with communicating of knee motor 6.
Watch 12 is primarily of wireless radio frequency modules and button composition, and wireless radio frequency modules is used for communicating with control module 11, and button is used for selecting " standing ", " sitting down " and " walking " motor pattern.
For the inventive method is described, make as given a definition:
1. define trunk inclination angle, front, Zuo Weizheng, rear, the right side is negative.Before and after trunk, inclination angle is ∠
front and back, as shown in Fig. 4 (a) h and Fig. 4 (b), from left or the right observation of user, with trunk vertical ground for benchmark, the angle that trunk tilts forward and back.Inclination angle, trunk left and right is ∠
left and right, as shown in Fig. 4 (c), with trunk vertical ground for benchmark, the angle that trunk tilts.
2. define P and represent foot bottom pressure sensor, C represents that crutch contacts to earth pressure transducer.Sole gross pressure is designated as F
p,the independent pressure F of left foot
pl, the independent pressure F of right crus of diaphragm
pr.Crutch pressure (having removed crutch self gravitation) is designated as F
c, turn left cane pressure F
cl, turn right cane pressure F
cr..
3. define knee joint angle and be designated as ∠
knee jointfor the angle (see Fig. 3 (a) and Fig. 3 (b)) between thigh support frame 2 and little leg support 3, left knee joint angle is designated as ∠
left knee joint, right knee joint angle is designated as ∠
right knee joint, in conjunction with normal walking states, for ensureing the safety of user, the scope that we limit knee joint angle in walking process is
hip Angle is designated as ∠
hipangle between thigh support frame 2 and trunk support 1) left Hip Angle is designated as ∠
left hip, right Hip Angle is designated as ∠
right hip.
4. defining hip motor speed in walking process is v
0, a
0for its start rotate acceleration , ?a
0for it terminates the acceleration of rotation; Knee motor speed is v
1, a
1for its start rotate acceleration , ?a
1for it terminates the acceleration of rotation.A
0, a
1, v
0, v
1by the joint rotating speed gained measured in lower limb able-bodied walking process, and relevant with the parameter of electric machine that wearable bionic exoskeleton pedipulator convalescence device uses.In the present invention, a
0value be
a
1value be
v
0value be
v
1value be
5. defining user's weight is G.
6. in instantiation, threshold value and scope are empirical value, need be tested in person draw concrete numerical value by user.
Combine walking trigging control flow chart 6 according to above definition, a kind of walking of the convalescence device based on trunk centre-of gravity shift trigger control method, comprises the steps:
1) judgement of parallel midstance.The data that the judgement of parallel midstance and control module 11 analyzing and processing sensor acquisition arrive, judge whether to meet following 4 conditions:
namely trunk is kept upright, and does not tilt forwards, backwards;
namely both legs are upright, and hip joint and knee joint angle are all about
c3:|F
pl?F
pr|/F
p<10%, i.e. two foot force approximately equals; C4:F
c>0, | F
cl?F
cr|/F
c<5%, is namely using crutch and two crutch contact to earth and pressure approximately equal; If control module 11 detects sensing data and to satisfy condition C1, C2, C3, C4, user is in parallel midstance.If do not meet the arbitrary condition in above-mentioned 4 conditions, then it not parallel midstance.For ensureing the safety of user, if original state does not meet the condition of parallel midstance, control centre 11 initiates a message to voice module 16, and reminding user adjustment attitude, until detect that user is parallel midstance.User can guide adjustment body posture according to the concrete operations in voice message.If condition C 1 does not meet, then user can be pointed out " trunk please to be keep upright, do not tilt to the left and right or tilt forwards, backwards "; If condition C 2 does not meet, then point out user " both legs please be keep upright, adjust the left knee joint of left hip or the right knee joint angle of right hip ".If condition C 3 does not meet, then point out user " double-legged uniform stressed please be make "; If condition C 4 does not meet, then user is pointed out " please crutch to be use, and make two crutch uniform stresseds ".
2) judgement of centre-of gravity shift.The data that the judgement of centre-of gravity shift and control module 11 analyzing and processing sensor acquisition arrive, judge whether to meet the following conditions: C5:
or C6:
namely trunk forward angle exceedes threshold value, if satisfy condition C5, shows that trunk is tilted to the left, if satisfy condition C6, shows that trunk is tilted to the right.C7:F
c>0, F
cl>F
cror C8:F
c>0, F
cl<F
cr, namely the contact to earth force value of pressure transducer of two crutch is not 0, and two crutch contact to earth, pressure differential exceedes threshold value, if two crutch pressure meet (F
cl?F
cr)/F
c>40%, then think F
cl>F
cr; If two crutch pressure meet (F
cr?F
cl)/F
c>40%, then think F
cr>F
cl.If satisfy condition C5, C7 simultaneously, show that user's trunk centre-of gravity shift is to the left side, meet the condition stepping right lower limb; If satisfy condition C6, C8 simultaneously, show that user's trunk centre-of gravity shift is to the right, meet the condition stepping left lower limb.If user first steps right lower limb, but do not satisfy condition C5, C7, control module 11 initiates a message to voice module 16, and reminding user adjustment attitude, until detect that user meets the condition of right lower limb advanced in years. simultaneouslyUser can guide adjustment body posture according to the concrete operations in voice message, if condition C 5 does not meet, then can point out user " please by trunk top rake left "; If condition C 7 does not meet, then user can be pointed out " please crutch to be use, and increase cane pressure of turning left, reduce to turn right cane pressure ".If user first steps left lower limb, but do not satisfy condition C6, C8, control module 11 initiates a message to voice module 16, and reminding user adjustment attitude, until detect that user meets the condition of left lower limb advanced in years. simultaneouslyUser can guide adjustment body posture according to the concrete operations in voice message, if condition C 6 does not meet, then can point out user " please by trunk to right anterior oblique "; If condition C 8 does not meet, then user can be pointed out " please crutch to be use, and increase cane pressure of turning right, reduce to turn left cane pressure ".If user does not perform lower limb action advanced in years, then keeping parallelism standing state, control module 11 continues detecting sensor data, judges user's attitude.Use this device initial stage user, we can train user, prevent user's false triggering.
3) walking trigging control.If control module 11 detects user and to satisfy condition C5, C7 simultaneously, then show that user's trunk centre-of gravity shift is to the left side, meet the trigger condition stepping right lower limb, control module 11 to the right hip motor 4_2 and right knee joint motor 6_2 sends instruction, perform and step right lower limb action, step lower limb action as shown in Figure 5 through three phases.Stage one: hip motor 4_2 starts with acceleration a
0evenly speed v is accelerated to from static
0, then with constant speed v
0rotate, drive user's trunk and thigh to produce relative angular movement, make angle ∠ between trunk support 1 and thigh support frame 2
right hipreduce; Knee motor 6_2 starts with acceleration a simultaneously
1evenly speed v is accelerated to from static
1(in walking process, v is set
1=2v
0), then with constant speed v
1rotate, drive thigh and shank to produce relative angular movement, make the angle ∠ between thigh support frame 2 and little leg support 3
right knee jointreduce, until control module 11 detects
control knee motor 6_2 with acceleration-a
1evenly be decelerated to static, realize attitude 1: satisfy condition C5, C9:F simultaneously
pl=(0 ~ 3%) G, F
pr=(60% ~ 80%) G, C10:F
c=20% ~ 40%G, C11:
stage two: hip motor continues 4_2 and rotates, until control module 11 detects
control knee motor 6_2 to rotate backward, with acceleration a
1the even speed that accelerates to is to v
1, then with constant speed v
1rotate, drive thigh and shank to produce relative angular movement, make the angle ∠ between thigh support frame 2 and little leg support 3
right knee jointincrease, realize attitude 2: satisfy condition C1, C9, C10, C12 simultaneously:
stage three: control mould 11 pieces and continue to detect ∠
right hip, until detect
control hip motor 4_2 with acceleration-a
0even be decelerated to static.Knee motor continues with constant speed v
1rotate, until control module 11 detects
(reserved here
safety buffer zone), control knee motor 6_2 with acceleration-a
1even be decelerated to static, release of taking a step, user to enter before right crus of diaphragm after left foot i.e. attitude 3, and satisfy condition C1, C3, C4 and C13 simultaneously:
if control module detects user and to satisfy condition C6, C8 simultaneously, then show that user meets the trigger condition of left lower limb advanced in years, control module left hip motor 4_1 and left knee joint motor 6_1 sends instruction, perform and step left lower limb action (identical with right lower limb action advanced in years), until release, before entering left foot, after right crus of diaphragm, namely state satisfies condition C1, C3, C4 and C14 simultaneously:
control module 11 continues to detect the data judging trunk inclination angle, foot force and crutch pressure transducer, enters gait maintenance state.
Take a step in process, control module 11 to take a step in action executing, except detecting motor angle in real time, to judge whether it reaches threshold value to stop outside electric machine rotation, simultaneously also can the value of each sensor of continuous surveillance whether in normal range.Step left foot action: foot force value scope F
pl=(0 ~ 5%) G, F
pr=(70% ~ 80%) G, crutch contacts to earth range of pressure values F
c>0, | F
cr?F
cl|/F
c=40% ~ 60%, trunk inclination value scope
step foot force value scope F in right crus of diaphragm action
pr=(0 ~ 5%) G, F
pl=(70% ~ 80%) G, crutch contacts to earth range of pressure values F
c>0, | F
cl?F
cr|/F
c=40% ~ 60%, trunk inclination value scope
if the parameters such as force value, trunk inclination value exceed above-mentioned normal time scope and reach 1s, be namely determined as " abnormality ", control module 11 will perform protective measure to user, until receive further instruction to remove " abnormality ".These protective measures include but not limited to: during user's crank, control motor stalls; When user falls down, control voice module 16 and give the alarm to ask other people to rescue.
The present invention's trigger control method of walking has the following advantages: the ambulation control method based on trunk centre-of gravity shift uses the trunk obliquity principle synchronous with centre-of gravity shift position to trigger and walks.This method adds crutch especially and to contact to earth pressure transducer, and this sensor transmits data by the mode of radio communication to control module 11.When control module 11 detects that the data of trunk obliquity sensor meet centre-of gravity shift, also must judge whether the contact to earth data of pressure transducer of crutch exceed threshold value, if crutch contacts to earth, the data of pressure transducer also exceed threshold value, then judge that user meets trigger condition, just travel commands is sent to motor, otherwise continue keeping parallelism midstance, this control method adopts trunk obliquity sensor to turn to contact to earth with cane the attitude of pressure transducer coordinated to user to detect in real time, this pair of Rule of judgment triggering method avoids the false triggering risk of single triggering mode, ensure the safety of user.
It should be noted that, those skilled in the art without departing from the spirit and scope of the present invention, can also make various conversion or modification, belong to equivalent technical solutions of the present invention.
Claims (6)
1., based on the convalescence device walking trigger control method of trunk centre-of gravity shift, it is characterized in that comprising the steps:
1) judgement of parallel midstance: the data that control module analyzing and processing sensor acquisition arrives, judges whether to meet following 4 conditions simultaneously:
c3:|F
pl?F
pr|/F
p<10%; C4:F
c>0, | F
cl?F
cr|/F
c<5%; If control module detects sensing data and to satisfy condition C1, C2, C3, C4, user is in parallel midstance; If do not meet the arbitrary condition in above-mentioned 4 conditions, then it not parallel midstance;
2) judgement of trigger condition of walking: the data that control module analyzing and processing sensor acquisition arrives, judge whether to meet the following conditions:
c7:F
c>0, F
cl>F
cror C8:F
c>0, F
cl<F
cr; If satisfy condition C5, C7 simultaneously, then meet the trigger condition first stepping right lower limb; If satisfy condition C6, C8 simultaneously, then meet the trigger condition first stepping left lower limb; C5, C7 or do not satisfy condition C6, C8 if do not satisfy condition simultaneously simultaneously, control module continues detecting sensor data, judges user's attitude;
3) walking trigging control: if control module detects that user meets the trigger condition of right lower limb advanced in years, control module to the right hip motor and right knee joint motor sends instruction, performs and steps right lower limb action: hip motor starts with acceleration a
0evenly speed v is accelerated to from static
0, then with speed v
0rotate, drive user's trunk and thigh to produce relative angular movement, make angle ∠ between trunk support and thigh support frame
right hipreduce; Knee motor starts with acceleration a simultaneously
1evenly speed v is accelerated to from static
1, then with speed v
1rotate, drive thigh and shank to produce relative angular movement, make the angle ∠ between thigh support frame and little leg support
right knee jointreduce, until control module detects
control knee motor with acceleration-a
1even be decelerated to static; Hip motor continues to rotate, until control module detects
control knee motor to rotate backward, with acceleration a
1the even speed that accelerates to is to v
1, then with speed v
1rotate, drive thigh and shank to produce relative angular movement, make the angle ∠ between thigh support frame and little leg support
right knee jointincrease; Control module continues to detect ∠
right hip, until detect
control hip motor with acceleration-a
0even be decelerated to static; Knee motor continues with speed v
1rotate, until control module detects
control knee motor with acceleration-a
1even be decelerated to static, release of taking a step, user to enter before right crus of diaphragm attitude after left foot;
If control module detects that user meets the trigger condition of left lower limb advanced in years, control module left hip motor and left knee joint motor sends instruction, performs and steps left lower limb action, until release, to enter before left foot state after right crus of diaphragm; Execution left lower limb action advanced in years is all left and right lower limb mutually with right lower limb action advanced in years and exchanges, and control mode is identical;
4) control module continues to detect the data judging trunk inclination angle, foot force and crutch pressure transducer, enters gait maintenance state;
Described ∠
front and backfor inclination angle before and after trunk; Described ∠
left and rightfor inclination angle, trunk left and right; F
plfor the independent pressure of left foot; F
prfor the independent pressure of right crus of diaphragm; F
clfor cane pressure of turning left; F
cr.for cane pressure of turning right; F
cfor remove two crutch pressure after crutch self gravitation and; ∠
knee jointfor the angle between thigh support frame and little leg support; ∠
hipfor the angle between thigh support frame and trunk support; ∠
left knee jointfor left knee joint angle; ∠
right knee jointfor right knee joint angle; ∠
left hipfor left Hip Angle; ∠
right hipfor right Hip Angle.
2. the walking of the convalescence device based on trunk centre-of gravity shift trigger control method according to claim 1, is characterized in that, described ∠
front and backfor with trunk vertical ground for benchmark, the angle that trunk tilts forward and back, lean forward as just, hypsokinesis is negative; Described ∠
left and rightfor with trunk vertical ground for benchmark, the angle that trunk tilts; "Left"-deviationist is just, Right deviation is negative.
3. the walking of the convalescence device based on trunk centre-of gravity shift trigger control method according to claim 1, it is characterized in that, if original state does not meet the condition of parallel midstance, control centre initiates a message to voice module, reminding user adjustment attitude, until detect that user is parallel midstance; User guides adjustment body posture according to the concrete operations in voice message; If condition C 1 does not meet, voice module prompting user " please keep trunk upright, not tilt to the left and right or tilt forwards, backwards "; If condition C 2 does not meet, voice module prompting user " please keep both legs upright, adjust the left knee joint of left hip or the right knee joint angle of right hip "; If condition C 3 does not meet, voice module shows that user " please make double-legged uniform stressed "; If condition C 4 does not meet, voice module prompting user " please use crutch, and make two crutch uniform stresseds ".
4. the walking of the convalescence device based on trunk centre-of gravity shift trigger control method according to claim 1, is characterized in that, described a
0value be
a
1value be
v
0value be
v
1value be
5. the walking of the convalescence device based on trunk centre-of gravity shift trigger control method according to claim 1, it is characterized in that, described control module is connected with left lower limb hip motor angle sensor, right lower limb hip motor angle sensor, left lower limb knee motor angle sensor, right lower limb knee motor angle sensor, left foot foot bottom pressure sensor, right crus of diaphragm foot bottom pressure sensor, left lower limb hip motor, trunk obliquity sensor, right lower limb hip motor, left lower limb knee motor and right lower limb knee motor respectively.
6. the walking of the convalescence device based on trunk centre-of gravity shift trigger control method according to claim 1, it is characterized in that, the trunk support of described convalescence device is bundled in user's upper body; Thigh support frame is bundled on user's thigh, and little leg support is bundled on user's shank; Foot support plate is arranged at the bottom of user's foot; Trunk support is connected by hip motor with thigh support frame; Stator and the trunk support of hip motor are fixed, and rotor and the thigh support frame of hip motor are fixed; The stators and rotators of thigh support frame and little leg support difference knee motor is connected; Knee motor is connected to thigh support frame and little leg support and relative angular movement both controlling; Little leg support is flexibly connected with foot support plate.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510834976.3A CN105326627B (en) | 2015-11-25 | 2015-11-25 | Convalescence device walking trigger control method based on trunk centre-of gravity shift |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510834976.3A CN105326627B (en) | 2015-11-25 | 2015-11-25 | Convalescence device walking trigger control method based on trunk centre-of gravity shift |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105326627A true CN105326627A (en) | 2016-02-17 |
CN105326627B CN105326627B (en) | 2018-04-13 |
Family
ID=55277541
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510834976.3A Expired - Fee Related CN105326627B (en) | 2015-11-25 | 2015-11-25 | Convalescence device walking trigger control method based on trunk centre-of gravity shift |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105326627B (en) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108379038A (en) * | 2018-01-15 | 2018-08-10 | 浙江大学 | A kind of lower limb rehabilitation exoskeleton system and its walking control method |
CN108416276A (en) * | 2018-02-12 | 2018-08-17 | 浙江大学 | The abnormal gait detection method of side gait video based on people |
CN109758342A (en) * | 2017-11-09 | 2019-05-17 | 福宝科技股份有限公司 | Exoskeleton robot and its control method |
CN110721055A (en) * | 2019-10-17 | 2020-01-24 | 深圳市迈步机器人科技有限公司 | Control method of lower limb walking aid exoskeleton robot and exoskeleton robot |
CN110946742A (en) * | 2019-12-02 | 2020-04-03 | 南京伟思医疗科技股份有限公司 | Device and method for assisting lower limb robot to transfer gravity center by aid of weight reduction vehicle |
CN110974609A (en) * | 2019-12-09 | 2020-04-10 | 宿州学院 | Foot sole pressure sensing system of exoskeleton device for lower limb rehabilitation training |
CN111419652A (en) * | 2020-06-12 | 2020-07-17 | 上海傅利叶智能科技有限公司 | Power-source-free knee joint mechanism |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102499859A (en) * | 2011-11-08 | 2012-06-20 | 上海交通大学 | Lower limb exoskeleton walking rehabilitation robot |
CN103200909A (en) * | 2010-09-27 | 2013-07-10 | 范德比尔特大学 | Movement assistance device |
CN103932868A (en) * | 2014-04-21 | 2014-07-23 | 清华大学 | Control method for paraplegia waling-assisted power exoskeleton |
CN104302251A (en) * | 2012-03-22 | 2015-01-21 | 埃克苏仿生公司 | Human machine interface for lower extremity orthotics |
US20150164732A1 (en) * | 2013-12-17 | 2015-06-18 | Samsung Electronics Co., Ltd. | Walking assistance apparatus and method of controlling the same |
US20150196403A1 (en) * | 2014-01-15 | 2015-07-16 | Samsung Electronics Co., Ltd. | Wearable robot and control method thereof |
CN105073069A (en) * | 2013-03-13 | 2015-11-18 | 埃克苏仿生公司 | Gait orthotic system and method for achieving hands-free stability |
-
2015
- 2015-11-25 CN CN201510834976.3A patent/CN105326627B/en not_active Expired - Fee Related
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103200909A (en) * | 2010-09-27 | 2013-07-10 | 范德比尔特大学 | Movement assistance device |
CN102499859A (en) * | 2011-11-08 | 2012-06-20 | 上海交通大学 | Lower limb exoskeleton walking rehabilitation robot |
CN104302251A (en) * | 2012-03-22 | 2015-01-21 | 埃克苏仿生公司 | Human machine interface for lower extremity orthotics |
CN105073069A (en) * | 2013-03-13 | 2015-11-18 | 埃克苏仿生公司 | Gait orthotic system and method for achieving hands-free stability |
US20150164732A1 (en) * | 2013-12-17 | 2015-06-18 | Samsung Electronics Co., Ltd. | Walking assistance apparatus and method of controlling the same |
US20150196403A1 (en) * | 2014-01-15 | 2015-07-16 | Samsung Electronics Co., Ltd. | Wearable robot and control method thereof |
CN103932868A (en) * | 2014-04-21 | 2014-07-23 | 清华大学 | Control method for paraplegia waling-assisted power exoskeleton |
Cited By (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109758342A (en) * | 2017-11-09 | 2019-05-17 | 福宝科技股份有限公司 | Exoskeleton robot and its control method |
CN109758342B (en) * | 2017-11-09 | 2021-12-03 | 福宝科技股份有限公司 | Exoskeleton robot and control method thereof |
CN108379038A (en) * | 2018-01-15 | 2018-08-10 | 浙江大学 | A kind of lower limb rehabilitation exoskeleton system and its walking control method |
CN108416276A (en) * | 2018-02-12 | 2018-08-17 | 浙江大学 | The abnormal gait detection method of side gait video based on people |
CN108416276B (en) * | 2018-02-12 | 2022-05-24 | 浙江大学 | Abnormal gait detection method based on human lateral gait video |
CN110721055A (en) * | 2019-10-17 | 2020-01-24 | 深圳市迈步机器人科技有限公司 | Control method of lower limb walking aid exoskeleton robot and exoskeleton robot |
CN110721055B (en) * | 2019-10-17 | 2021-11-02 | 深圳市迈步机器人科技有限公司 | Control method of lower limb walking aid exoskeleton robot and exoskeleton robot |
CN110946742A (en) * | 2019-12-02 | 2020-04-03 | 南京伟思医疗科技股份有限公司 | Device and method for assisting lower limb robot to transfer gravity center by aid of weight reduction vehicle |
CN110974609A (en) * | 2019-12-09 | 2020-04-10 | 宿州学院 | Foot sole pressure sensing system of exoskeleton device for lower limb rehabilitation training |
CN111419652A (en) * | 2020-06-12 | 2020-07-17 | 上海傅利叶智能科技有限公司 | Power-source-free knee joint mechanism |
Also Published As
Publication number | Publication date |
---|---|
CN105326627B (en) | 2018-04-13 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105326627A (en) | Trunk center-of-gravity shift based rehabilitation device walking triggering control method | |
CN105456000B (en) | A kind of ambulation control method of wearable bionic exoskeleton pedipulator convalescence device | |
EP2671559B1 (en) | Ambulation training device and ambulation training system | |
CN105411813A (en) | Wearable bionic exoskeleton mechanical leg rehabilitation device | |
CN109195565B (en) | Walking movement assisting device | |
CN105456004B (en) | Exoskeleton-type moves walking rehabilitation training device and method | |
CN104825311B (en) | The special lower limb exoskeleton of hemiplegic patient and its using method and stability verification method | |
CN109568089A (en) | A kind of trailing type lower limb recovery robot by training paces system | |
CN105455819A (en) | Standing mode control method of wearable bionic exoskeleton mechanical leg rehabilitation device | |
JP5706016B2 (en) | Walking assistance robot | |
CN109758342A (en) | Exoskeleton robot and its control method | |
JP2023531830A (en) | Rehabilitation exoskeleton device for one leg and control method thereof | |
CN106137489A (en) | Interactive ectoskeleton knee joint machine system | |
CN105342808A (en) | Walking triggering control method of foot pressure sensor based rehabilitation device | |
JP2011115323A (en) | Walking assist robot | |
CN106901949B (en) | Full lower limb exoskeleton and its operating method | |
CN108338895A (en) | Planar walking following support power assisting device and method | |
Li et al. | Effect of robot assisted gait training on motor and walking function in patients with subacute stroke: a random controlled study | |
CN105326625A (en) | Sitting mode control method for wearable bionic exoskeleton mechanical leg rehabilitation device | |
JP2012095793A (en) | Walking training system | |
CN105287164B (en) | A kind of convalescence device speed of travel control method rocked based on trunk | |
CN205412080U (en) | Multi -functional fitness campaign composite set | |
KR102162485B1 (en) | Controlling method of lower body assisting robot | |
CN205831797U (en) | A kind of wearable lower limb gait Intelligent Measurement running gear | |
CN205586203U (en) | Wearable bionical ectoskeleton mechanical legs rehabilitation device |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20180413 Termination date: 20181125 |
|
CF01 | Termination of patent right due to non-payment of annual fee |