CN101403925A - Control method and system for touchdown time of stable walking feet of humanoid robot - Google Patents
Control method and system for touchdown time of stable walking feet of humanoid robot Download PDFInfo
- Publication number
- CN101403925A CN101403925A CNA2008101719859A CN200810171985A CN101403925A CN 101403925 A CN101403925 A CN 101403925A CN A2008101719859 A CNA2008101719859 A CN A2008101719859A CN 200810171985 A CN200810171985 A CN 200810171985A CN 101403925 A CN101403925 A CN 101403925A
- Authority
- CN
- China
- Prior art keywords
- robot
- pin
- leg
- joint
- ankle
- 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 23
- 230000009184 walking Effects 0.000 title claims description 34
- 210000002683 foot Anatomy 0.000 claims abstract description 26
- 238000001514 detection method Methods 0.000 claims abstract description 12
- 210000002414 leg Anatomy 0.000 claims description 129
- 210000000544 articulatio talocruralis Anatomy 0.000 claims description 55
- 230000005021 gait Effects 0.000 claims description 50
- 210000004233 talus Anatomy 0.000 claims description 11
- 210000004394 hip joint Anatomy 0.000 claims description 7
- 210000000629 knee joint Anatomy 0.000 claims description 7
- 238000005070 sampling Methods 0.000 claims description 6
- 210000003423 ankle Anatomy 0.000 abstract description 3
- 230000000694 effects Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 5
- 230000008569 process Effects 0.000 description 4
- 230000002159 abnormal effect Effects 0.000 description 3
- 230000037396 body weight Effects 0.000 description 2
- 238000004364 calculation method Methods 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 238000006243 chemical reaction Methods 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 230000005484 gravity Effects 0.000 description 2
- 239000000463 material Substances 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
Images
Landscapes
- Manipulator (AREA)
Abstract
The invention discloses a method for controlling the time of foot landing which can lead a humanoid robot walk steadily and a system thereof, belonging to the field of robots. The method comprises that: the feet of the swing legs of a robot are detected to judge whether the feet land or not; if the feet of the swing legs of the robot land before the time of the programming pace, the ankle of the swing legs is elevated; if the feet of the swing legs of the robot land after the time of the programming pace, the ankle of the swing legs is lowered. The system comprises a detection device and an adjustment device; wherein, the adjustment device comprises an advanced adjustment module, a lagging adjustment module and a supporting adjustment module. The invention has the effect that the robot can walk steadily in the actual environment by amending the programming dynamic pace of the robot and controlling the pace in real time.
Description
Technical field
The present invention relates to the robot field, particularly a kind of control method and system of pin touchdown time of apery robot stabilized walking.
Background technology
Bipod walking robot is the same with the people, is to move by the walking realization of two legs.In order to make robot ambulation, need the run trace (dynamically gait) of given robot.The dynamic gait of robot is the motion in a kind of intrinsic, cycle, produces according to biped robot's integral power.Because the coupling of constraint condition and the complicacy of kinetics equation, dynamically gait is calculated needs an optimizing process.So dynamically gait generally can only realize by offline computing method.That is to say that dynamically gait generally is to generate under the known situation of hypothesis biped robot's model and surrounding environment.But because there is error in the modeling of robot, and the variation of surrounding environment or produced unknown situation, if the dynamic gait of being planned is not revised in real time and controlled, robot produces instability possibly even abnormal occurrence such as falls down.Therefore, for make robot can be in actual environment stabilized walking, need the dynamic gait of planning be revised according to the current oneself state of current environmental information and robot, carry out real-time gait control, the change that overcomes environment is with uncertain.
Prior art one discloses a kind of control method based on ZMP (Zero Moment Point, zero moment point) compensation.In order to make robot two sufficient gait stabilities, utilize ZMP that robot is compensated.In ZMP, the resultant moment that ground reaction force and gravity produced on acting at the bottom of the robot foot equals zero.Realize the ZMP compensation by the upper body and the correction robot foot position that change robot.
Prior art two discloses a kind of method of controlling two-foot walking robot, according to ground reaction force, calculates roll angle and pitch angle.Drive detent by this roll angle and pitch angle, normal vector aligns with the reference direction on the gravity direction.
After prior art was studied, the inventor found: the robotary correction in the prior art one need be carried out complicated dynamics calculation.And because whether the touchdown time of leading leg of robot decision robot begins shift weight, so the robot foot touchdown time has material impact to the stability of robot.But this technology is not considered this factor, thereby causes robot still can produce instability even abnormal occurrence such as fall down.Equally, prior art two is not taken into account the robot foot touchdown time yet to the material impact of the stability of robot, so it is unstable even abnormal occurrence such as fall down robot also can to occur.
Summary of the invention
For make robot can be in actual environment stabilized walking, the embodiment of the invention provides a kind of control method and system of pin touchdown time of apery robot stabilized walking.Described technical scheme is as follows:
A kind of control method of pin touchdown time of apery robot stabilized walking, described method comprises:
Whether the pin that detection machine people leads leg lands and the size of contact force;
If the pin that robot leads leg landed in advance than the time of planning gait, then raise this ankle-joint position of leading leg;
If the pin that robot leads leg is then lowerd the ankle-joint of leading leg than landing the time lag of planning gait.
A kind of control system of pin touchdown time of apery robot stabilized walking, described system comprise checkout equipment and adjustment equipment:
Described checkout equipment: whether the pin that is used for the force transducer detection machine people by the robot anklebone place lands and the size of contact force;
Described adjustment equipment: be used for by adjusting foot of the robot touchdown time of expectation, make it and the touchdown time planned coincide,, then raise this ankle-joint position of leading leg if the pin that robot leads leg lands in advance than the planning gait; If the pin that robot leads leg lags behind than the planning gait and lands, then the ankle-joint of leading leg is lowerd.
Described adjustment equipment comprises adjusting module, hysteresis adjusting module and support adjusting module in advance:
Shift to an earlier date adjusting module: be used for working as F
Foot>0 and t<T
LandThe time, then the robot pin of leading leg lands in advance than the planning gait, robot according to being in proportion of pin contact force raise the position of this ankle-joint of leading leg, the described calculating robot real-time correction of ankle-joint of should leading leg is: Δ Z
f(t)=Δ Z
f(t-T)+K
1F
Foot
Hysteresis adjusting module: be used for working as F
Foot=0, t<T
LandThe time, then the robot pin of leading leg lags behind than the planning gait and lands, and judges to lead leg robot whether pin can land when stretching;
If can land, the lead leg height of ankle-joint of the robot of loweing; The described calculating robot real-time correction of ankle-joint of should leading leg is: Δ Z
f(t)=Δ Z
f(t-T)-h;
Sole still can't kiss the earth if robot leads leg when stretching fully, then adjusts hip joint, knee joint and the ankle-joint of other one leg, and it is crooked that this leg is increased, and robot upper body height descends, so that the pin of leading leg can reach ground;
Support adjusting module: be used for working as F
Foot〉=M
r, t>T
LandThe time, then this is led leg and supports separately entire machine people, and calculating robot's real-time correction of ankle-joint of should leading leg is: Δ Z
f(t)=(1-K
2) Δ Z
f(t-T);
Described T is the sampling period of computer servo control system, K
1And K
2Be coefficient, 0<K
1<1,0<K
2<1, F
FootBe the pin that records of force transducer and the contact force between ground, T
LandBe the pin touchdown time of planning expectation, Mr is the threshold value of switching controls mode, and h is the constant greater than zero.
The beneficial effect of the technical scheme that the embodiment of the invention provides is:
Realize robot stabilized walking by revising biped robot's pin touchdown time, need not concrete robot dynamics's model, calculate simple, be swift in response, the height of rapid adjustment robot foot, make robot can be on broken terrain stabilized walking, and this technical scheme is not at particular machines people structure, wide adaptability.Both combine dynamic gait, and guaranteed to realize walking step state, and can keep mobile equilibrium again.
Description of drawings
In order to be illustrated more clearly in the embodiment of the invention or technical scheme of the prior art, to do to introduce simply to the accompanying drawing of the required use of embodiment below, apparently, accompanying drawing in describing below only is some embodiments of the present invention, for those of ordinary skills, under the prerequisite of not paying creative work, can also obtain other accompanying drawing according to these accompanying drawings.
Fig. 1 is the walking controller structural drawing that the embodiment of the invention 1 provides;
Fig. 2 is a kind of process flow diagram of control method of the pin touchdown time of a kind of apery robot stabilized walking of providing of the embodiment of the invention 1;
Fig. 3 is land in advance an adjustment schematic diagram under the situation of robot foot that the embodiment of the invention 1 provides;
Fig. 4 is land in advance a kind of process flow diagram under the situation of robot foot that the embodiment of the invention 1 provides;
Fig. 5 is lag behind an adjustment schematic diagram under the situation that lands of the robot foot that provides of the embodiment of the invention 1;
Fig. 6 is lag behind a kind of process flow diagram under the situation that lands of the robot foot that provides of the embodiment of the invention 1;
Fig. 7 is the structural drawing of the control system that provides of the embodiment of the invention 2;
Fig. 8 is the structural drawing of the adjustment equipment that provides of the embodiment of the invention 2.
Embodiment
For making the purpose, technical solutions and advantages of the present invention clearer, embodiment of the present invention is described further in detail below in conjunction with accompanying drawing.Obviously, described embodiment only is the present invention's part embodiment, rather than whole embodiment.Based on the embodiment among the present invention, those of ordinary skills belong to the scope of protection of the invention not making the every other embodiment that is obtained under the creative work prerequisite.
Whether the force transducer detection machine people pin of the present invention by the robot anklebone place lands and the size of contact force, by adjusting foot of the robot touchdown time of expectation, makes it and the touchdown time planned coincide.
As shown in Figure 1, the embodiment of the invention provides a kind of robot walking controller.This robot walking controller adopts double structure, by the off-line gait planning Z that plays feedforward action
F0(t) and play the Δ Z of LOCAL FEEDBACK effect
f(t) constitute.Walking robot comprises the force transducer 6 and the web member thereof at upper body 1, hip joint 2, knee joint 3, ankle-joint 4, pin 5, ankle place, and the two legs of the lower part of the body respectively has 6 degree of freedom respectively.
When robot walks in real time, the reference altitude Z of robot anklebone
f(t) equal the dynamic gait Z that off-line is planned
F0(t) add real-time correction amount Z
f(t).Wherein, Z
F0(t) generally be under the known situation of given robot model and surrounding environment, to generate.Δ Z
f(t) be not land (in advance or lag behind land), in order to overcome uncertain and real-time correction ankle-joint height when making robot keep balance of environment in the time of expectation when robot foot.
Referring to Fig. 2, the embodiment of the invention provides a kind of control method of pin touchdown time of apery robot stabilized walking, by adjusting foot of the robot touchdown time of expectation, makes it and the touchdown time planned coincide.Concrete steps are as follows:
Step 201: whether the pin that the force transducer detection machine people by the robot anklebone place leads leg lands and the size of contact force;
If land, then execution in step 202, otherwise, execution in step 204.
Step 202:F
Foot>0 and t<T
Land, the pin that robot leads leg lands in advance than the planning gait;
Step 203: robot raises this ankle-joint position of leading leg according to the pin contact force of leading leg with being in proportion; Execution in step 208 then;
Step 204:F
Foot=0, t<T
Land, the pin that robot leads leg lags behind than the planning gait and lands;
Step 205: judge and lead leg robot whether sole can land when stretching;
If can land, then execution in step 206, otherwise, execution in step 207.
Step 206: the robot height of ankle-joint of leading leg of then need loweing; Execution in step 208 then;
Step 207: stretch and lead leg, adjust hip joint, knee joint and the ankle-joint of other one leg, it is crooked that this leg is increased, and robot upper body height descends, and consequently the pin of leading leg reaches ground, to keep the balance of robot body;
Step 208:F
Foot〉=M
r, this is led leg and supports the entire machine people separately, and then this ankle-joint position of leading leg returns to the value of intrinsic dynamic gait regulation gradually.
Further, the pin that the embodiment of the invention will be led leg to robot describes than the situation that the planning gait land in advance, and as shown in Figure 3, robot raises this ankle-joint position of leading leg according to the pin contact force of leading leg with being in proportion.Lead leg when this and can support the entire machine man-hour separately, then this ankle-joint position of leading leg returns to the value of intrinsic dynamic gait regulation gradually.The real-time correction amount Z of robot anklebone
f(t) calculate by following two formulas:
Wherein, T is the sampling period of computer servo control system.K
1And K
2Be coefficient, 0<K
1<1,0<K
2<1.F
FootBe the pin that records of force transducer and the contact force between ground.T
LandIt is the pin touchdown time of planning expectation.Mr is the threshold value of switching controls mode, its value be slightly less than robot body weight (for example, its value equal the robot body weight 80% to 95%).
Referring to Fig. 4, concrete steps are as follows:
Step 401:F
Foot>0 and t<T
Land, the pin that robot leads leg is adjusted than the situation that the planning gait lands in advance;
Step 402: pin that robot leads leg lands in advance than the planning gait, robot then according to being in proportion of pin contact force raise the position of this ankle-joint of leading leg;
Particularly, pin that robot leads leg lands in advance than the planning gait, and calculating robot's real-time correction of ankle-joint of should leading leg is:
ΔZ
f(t)=ΔZ
f(t-T)+K
1F
foot
Step 403:F
Foot〉=M
rAnd t>T
Land, robot leads leg and supports separately the entire machine people, and then the robot ankle-joint position of should leading leg returns to the value of intrinsic dynamic gait regulation gradually.
Concrete, robot leads leg and supports the entire machine people separately, and calculating robot's real-time correction of ankle-joint of should leading leg is:
ΔZ
f(t)=(1-K
2)ΔZ
f(t-T)
Further, the embodiment of the invention will describe than the situation that the hysteresis of planning gait lands the pin that robot leads leg, and as shown in Figure 5, robot will suitably lower the leg ankle-joint, wherein, the degree of loweing will depend on the discrepancy in elevation between the surface of contact of actual contact face and expection.Lead leg when this and can support the entire machine man-hour separately, then this ankle-joint position of leading leg returns to the value of intrinsic dynamic gait regulation gradually.In such cases, the real-time correction amount Z of robot anklebone
f(t) calculate by following two formulas:
As shown in Figure 6, concrete steps are as follows:
Step 601:F
Foot=0, t<T
Land, the pin that robot leads leg is adjusted than the situation that the hysteresis of planning gait lands;
Step 602: pin that robot leads leg lags behind than the planning gait and lands, and judges to lead leg robot whether pin can land when stretching;
If can land, then execution in step 603, otherwise, execution in step 604;
Step 603: pin that robot leads leg lags behind than the planning gait and lands, the lead leg height of ankle-joint of the robot of loweing, and the degree of loweing depends on the discrepancy in elevation between the surface of contact of actual contact face and expection; Execution in step 605 then;
Particularly, pin that robot leads leg lags behind than the planning gait and lands, and calculating robot's real-time correction of ankle-joint of should leading leg is:
ΔZ
f(t)=ΔZ
f(t-T)-h
Step 604: robot leads leg when stretching fully sole still can't kiss the earth, then adjust hip joint, knee joint and the ankle-joint of other one leg, it is crooked that this leg is increased, and robot upper body height descends, so that the pin of leading leg reaches ground, to keep the balance of robot body;
Step 605:F
Foot〉=M
rAnd t>T
Land, then this is led leg and supports the entire machine people separately, and then this ankle-joint position of leading leg returns to the value of intrinsic dynamic gait regulation gradually.
Particularly, support separately the entire machine people when robot leads leg, then calculating robot's real-time correction of ankle-joint of should leading leg is:
ΔZ
f(t)=(1-K
2)ΔZ
f(t-T)
The embodiment of the invention need not concrete robot dynamics's model, calculate simple, reflection rapidly, the height of rapid adjustment robot foot, make robot can be on broken terrain stabilized walking, and not at particular machines people structure, wide adaptability had both combined dynamic gait, guaranteed to realize walking step state, can keep mobile equilibrium again, well solve the robot problem of unstable.
Referring to Fig. 7, the present invention also provides a kind of control system of pin touchdown time of apery robot stabilized walking, specifically comprises:
Checkout equipment 701: whether the pin that is used for the force transducer detection machine people by the robot anklebone place lands and the size of contact force;
Adjustment equipment 702: be used for by adjusting foot of the robot touchdown time of expectation, make it and the touchdown time planned coincide,, then raise this ankle-joint position of leading leg if the pin that robot leads leg lands in advance than the planning gait; If the pin that robot leads leg lags behind than the planning gait and lands, then the ankle-joint of leading leg is lowerd.
Further, referring to Fig. 8, adjustment equipment 702 comprises:
Shift to an earlier date adjusting module 801: be used for working as F
Foot>0 and t<T
LandThe time, then the robot pin of leading leg lands in advance than the planning gait, robot according to being in proportion of pin contact force raise the position of this ankle-joint of leading leg, the described calculating robot real-time correction of ankle-joint of should leading leg is: Δ Z
f(t)=Δ Z
f(t-T)+K
1F
Foot
Hysteresis adjusting module 802: be used for working as F
Foot=0, t<T
LandThe time, then the robot pin of leading leg lags behind than the planning gait and lands, and judges to lead leg robot whether pin can land when stretching;
If can land, the lead leg height of ankle-joint of the robot of loweing; The described calculating robot real-time correction of ankle-joint of should leading leg is: Δ Z
f(t)=Δ Z
f(t-T)-h;
Sole still can't kiss the earth if robot leads leg when stretching fully, then adjusts hip joint, knee joint and the ankle-joint of other one leg, and it is crooked that this leg is increased, and robot upper body height descends, so that the pin of leading leg reaches ground;
Support adjusting module 803: be used for working as F
Foot〉=M
rAnd t>T
LandThe time, then this is led leg and supports separately entire machine people, and calculating robot's real-time correction of ankle-joint of should leading leg is: Δ Z
f(t)=(1-K
2) Δ Z
f(t-T).
The embodiment of the invention need not concrete robot dynamics's model, calculate simple, reflection rapidly, the height of rapid adjustment robot foot, make robot can be on broken terrain stabilized walking, and not at particular machines people structure, wide adaptability had both combined dynamic gait, guaranteed to realize walking step state, can keep mobile equilibrium again, well solve the robot problem of unstable.
All or part of content in the technical scheme that above embodiment provides can realize that its software program is stored in the storage medium that can read by software programming.
The above only is preferred embodiment of the present invention, and is in order to restriction the present invention, within the spirit and principles in the present invention not all, any modification of being done, is equal to replacement, improvement etc., all should be included within protection scope of the present invention.
Claims (9)
1, a kind of control method of pin touchdown time of apery robot stabilized walking is characterized in that, described method comprises:
Whether the pin that detection machine people leads leg lands;
If the pin that described robot leads leg landed in advance than the time of planning gait, then raise the ankle-joint position of leading leg;
If the pin that described robot leads leg is then lowerd the ankle-joint of leading leg than landing the time lag of planning gait.
2, the control method of the pin touchdown time of apery robot stabilized walking as claimed in claim 1 is characterized in that, whether the pin that described detection machine people leads leg lands, and specifically comprises:
Whether the pin that the force transducer detection machine people by the robot anklebone place leads leg lands.
3, the control method of the pin touchdown time of apery robot stabilized walking as claimed in claim 1 is characterized in that, if the pin that described robot leads leg lands in advance than the planning gait, then raises this ankle-joint position of leading leg, and specifically comprises:
If F
Foot>0 and t<T
Land, then the robot pin of leading leg lands in advance than the planning gait, robot according to being in proportion of pin contact force raise the position of this ankle-joint of leading leg, the described calculating robot real-time correction of ankle-joint of leading leg is: Δ Z
f(t)=Δ Z
f(t-T)+K
1F
Foot
The size of described contact force obtains described K by the force transducer detection at robot anklebone place
1Be coefficient, 0<K
1<1, F
FootBe the pin that records of force transducer and the contact force between ground, T
LandBe the pin touchdown time of planning expectation, T is a computer cycle control.
4, the control method of the pin touchdown time of apery robot stabilized walking according to claim 1 is characterized in that, lands if the pin that described robot leads leg lags behind than the planning gait, then the ankle-joint of leading leg is lowerd, and specifically comprises:
If F
Foot=0, t<T
Land, then the robot pin of leading leg lags behind than the planning gait and lands, and judges to lead leg robot whether pin can land when stretching;
If can land, the lead leg height of ankle-joint of the robot of loweing, the described calculating robot real-time correction of ankle-joint of leading leg is: Δ Z
f(t)=Δ Z
f(t-T)-h;
Sole still can't kiss the earth if robot leads leg when stretching fully, then adjusts hip joint, knee joint and the ankle-joint of other one leg, and it is crooked that this leg is increased, and robot upper body height descends, so that the pin of leading leg reaches ground;
Described F
FootBe the pin that records of force transducer and the contact force between ground, T
LandBe the pin touchdown time of planning expectation, T is the sampling period of computer servo control system, and h is the constant greater than zero.
5, as the control method of the pin touchdown time of apery robot stabilized walking as described in claim 3 or 4, it is characterized in that described method also comprises:
If F
Foot〉=M
r, t>T
Land, then this is led leg and supports separately entire machine people, and calculating robot's real-time correction of ankle-joint of should leading leg is: Δ Z
f(t)=(1-K
2) Δ Z
f(t-T);
Described K
2Be coefficient, 0<K
2<1.
6, a kind of control system of pin touchdown time of apery robot stabilized walking is characterized in that, described system comprises checkout equipment and adjustment equipment:
Described checkout equipment: whether the pin that is used for the force transducer detection machine people by the robot anklebone place lands and the size of contact force;
Described adjustment equipment: be used for by adjusting foot of the robot touchdown time of expectation, make it and the touchdown time planned coincide,, then raise this ankle-joint position of leading leg if the pin that robot leads leg lands in advance than the planning gait; If the pin that robot leads leg lags behind than the planning gait and lands, then the ankle-joint of leading leg is lowerd.
7, the control system of the pin touchdown time of apery robot stabilized walking as claimed in claim 6 is characterized in that, described adjustment equipment specifically comprises:
Shift to an earlier date adjusting module: be used for working as F
Foot>0 and t<T
LandThe time, then the robot pin of leading leg lands in advance than the planning gait, robot according to being in proportion of pin contact force raise the position of this ankle-joint of leading leg, the described calculating robot real-time correction of ankle-joint of should leading leg is: Δ Z
f(t)=Δ Z
f(t-T)+K
1F
Foot
The size of described contact force obtains described F by the force transducer detection at robot anklebone place
FootBe the pin that records of force transducer and the contact force between ground, T
LandBe the pin touchdown time of planning expectation, Mr is the threshold value of switching controls mode, and T is the sampling period of computer servo control system, K
1Be coefficient, 0<K
1<1.
8, the control system of the pin touchdown time of apery robot stabilized walking as claimed in claim 6 is characterized in that, described adjustment equipment specifically comprises:
Hysteresis adjusting module: be used for working as F
Foot=0, t<T
LandThe time, then the robot pin of leading leg lags behind than the planning gait and lands, and judges to lead leg robot whether pin can land when stretching;
If can land, the lead leg height of ankle-joint of the robot of loweing; The described calculating robot real-time correction of ankle-joint of should leading leg is: Δ Z
f(t)=Δ Z
f(t-T)-h;
Sole still can't kiss the earth if robot leads leg when stretching fully, then adjusts hip joint, knee joint and the ankle-joint of other one leg, and it is crooked that this leg is increased, and robot upper body height descends, so that the pin of leading leg reaches ground;
Described F
FootBe the pin that records of force transducer and the contact force between ground, T
LandBe the pin touchdown time of planning expectation, T is the sampling period of computer servo control system, and h is the constant greater than zero.
9, as the control system of the pin touchdown time of claim 7 or 8 described apery robot stabilized walkings, it is characterized in that described adjustment equipment also comprises:
Support adjusting module: be used for working as F
Foot〉=M
r, t>T
LandThe time, then this is led leg and supports separately entire machine people, and calculating robot's real-time correction of ankle-joint of should leading leg is: Δ Z
f(t)=(1-K
2) Δ Z
f(t-T);
Described K
2Be coefficient, 0<K
2<1, T is the sampling period of computer servo control system.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN200810171985A CN100594459C (en) | 2008-10-28 | 2008-10-28 | Foot touching-ground time control method and system for stable walk of human imitating robert |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN200810171985A CN100594459C (en) | 2008-10-28 | 2008-10-28 | Foot touching-ground time control method and system for stable walk of human imitating robert |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101403925A true CN101403925A (en) | 2009-04-08 |
CN100594459C CN100594459C (en) | 2010-03-17 |
Family
ID=40537958
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN200810171985A Expired - Fee Related CN100594459C (en) | 2008-10-28 | 2008-10-28 | Foot touching-ground time control method and system for stable walk of human imitating robert |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN100594459C (en) |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104793622A (en) * | 2014-01-20 | 2015-07-22 | 丰田自动车株式会社 | Biped walking robot control method and biped walking robot control system |
WO2018040737A1 (en) * | 2016-09-05 | 2018-03-08 | 深圳光启合众科技有限公司 | Robot, and moving control method and device therefor |
CN110202580A (en) * | 2019-06-28 | 2019-09-06 | 北京理工大学 | A kind of anthropomorphic robot space Shared control model building method that disturbance restores |
CN110308727A (en) * | 2019-07-12 | 2019-10-08 | 沈阳城市学院 | A kind of control method for eliminating biped robot's upper body posture shaking |
CN111168672A (en) * | 2020-01-03 | 2020-05-19 | 广东博智林机器人有限公司 | Robot motion planning method, system, computer device and storage medium |
CN112180958A (en) * | 2020-09-23 | 2021-01-05 | 北航歌尔(潍坊)智能机器人有限公司 | Robot and motion coordination method, control device and readable storage medium thereof |
CN113673424A (en) * | 2021-08-19 | 2021-11-19 | 华南理工大学 | Method for judging walking gait cycle phase |
CN114401887A (en) * | 2019-08-06 | 2022-04-26 | 波士顿动力公司 | Step contact detection |
CN114663913A (en) * | 2022-02-28 | 2022-06-24 | 电子科技大学 | Human body gait parameter extraction method based on Kinect |
-
2008
- 2008-10-28 CN CN200810171985A patent/CN100594459C/en not_active Expired - Fee Related
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104793622A (en) * | 2014-01-20 | 2015-07-22 | 丰田自动车株式会社 | Biped walking robot control method and biped walking robot control system |
CN104793622B (en) * | 2014-01-20 | 2018-01-30 | 丰田自动车株式会社 | two-foot walking robot control method and two-foot walking robot control system |
WO2018040737A1 (en) * | 2016-09-05 | 2018-03-08 | 深圳光启合众科技有限公司 | Robot, and moving control method and device therefor |
CN110202580B (en) * | 2019-06-28 | 2020-08-21 | 北京理工大学 | Construction method of disturbance recovery humanoid robot space compliance control model |
CN110202580A (en) * | 2019-06-28 | 2019-09-06 | 北京理工大学 | A kind of anthropomorphic robot space Shared control model building method that disturbance restores |
CN110308727A (en) * | 2019-07-12 | 2019-10-08 | 沈阳城市学院 | A kind of control method for eliminating biped robot's upper body posture shaking |
CN114401887A (en) * | 2019-08-06 | 2022-04-26 | 波士顿动力公司 | Step contact detection |
CN111168672A (en) * | 2020-01-03 | 2020-05-19 | 广东博智林机器人有限公司 | Robot motion planning method, system, computer device and storage medium |
CN112180958A (en) * | 2020-09-23 | 2021-01-05 | 北航歌尔(潍坊)智能机器人有限公司 | Robot and motion coordination method, control device and readable storage medium thereof |
CN112180958B (en) * | 2020-09-23 | 2022-08-19 | 北航歌尔(潍坊)智能机器人有限公司 | Robot and motion coordination method, control device and readable storage medium thereof |
CN113673424A (en) * | 2021-08-19 | 2021-11-19 | 华南理工大学 | Method for judging walking gait cycle phase |
CN113673424B (en) * | 2021-08-19 | 2023-09-08 | 华南理工大学 | Judgment method for walking gait cycle stage |
CN114663913A (en) * | 2022-02-28 | 2022-06-24 | 电子科技大学 | Human body gait parameter extraction method based on Kinect |
CN114663913B (en) * | 2022-02-28 | 2023-10-31 | 电子科技大学 | Kinect-based human gait parameter extraction method |
Also Published As
Publication number | Publication date |
---|---|
CN100594459C (en) | 2010-03-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN100594459C (en) | Foot touching-ground time control method and system for stable walk of human imitating robert | |
Caron et al. | Stair climbing stabilization of the HRP-4 humanoid robot using whole-body admittance control | |
CN112051741B (en) | Dynamic motion generation and control method for biped robot | |
JP3269852B2 (en) | Posture stabilization control device for legged mobile robot | |
Mistry et al. | Inverse dynamics control of floating base systems using orthogonal decomposition | |
EP2704671B1 (en) | Impedance simulating motion controller for orthotic and prosthetic applications | |
US7072740B2 (en) | Legged mobile robot | |
US20080009971A1 (en) | Walking robot and control method thereof | |
Chen et al. | Bioinspired control of walking with toe-off, heel-strike, and disturbance rejection for a biped robot | |
Kim et al. | Realization of dynamic walking for the humanoid robot platform KHR-1 | |
US20040128028A1 (en) | Motion editing apparatus and method for legged mobile robot and computer program | |
CN101414189A (en) | Method and device for controlling upper body attitude of apery robot stabilized walking | |
US20040172165A1 (en) | Legged mobile robot | |
CN102440854B (en) | Human-machine coupling overload carrying system device and control method thereof | |
CN101414190A (en) | Method and system for controlling apery robot stabilized walking based on effective stable domain | |
CN101943912A (en) | Control method for eliminating upper body posture shaking of double-foot humanoid robot | |
Li et al. | Walking pattern generation for a humanoid robot with compliant joints | |
Park et al. | Online biped walking pattern generation for humanoid robot khr-3 (kaist humanoid robot-3: Hubo) | |
Stephens et al. | Modeling and control of periodic humanoid balance using the linear biped model | |
KR20090126038A (en) | Walking robot and method of controlling the same | |
CN112775937A (en) | Self-adaptive robust control method and device for under-actuated hydraulic single-leg power-assisted exoskeleton | |
US20050165507A1 (en) | Robot device operation control device and operation control method | |
WO2024146206A1 (en) | Whole-body compliance control method applied to rapid walking of biped robot | |
Kareem et al. | Robust stability control of inverted pendulum model for bipedal walking robot | |
CN114888806A (en) | Robust control method and device for under-actuated single-leg support hydraulic power-assisted exoskeleton |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20100317 |
|
CF01 | Termination of patent right due to non-payment of annual fee |