dynamic imbalance analysis and stability control of ... · dynamic imbalance analysis and stability...

17
Research Article Dynamic Imbalance Analysis and Stability Control of Galloping Gait for a Passive Quadruped Robot Chunlei Wang, 1 Ting Zhang, 2 Xiaohui Wei, 1 Yongjun Long, 1 and Shigang Wang 1 1 e State Key Laboratory of Mechanical System and Vibration, Shanghai Jiao Tong University, Shanghai 200240, China 2 College of Mechanical Engineering, Shanghai University of Engineering Science, Shanghai 200030, China Correspondence should be addressed to Shigang Wang; [email protected] Received 1 March 2015; Revised 30 May 2015; Accepted 30 May 2015 Academic Editor: Fabio Esposito Copyright © 2015 Chunlei Wang et al. is is an open access article distributed under the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited. Some imbalance and balance postures of a passive quadruped robot with a simplified mathematical model are studied. rough analyzing the influence of the touchdown angle of the rear leg on the posture of the trunk during the flight phase, the stability criterion is concluded: the closer are the two moments which are the zero time of the pitching angle and the peak time of the center of mass, the better is the stability of the trunk posture during the flight phase. Additionally, the validity of the stability criterion is verified for the cat, greyhound, lion, racehorse, basset hound, and giraffe. Furthermore, the stability criterion is also applicable when the center of the mass of body is shiſted. Based on the stability criterion, the necessary and sufficient condition of the galloping stability for the quadruped robot is proposed to attain a controlled thrust. e control strategy is designed by an optimization dichotomy algorithm for seeking the zero point of the balance condition. rough the control results, it is demonstrated that the imbalance posture of the trunk could be stabilized by adjusting the stiffness of four legs. 1. Introduction In recent years, some models were presented to study the trotting, bounding, and galloping gait of quadruped robot. e spring loaded inverted pendulum (SLIP) model was suitable to study the hopping of one-legged robot [1, 2], bipedal running of human [35], and trotting of quadruped robot [6, 7]. Meanwhile, the studying of SLIP model was a fundamental work for other models of the quadruped robot. e planar model consisted of a rigid body and four springy massless legs was derived from the SLIP [8]. Many bounding [912] and galloping [7, 13] gaits were achieved in simulation or experiment environments based on the beam and springy leg (BSL) model. e stability was an important property of locomotion, since the stability could ensure the quadruped robot form a successive locomotion. Most of the authors studied the motion stability of quadruped robot by employing the Poincar´ e return map (PRM) based on the Newton-Raphson method [10, 11, 1416]. e PRM method was designed to search for a group of initial values for maintaining a stable cyclic motion through solving the dynamic equation of the quadruped robot. If the selected initial values were not able to maintain a steady-state bounding or galloping, another group of initial values was used to solve the dynamic equation to judge whether the locomotion was stable or not. e procedures above were repeated until the desired stable locomotion was achieved. Ultimately, many stable cyclic motions would be achieved by the same mechanical parameters of robot. Due to the difficulty in hand-tuning multiple parameters, the optimization algorithm was chosen to search for the initial values when the system was passive [14, 17] or was used to design the control parameters when the system was controlled [1820]. From the analysis of the PRM method, the passive dynamic bounding and galloping gait were achieved by cut and try. e necessary and sufficient conditions of the stability during the stride were not con- cerned when using the PRM method. erefore, the dynamic stability inside the stride was an elusive issue for being not studied elaborately. Meanwhile, other authors also focused on achieving the stable bounding or galloping gait by control strategies. Marhea et al. [13] presented a fuzzy control strategy for the high-speed quadruped bounding and galloping. e fuzzy Hindawi Publishing Corporation Applied Bionics and Biomechanics Volume 2015, Article ID 479615, 17 pages http://dx.doi.org/10.1155/2015/479615

Upload: others

Post on 23-Jun-2020

4 views

Category:

Documents


0 download

TRANSCRIPT

Page 1: Dynamic Imbalance Analysis and Stability Control of ... · Dynamic Imbalance Analysis and Stability Control of ... The spring loaded inverted pendulum (SLIP) model was suitable to

Research ArticleDynamic Imbalance Analysis and Stability Control ofGalloping Gait for a Passive Quadruped Robot

Chunlei Wang,1 Ting Zhang,2 Xiaohui Wei,1 Yongjun Long,1 and Shigang Wang1

1The State Key Laboratory of Mechanical System and Vibration, Shanghai Jiao Tong University, Shanghai 200240, China2College of Mechanical Engineering, Shanghai University of Engineering Science, Shanghai 200030, China

Correspondence should be addressed to Shigang Wang; [email protected]

Received 1 March 2015; Revised 30 May 2015; Accepted 30 May 2015

Academic Editor: Fabio Esposito

Copyright © 2015 Chunlei Wang et al. This is an open access article distributed under the Creative Commons Attribution License,which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.

Some imbalance and balance postures of a passive quadruped robot with a simplified mathematical model are studied. Throughanalyzing the influence of the touchdown angle of the rear leg on the posture of the trunk during the flight phase, the stabilitycriterion is concluded: the closer are the twomoments which are the zero time of the pitching angle and the peak time of the centerof mass, the better is the stability of the trunk posture during the flight phase. Additionally, the validity of the stability criterionis verified for the cat, greyhound, lion, racehorse, basset hound, and giraffe. Furthermore, the stability criterion is also applicablewhen the center of themass of body is shifted. Based on the stability criterion, the necessary and sufficient condition of the gallopingstability for the quadruped robot is proposed to attain a controlled thrust. The control strategy is designed by an optimizationdichotomy algorithm for seeking the zero point of the balance condition. Through the control results, it is demonstrated that theimbalance posture of the trunk could be stabilized by adjusting the stiffness of four legs.

1. Introduction

In recent years, some models were presented to study thetrotting, bounding, and galloping gait of quadruped robot.The spring loaded inverted pendulum (SLIP) model wassuitable to study the hopping of one-legged robot [1, 2],bipedal running of human [3–5], and trotting of quadrupedrobot [6, 7]. Meanwhile, the studying of SLIP model was afundamental work for other models of the quadruped robot.The planar model consisted of a rigid body and four springymassless legs was derived from the SLIP [8]. Many bounding[9–12] and galloping [7, 13] gaits were achieved in simulationor experiment environments based on the beam and springyleg (BSL) model.

The stability was an important property of locomotion,since the stability could ensure the quadruped robot forma successive locomotion. Most of the authors studied themotion stability of quadruped robot by employing thePoincare return map (PRM) based on the Newton-Raphsonmethod [10, 11, 14–16]. The PRM method was designedto search for a group of initial values for maintaining astable cyclic motion through solving the dynamic equation

of the quadruped robot. If the selected initial values werenot able to maintain a steady-state bounding or galloping,another group of initial values was used to solve the dynamicequation to judge whether the locomotion was stable ornot. The procedures above were repeated until the desiredstable locomotion was achieved. Ultimately, many stablecyclic motions would be achieved by the same mechanicalparameters of robot. Due to the difficulty in hand-tuningmultiple parameters, the optimization algorithm was chosento search for the initial values when the system was passive[14, 17] or was used to design the control parameters whenthe system was controlled [18–20]. From the analysis of thePRM method, the passive dynamic bounding and gallopinggait were achieved by cut and try.The necessary and sufficientconditions of the stability during the stride were not con-cerned when using the PRMmethod.Therefore, the dynamicstability inside the stride was an elusive issue for being notstudied elaborately.

Meanwhile, other authors also focused on achievingthe stable bounding or galloping gait by control strategies.Marhefka et al. [13] presented a fuzzy control strategy for thehigh-speed quadruped bounding and galloping. The fuzzy

Hindawi Publishing CorporationApplied Bionics and BiomechanicsVolume 2015, Article ID 479615, 17 pageshttp://dx.doi.org/10.1155/2015/479615

Page 2: Dynamic Imbalance Analysis and Stability Control of ... · Dynamic Imbalance Analysis and Stability Control of ... The spring loaded inverted pendulum (SLIP) model was suitable to

2 Applied Bionics and Biomechanics

logic controller was able to search for the touchdown anglesand the thrusts of legs by tracking the desired running heightand the desired velocity of a quadruped robot in one stride.Finally, the galloping gait was stabilized by the fuzzy logiccontroller with the planar BSL model. Krasny and Orin [18]realized a 3D galloping gait of a small dog with the finitestate machine.The controller adjusted the rest position of legspring to match the designed energy of each leg when it wasat the maximum compression. The control algorithm couldstabilize the pitching motion and the vertical displacement ofcenter of mass (COM) which were considered to be the twokey indicators of the stability in the sagittal plane. Seyfarthet al. [21] presented a movement criterion for running. Theyconcluded that the mechanical self-stabilized running wouldbe achieved by adjusting the leg stiffness for a certain attackangle. At last, the stable runningwas realized for a SLIPmodelby the PRM method. Herr and McMahon [22] employeda ‘hip thrusting and shoulder braking’ method to ensurethe pitching stability and realized a stable galloping gaitof a horse. Designing a control strategy could attain stablerunning including the trotting, bounding, and galloping gait.However, the dynamic balance conditions were not analyzedelaborately. Hence, a necessary and sufficient condition mustbe proposed for judging the stability of the quadruped robot.

As stated in previous paragraph, the stability indicatorsin the sagittal plane are the pitching angle and the heightof COM. Meanwhile, the pitching angular velocity of thetrunk during the flight phase also plays an important rolein maintaining stable locomotion of the robot. In thispaper, the instable state is defined as the tumble of robot;that is, the bottom or the head falls down on the groundwhile the quadruped robot is galloping. Through the BSLmodel, the imbalance postures of the robot with improperpitching angular velocity are studied in this paper. Then, thestability criterion is achieved. Next, the controlled thrust isdesigned by adjusting the leg stiffness on the basis of thestability criterion. Finally, through some simulations, it isdemonstrated that the control method is feasible to stabilizethe trunk posture under the instable initial parameter whilethe quadruped robot is galloping.

In Methods, the simplified model is introduced and thecontrolled thrust is proposed. In Results, by analyzing theimpacts of the pitching angle and angular velocity on thetrunk posture, the stability criterion is proposed. Meanwhile,the controlled thrusts are obtained to stabilize the locomotionby adjusting the leg stiffness. In Discussions, the validity ofthe stability criterion is verified for various animals. Finally,in Conclusions, some summaries are given.

2. Methods

2.1. DynamicalModel andGalloping Simulation of a SimplifiedQuadruped Robot. In the paper, a quadruped robot is usedfor the purpose of analyzing the stability of the galloping gaitand is simplified as a BSL model in sagittal plane [6, 12],as shown in Figure 1. The COM coordinate is (𝑥, 𝑧), thebody pitching angle is 𝜃, and the leg orientation angle is𝛽 while the quadruped robot is running. In addition, thefour legs (front leading leg, front trailing leg, rear leading

z

0

xtdrl

Frl

rt

𝜏rl𝛽rl

(x, z)lb

l0

fl

ftmg

𝜃

x

Figure 1: The simplified quadruped model of a cheetah.

leg, and rear trailing leg) are indicted as fl, f t, rl, and rt,respectively. Furthermore, based on the energy conservationand the Lagrange equations, the dynamic model of the BSLsystem is constructed when the damping energy dissipationterms are ignored.

The dynamic model is derived as

𝑀 𝑞 +𝐵 (𝑞) = 𝑄 (𝑞) , (1)

where 𝑀 = [

𝑚 0 00 𝑚 00 0 𝐽

], 𝑞 = [𝑥 𝑧 𝜃]𝑇. In addition, 𝐵(𝑞) =

[𝐵1(𝑥, 𝑧, 𝜃) 𝐵2(𝑥, 𝑧, 𝜃) 𝐵3(𝑥, 𝑧, 𝜃)]𝑇,

𝐵1 (𝑥, 𝑧, 𝜃) = 𝐾 [𝛿ft (𝑙0 − 𝑙ft) sin𝛽ft + 𝛿fl (𝑙0 − 𝑙fl) sin𝛽fl

+ 𝛿rt (𝑙0 − 𝑙rt) sin𝛽rt + 𝛿rl (𝑙0 − 𝑙rl) sin𝛽rl] ,

𝐵2 (𝑥, 𝑧, 𝜃) = −𝐾 [𝛿ft (𝑙0 − 𝑙ft) cos𝛽ft

+ 𝛿fl (𝑙0 − 𝑙fl) cos𝛽fl + 𝛿rt (𝑙0 − 𝑙rt) cos𝛽rt

+ 𝛿rl (𝑙0 − 𝑙rl) cos𝛽rl] +𝑚𝑔,

𝐵3 (𝑥, 𝑧, 𝜃) = −𝐾𝑙𝑏 [𝛿ft (𝑙0 − 𝑙ft) cos (𝜃 − 𝛽ft)

+ 𝛿fl (𝑙0 − 𝑙fl) cos (𝜃 − 𝛽fl)

− 𝛿rt (𝑙0 − 𝑙rt) cos (𝜃 − 𝛽rt)

− 𝛿rl (𝑙0 − 𝑙rl) cos (𝜃 − 𝛽rl)] .

(2)

Furthermore, 𝑄(𝑞) = [𝑄1(𝑥, 𝑧, 𝜃) 𝑄2(𝑥, 𝑧, 𝜃) 𝑄3(𝑥, 𝑧, 𝜃)]𝑇,

𝑄1 (𝑥, 𝑧, 𝜃) = − 𝛿ft𝐹ft sin𝛽ft − 𝛿fl𝐹fl sin𝛽fl − 𝛿rt𝐹rt sin𝛽rt

− 𝛿rl𝐹rl sin𝛽rl + 𝛿ft𝜏ftcos𝛽ft𝑙ft

+ 𝛿fl𝜏flcos𝛽fl𝑙fl

+ 𝛿rt𝜏rt

cos𝛽rt𝑙rt

+ 𝛿rl𝜏rlcos𝛽rl𝑙rl

,

𝑄2 (𝑥, 𝑧, 𝜃) = − 𝛿ft𝐹ft cos𝛽ft − 𝛿fl𝐹fl cos𝛽fl − 𝛿rt𝐹rt

⋅ cos𝛽rt − 𝛿rl𝐹rl cos𝛽rl + 𝛿ft𝜏ftsin𝛽ft𝑙ft

+ 𝛿fl𝜏flsin𝛽fl𝑙fl

+ 𝛿rt𝜏rtsin𝛽rt𝑙rt

+ 𝛿rl𝜏rlsin𝛽rl𝑙rl

,

Page 3: Dynamic Imbalance Analysis and Stability Control of ... · Dynamic Imbalance Analysis and Stability Control of ... The spring loaded inverted pendulum (SLIP) model was suitable to

Applied Bionics and Biomechanics 3

𝑄3 (𝑥, 𝑧, 𝜃) = 𝑙𝑏 [𝛿ft𝐹ft cos (𝜃 − 𝛽ft) + 𝛿fl𝐹fl cos (𝜃 − 𝛽fl)

− 𝛿rt𝐹rt cos (𝜃 − 𝛽rt) − 𝛿rl𝐹rl cos (𝜃 − 𝛽rl)]

+ 𝛿ft𝜏ft [1−𝑙𝑏sin (𝜃 − 𝛽ft)

𝑙ft]+ 𝛿fl𝜏fl [1

𝑙𝑏sin (𝜃 − 𝛽fl)

𝑙fl]+ 𝛿rt𝜏rt [1−

𝑙𝑏sin (𝜃 − 𝛽rt)

𝑙rt]

+ 𝛿rl𝜏rl [1−𝑙𝑏sin (𝜃 − 𝛽rl)

𝑙rl] .

(3)

Through the dynamicmodel Equation (1), Figure 2 showsthe vertical displacement of the COM, the pitching angle 𝜃,and the pitching angular velocity 𝜔 under the mechanicalparameters and initial values in Table 1. The initial valuesinclude the horizontal displacement 𝑥0 and the verticaldisplacement 𝑧0 of COM, their velocities V

𝑥0 and V𝑧0, the

pitching angle 𝜃0 and the pitching angular velocity𝜔0, and theorientation angles 𝛽tdft and 𝛽tdrt at the moment of touchdown.The distance 𝑑 between the leading and trailing leg when thelegs are in contact with the ground is defined as follows:

𝑑𝑓= 𝑥

tdfl −𝑥

tdft ,

𝑑𝑟= 𝑥

tdrl −𝑥

tdrt .

(4)

From Figure 2(a), a periodic galloping process of acheetah is shown. At the moments 𝑡0 and 𝑡8, the spine ofcheetah shows a maximum flexion posture and the COMof cheetah is at the peak in vertical direction. In addition,at the moments 𝑡1, 𝑡2, and 𝑡3, the rear legs touch down theground, and the legs endure the ground reaction force (GRF).At the moment 𝑡4, the spine of cheetah shows a maximumextension when the COM of cheetah is at the peak in verticaldirection and the pitching angle 𝜃 is zero. Furthermore, at themoments 𝑡5, 𝑡6, and 𝑡7, the front legs touch down the ground.Correspondingly, Figure 2(e) gives the footfall pattern andthe stance duration of the four legs (fl, ft, rl, and rt).While oneand two legs contact the ground during the stance phase, thevelocity 𝑞(V

𝑥, V𝑧, 𝜔) of the trunk is changing. On the contrary,

during the flight phase, the legs do not exert the thrusts on thetrunk, and, as a result, the velocity 𝑞(V

𝑥, V𝑧, 𝜔) is constant.

However, practically, the trajectories of the galloping gaitfor the quadruped robot cannot be always a single kind ofsymmetrical locomotion. When the cheetah suffers from adisturbance, such as stepping on a loose stone, catching asmall animal, or jumping over an obstacle, the cheetah thenmust keep the balance of the trunk for running forward.The trunk stability is dependent on the pitching angle 𝜃 andpitching angular velocity 𝜔. In Results, the instability andstability analyses of the quadruped robot according to (1) arepresented.

2.2. Control Design. Based on the passive dynamic model[6, 14, 29], the mutual transformation of the kinetic energyand potential energy is widely studied. As shown in Figure 3,

Table 1: System parameters and initial conditions.

Variable Value𝑚 (kg) 640𝐾 (N/m) 62200𝑙0(m) 1.5

𝑙𝑏(m) 0.75

𝐽 (kgm2) 240V𝑥0(m/s) 11

𝜔0(rad/s) 6

𝑧0(m) 1.6

𝑥0(m) 0

V𝑧0(m/s) 0

𝜃0(rad) 0

𝑑𝑓(m) 0.6

𝑑𝑟(m) 0.6

𝛽tdft (rad) 0.3540𝛽tdrt (rad) 0.2122𝐹𝑖(N) 0

𝜏𝑖(Nm) 0

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4 0.45 0.51.6

1.651.7

z (m

)

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4 0.45 0.5

00.5

1

𝜃(r

ad)

−0.5

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4 0.45 0.5

26

𝜔(r

ad/s

)

−2

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4 0.45 0.5

rt

rl

ft

fl

Time (s)

z

0

(e)

(d)

(c)

(b)

(a)

t

t0 t1 t2 t3 t4 t5 t6 t7 t8

Figure 2: The galloping process of a cheetah.

first, when the rear trailing leg touches down the ground,the leg starts retracting in a clockwise direction togetherwith compression. Then, when the leg obtains the maximumcompression, the elastic potential energy stored in the rear legis the maximum. Finally, the stored elastic potential energy isreleased until the length of the leg reaches the rest length 𝑙0,

Page 4: Dynamic Imbalance Analysis and Stability Control of ... · Dynamic Imbalance Analysis and Stability Control of ... The spring loaded inverted pendulum (SLIP) model was suitable to

4 Applied Bionics and Biomechanics

z (m

)

x (m)0

Touchdown LiftoffMaximumcompression

xtdrt

tdrt

l 0l0

𝛽 𝛽l0rt

Figure 3: Stance phase of the rear tailing leg.

and the leg starts to lift off the ground and the orientationangle is 𝛽lort .

In addition, the maximum elastic potential energy 𝐸𝑘

stored in the two rear legs is shown in Figure 4 when 𝑑𝑟= 0

and the orientation angle 𝛽tdrt is increasing. Apparently, theelastic potential energy increases gradually and is expressedas

𝐸𝑘= max [1

2𝐾(𝑙rf − 𝑙0)

2+

12𝐾(𝑙rt − 𝑙0)

2] , (5)

where max[⋅] is a maximum function.From (5) and Figure 4, the stiffness of the legs could be

adjusted to keep the energy constant when 𝛽tdrt is increased.As a result, the passive controlled thrusts are designedfrom the view of the mutual conversion of elastic potentialenergy, kinetic energy, and gravitational potential energy.Thedesigned thrusts may be written as

𝐹𝑖= Δ𝐾𝑖(𝑙0 − 𝑙𝑖) , (6)

where Δ𝐾𝑖is the stiffness compensation achieved by an

optimizing condition which will be discussed in Section 3.During locomotion of the quadruped robot, the stiffness

of legs has not been fully used to support the trunk. The legstiffness is not constant but it can be adjusted by itself. Whenthe robot wants to accelerate forward, the leg stiffness willdecrease and when the robot wants to decelerate forward, theleg stiffness will increase.Therefore, in the paper, the stiffnesscompensation is thought as a passive control method [30]and plays an instruction role in active control [31] for thequadruped robot.

3. Results

3.1. Stability Analysis of the Quadruped Robot. For the passivequadruped robot, both the imbalance and balance posturesdepend on the initial mechanical parameters. When thetouchdown angle 𝛽tdrt = (0 ∼ 𝜋/2) rad and 𝑑

𝑟= 0 under

the initial values of the other parameters in Table 1, thetrajectory 𝑞(𝑥, 𝑧, 𝜃) of the trunk may vary with different 𝛽tdft .As shown in Figure 5, the larger the touchdown angle 𝛽tdrtis, the larger, in the negative direction, the pitching angularvelocity𝜔fp of the trunk during the flight phase is. In addition,the pitching angular velocity 𝜔fp during the flight phase is

0 0.2 0.4 0.6 0.8 1 1.20

5000

10000

15000

Ek

(J)

𝛽tdrt (rad)

Figure 4: Maximum elastic potential energy stored in the rear legs.

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4 0.45

0

5

10

Time (s)

0.14

0.35

0.47

0.59

0.71

0.83

0.95

1.07

1.191.31

−5

−10

−15

−20

−25

−30

𝜔(r

ad)

𝛽tdrt =

𝛽tdrt =

𝛽tdrt =

𝛽tdrt =

𝛽tdrt =

𝛽tdrt =

𝛽tdrt =

𝛽tdrt =

𝛽tdrt =

𝛽tdrt =

Figure 5: Pitching angular velocities at different touchdown angles.

given in Figure 6 under the different orientation angles 𝛽tdrt .As shown, 𝜔fp increases approximately linearly when 𝛽tdrt =

(0 ∼ 1.2) rad. Next, the three states of the robot will bediscussed with the different orientation angles 𝛽tdrt .

Figure 7 shows the imbalance posture of the trunk withan insufficient pitching angular velocity. The black half bodyand white half body indicate “head” and “bottom” of thequadruped robot, respectively, in Figure 7(a). When the tworear legs touch down the ground at the same time underthe orientation angle 𝛽tdrt = 0.14 rad, the pitching angularvelocity 𝜔fp of the trunk is insufficient and the pitching angle𝜃 is increasing in an anticlockwise direction after the legs liftoff the ground in Figure 7(d). 𝑧

𝐵is the vertical displacement

of the bottom. In Figure 7(c), when 𝑧𝐵is zero, the bottom

contacts the ground to make the quadruped robot fall downat themoment 𝑡3.Therefore, the insufficient touchdown angle𝛽tdrt will lead to the insufficient pitching angular velocity 𝜔fp

of the trunk. Consequently, the bottom first falls down on theground in Figure 7(a).

Furthermore, when the initial touchdown angle 𝛽tdrt

is equal to 0.32 rad, the pitching angular velocity 𝜔fp of

Page 5: Dynamic Imbalance Analysis and Stability Control of ... · Dynamic Imbalance Analysis and Stability Control of ... The spring loaded inverted pendulum (SLIP) model was suitable to

Applied Bionics and Biomechanics 5

0 0.2 0.4 0.6 0.8 1 1.2

0

−5

−10

−15

−20

−25

(rad)𝛽tdrt

𝜔fp

(rad

/s)

Figure 6: Pitching angular velocities during the flight phase.

B Hz

0

B H B HB H

t0 t1 t2 t3

t

0 0.1 0.2 0.3 0.4 0.5 0.60

0.51

1.5

z (m

)

0 0.1 0.2 0.3 0.4 0.5 0.6012

z B(m

)

0 0.1 0.2 0.3 0.4 0.5 0.60

0.51

𝜃(r

ad)

0 0.1 0.2 0.3 0.4 0.5 0.6Time (s)

rtrl

(e)

(d)

(c)

(b)

(a)

Figure 7: Imbalance posture of trunk with 𝛽tdrt = 0.14 rad.

the trunk is sufficient. As a result, the trunk shows a balanceposture at the moment 𝑡2 in Figure 8. At the same time, thepitching angle 𝜃 is approximately zero at the peak time ofCOM in Figure 8(d). Consequently, the posture of the trunkis stable enough before it is supported by the two front legs atthe moment 𝑡3 as shown in Figure 8(a).

When the initial touchdown angle 𝛽tdrt is equal to 0.54 rad,the pitching angular velocity 𝜔fp is overlarge. As shown inFigure 9(d), the pitching angle 𝜃 of the trunk is more than−𝜋/2 rad at the moment 𝑡2 before the COM reaches the peakof vertical displacement. In addition, the pitching angle 𝜃

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.41.6

1.651.7

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.41

1.52

01

B Hz

0

B HB H B H

(a)

(b)

t0 t1 t2 t3

t

(c)

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4(d)

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4

(e)Time (s)

z (m

)z B

(m)

𝜃(r

ad)

−1

rtrl

Figure 8: Balance posture of trunk with 𝛽tdrt = 0.32 rad.

B H B H

BH

BH B Hz

0t0 t1 t2 t4t3

t

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9012

z (m

)

024

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9

z H(m

)

05

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9

𝜃(r

ad)

−5

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9Time (s)

rtrl

(e)

(d)

(c)

(b)

(a)

Figure 9: Imbalance posture of trunk with 𝛽tdrt = 0.54 rad.

Page 6: Dynamic Imbalance Analysis and Stability Control of ... · Dynamic Imbalance Analysis and Stability Control of ... The spring loaded inverted pendulum (SLIP) model was suitable to

6 Applied Bionics and Biomechanics

at the moment 𝑡3 is about −4.2 rad. Then, the head of thequadruped robotmay fall down on the ground at themoment𝑡4 as shown in Figure 9(a). 𝑧

𝐻is the vertical displacement of

the head shown in Figure 9(b). Therefore, the overlarge 𝜔fpwill result in the pitching angle 𝜃 up to more than −𝜋/2 radbefore COM reaches the peak of the vertical displacementduring the flight phase, so that the head, the bottom, or theback of the trunk may fall down according to the height ofCOM.

By analyzing the balance and imbalance postures of thetrunk Figures 7∼9, the initial condition 𝛽

tdrt will affect the

pitching angle 𝜃 and pitching angular velocity 𝜔fp duringflight phase. Moreover, during 𝛽tdrt = (0 ∼ 𝜋/2) rad, whenthe two moments, which are the zero time of the pitchingangle 𝜃 and the peak time of COM during flight phase, occurat the same time, the trunk shows the best balance posture.In Figure 10, when the 𝛽tdrt increases from 0 to 𝜋/2 rad, thezero time curve of 𝜃 and peak time curve of COM are given.As is shown, when 𝛽tdrt = 0.32 rad and the moment is about0.25 s, the pitching angle 𝜃 is zero. At the same time, the COMreaches the peak of vertical displacement. When 𝛽

tdrt is far

less than 0.32 rad, the bottom of the quadruped robot will falldown on the ground.When the𝛽tdrt is far higher than 0.32 rad,the pitching angle 𝜃 of the trunk will be negatively more than−𝜋/2 rad during the flight phase. In other words, the closerare the two moments which are the zero time of the pitchingangle 𝜃 and the peak time of COM, the better is the stabilityof the trunk posture during the flight phase.

3.2. Control Result for the Instability of the Quadruped Robot.Vlo𝑧, 𝜃lo, and 𝜔lo indicate the vertical velocity, pitching angle,

and angular velocity of the quadruped robot when rearleading leg lifts off the ground and the locomotion of theCOM is described as

Δ𝑧𝑝= Vlo𝑧⋅ 𝑡𝑝−

12𝑔 ⋅ 𝑡

2𝑝,

0 = Vlo𝑧−𝑔 ⋅ 𝑡𝑝,

𝜃lo= 0−𝜔lo

⋅ 𝑡𝜔,

12𝑚 ⋅ (Vlo

𝑧)

2= 𝑚𝑔 ⋅ Δ𝑧

𝑝,

(7)

where Δ𝑧𝑝is the vertical displacement of COM from liftoff

to the peak during the flight phase, 𝑡𝑝is the corresponding

time interval,𝑔 is the acceleration of gravity, and 𝑡𝜔is the time

interval from liftoff to the zero point of 𝜃 during the flightphase.

Based on the discussion of Figure 10, if 𝑡𝑝

= 𝑡𝜔, a

best balance posture of the trunk during the flight phase ispresented. Therefore, (7) may be transformed as

Con = 𝜔loVlo𝑧+𝑔𝜃

lo= 0. (8)

In a word, (8) is the necessary and sufficient conditionof a best balance for the quadruped galloping. When thequadruped robot exposes an imbalance posture with a ran-dom touchdown angle𝛽tdrt , the controlled thrusts equation (6)

0 0.2 0.4 0.6 0.8 1 1.2

0.1

0.2

0.3

0.4

0.5

0.6

0.7

0.8

Zero of 𝜃Peak of z

Zero

tim

e of𝜃

and

peak

tim

e of C

OM

(s)

𝛽tdrt (rad)

Figure 10: The zero time of pitching angle and the peak time ofCOM.

is designed to compensate the difference between the zerotime of pitching angle and the peak time of COM by solvingthe best balance condition equation (8) and the dynamicequation (1) coordinately. Then, the controlled thrust whichdepends on the coefficient Δ𝐾

𝑖in (6) is achieved by using an

optimization algorithm to find zero point of (8).Figure 11 shows an imbalance posture of the quadruped

robot based on the parameters in Table 1 without control.When the initial condition is set as 𝛽tdft = 0.6 rad, 𝛽tdrt =

0.5 rad, 𝑑𝑓= 0.1m, and 𝑑

𝑟= 0.5m, the pitching angle

𝜃 nearest to zero is at time 𝑡 = 0.2063 s. However, thevertical displacement 𝑧 of COM does not reach the peak atthis time. Therefore, after touchdown and liftoff of the frontlegs, the trunk rotates up to about −2.9 rad at the moment 𝑡4in Figure 11(c). This will cause a tumbling and even a pulledmuscle for the animals.

Therefore, the controlled thrusts of the hind limb arerequired to stabilize the pitching motion and the height ofCOMwhich are considered to be the indicators of stability insagittal plane.The designed thrusts are given as follows basedon (6):

𝐹𝑐= Δ𝐾𝑓[𝛿fl (𝑙0 − 𝑙fl) + 𝛿ft (𝑙0 − 𝑙ft)]

+Δ𝐾𝑟[𝛿rl (𝑙0 − 𝑙rl) + 𝛿rt (𝑙0 − 𝑙rt)] .

(9)

The stiffness variation as the control input is achieved bysolving the dynamic equation (1) with the control objectivesequation (8). Meanwhile, the galloping stability criterionequation (8) is solved to seek its zero point by a dichotomyalgorithm [32, 33]. At last, Δ𝐾

𝑓and Δ𝐾

𝑟are achieved as

Δ𝐾𝑓= −3.9626 × 104 N/m, Δ𝐾

𝑟= −3.4357 × 104 N/m.

The control result is presented in Figure 12. With thecontrolled thrusts, a balance posture of the quadruped robotis achieved. With the stiffness compensation Δ𝐾

𝑟, the two

rear legs touch down the ground with initial conditions 𝛽tdrt =0.5 rad and 𝑑

𝑟= 0.5m. At the end of the stance phase, the legs

Page 7: Dynamic Imbalance Analysis and Stability Control of ... · Dynamic Imbalance Analysis and Stability Control of ... The spring loaded inverted pendulum (SLIP) model was suitable to

Applied Bionics and Biomechanics 7

B Hz

0

B HB H

BH BH

BH

t0 t1 t2 t3 t4 t5

t

0 0.1 0.2 0.3 0.4 0.5 0.6 0.71.5

22.5

z (m

)

05

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7

−5−10

𝜃(r

ad)

010

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7

−10−20𝜔

(rad

/s)

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7Time (s)

ftrt

rl fl

(e)

(d)

(c)

(b)

(a)

Figure 11: Imbalance posture of the quadruped robot withoutcontrol.

0 0.1 0.2 0.3 0.4 0.5 0.6 0.71.5

1.6

1.7

0

1

05

10

B H B HB H B H B H

z (m

)𝜃

(rad

)𝜔

(rad

/s)

−1

−5

t0 t1 t2 t3 t4

t

z

0

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7Time (s)

(a)

(b)

(c)

(d)

(e)

ftrt

rl fl

Figure 12: Balance posture of the quadruped robot with control.

lift off the ground with Con𝑟= 0 (namely, 𝜔lo

rl Vlo𝑧,rl +𝑔𝜃

lorl = 0).

At the moment 𝑡2, the COM reaches the peak (Figure 12(b)),and, meanwhile, the pitching angle 𝜃 is zero (Figure 12(c))during the first flight phase. Furthermore, with the stiffnesscompensation Δ𝐾

𝑓, the front legs touch down the ground

with 𝛽tdft = 0.6 rad and 𝑑𝑓= 0.1m. Then, the front legs lift

off the ground with Con𝑓= 0, (namely, 𝜔lo

fl Vlo𝑧,fl + 𝑔𝜃

lofl = 0).

Finally, at the moment 𝑡4, the trunk reaches the second peakwith V

𝑧= 0 and 𝜃 = 0 during the second flight phase in

Figure 12(a). Moreover, the controlled thrusts are calculatedand shown in Figure 13; the legend “rt”, “rl”, “ft,” and “fl”indicate the 𝐹rt, 𝐹rl, 𝐹ft, and 𝐹fl, respectively.

4. Discussions

4.1. Scale Factor of Stability Criterion. As shown inSection 3.1, the stability criterion is applicable for theparameters of a quadruped robot listed in Table 1. In thissection, the applicability of the stability criterion is verifiedfor several animals including cat, grey hound, lion, andhorse, as their body weights vary from small to large [23–28].The corresponding parameters are listed in Table 2.

As shown in Figure 14, the domestic cat also complieswith the stability criterion. When the touchdown angle 𝛽tdrtis set as 0.07 rad, at the moment 𝑡3, the bottom of the catfalls down on the ground which is an imbalance posture dueto the less thrust provided by the hind limb during stancephase (Figure 14(a)). The balance posture conforming to thestability criterion equation (8) is shown in Figure 14(b) when𝛽tdrt is set as 0.35 rad. In addition, the dashed line indicates

the moment when the zero time of pitching angle and peaktime of COM are equal. While 𝛽tdrt is set as 0.8 rad, the catsomersaults forward during flight phase (Figure 14(c)) for thelarge thrust of hind limb during stance phase. Meanwhile,Figure 14(d) demonstrates the variation of zero time ofpitching angle and peak time of COMwith touchdown angle.As stated in Section 3.1, the closer are the twomoments whichare the zero time of the pitching angle and the peak time ofCOM, the better is the stability of the torso posture duringthe flight phase. As a result, the touchdown angle 𝛽tdrt at theintersection of the two curves could make the cat form astable state during flight phase.

The imbalance and balance postures of greyhound, lion,and racehorse are shown in Figures 15∼17. All of the testscomply with the stability criterion equation (8). In addition,all the imbalance and balance postures are also similar tothe cat. For instance, when the touchdown angle is smallerthan the stable touchdown angle (STA) at the intersectionof the zero time curve of pitching angle and the peak timecurve of COM, the animals will emerge as an overlarge nose-up pitching motion. Thereby, the bottom of the animals willcontact the ground. On the contrary, if the touchdown angleis larger than the STA, the overlarge nose-down motion willemerge, and, consequently, the head will contact the groundor the body will generate a clockwise somersault during flightphase. The curves of pitching angle and height of COM varyfrom animal to animal, although there are same regulationsof the tumble for them. Just because of the same regulations

Page 8: Dynamic Imbalance Analysis and Stability Control of ... · Dynamic Imbalance Analysis and Stability Control of ... The spring loaded inverted pendulum (SLIP) model was suitable to

8 Applied Bionics and Biomechanics

Table 2: Parameters of animals and the initial values of simulation [23–28].

Variable Cat Greyhound Lion Racehorse Basset hound Giraffe𝑚 (kg) 3.7 35 167 900 25 1200𝐾 (N/m) 3200 7000 62200 62200 7000 62200𝑙0(m) 0.285 0.6 0.755 1.4 0.22 2

𝑙𝑏(m) 0.16 0.26 0.45 0.65 0.3 0.5

V𝑥0(m/s) 5 1 9 8 1 3

𝜔0(rad/s) 12 12 6 7 12 9

𝑧0(m) 0.3 0.7 0.8 1.5 0.3 2.1

𝑥0(m) 0 0 0 0 0 0

V𝑧0(m/s) 0 0 0 0 0 0

𝜃0(rad) 0 0 0 0 0 0

Time (s)0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8

×104

0

−0.2

−0.4

−0.6

−0.8

−1

−1.2

−1.4

−1.6

−1.8

−2

Fc

(N)

ftrtrl fl

Figure 13: Controlled thrusts.

of the tumble of greyhound, lion, and racehorse as cat, theirimbalance and balance postures will not be elaborated again.

4.2. The Applicability of the Stability Criterion for the Animalswith Special Body Size. The basset hound and the giraffe aretwo special animals for the length proportion between leg andtorso. The legs of basset hound are much shorter than thetorso, while the legs of giraffe are much longer than the torso.The lengths of leg and torso are listed in Table 2. Therefore,we test the applicability of the stability criterion for the twoanimals in this section.

The imbalance and balance postures of basset hound areshown in Figure 18. The overlarge nose-up motion of bassethound emerges which is induced by the small thrust whenthe touchdown angle is less than the STA. As a result, thebottom of the basset hound will contact the ground when thetouchdown angle is set as 0.2 rad (Figure 18(a)). The stablestate emerges when the touchdown angle of hind limb is set as0.4 radwhich is equal to the STA.Meanwhile, the zero time ofpitching angle that is the peak time of COM is 0.26 s (Figures18(b) and 18(e)).When the touchdown angle is larger than the

STA, the nose-down motion of basset hound emerges. Then,the head contacts the ground when the touchdown angle isset as 0.49 rad (Figure 18(c)). When the touchdown angle isset as 0.78 rad, the zero time of pitching angle and the peaktime of COM are very close (Figure 18(e)). According to thestability criterion, the posture of basset hound is almost stablewith a touchdown angle of 0.78 rad (Figure 18(d)).

The imbalance and balance postures of giraffe are shownin Figure 19. There are two intersections between the zerotime curve of the pitching angle and peak time curve ofCOM.Therefore, there are two STAs for the givenmechanicalparameters and initial values of giraffe listed in Table 2. Thefirst STA is 0.34 rad, and the second one is 0.50 rad. All of theinstable touchdown angles are divided into three sections bythe two STAs. The peak time of COM is earlier than the zerotime of pitching angle when the touchdown angle is less thanthe first STA or larger than the second STA (Figure 19(f)). Asa result, the torso emerges as a positive angle when the giraffeis at the peak time of COM; at last, the backward somersaultis generated (Figures 19(a) and 19(e)). The two STAs resultin different stable states, and the height of COM and theamplitude of the pitching angle with the second STA are bothlarger than those with the first STA.That is the larger thrust isexerted by the hind limb with the second STA (Figures 19(b)and 19(d)). The peak time of COM is later than the zero timeof pitching angle when the touchdown angle is set inside therange between the first and second STAs. Consequently, thetorso emerges as a negative angle when the giraffe is at thepeak time of COM. Finally, the imbalance postures with anoverlarge nose-down motion are achieved (Figure 19(c)).

4.3. The Stability Analysis with the Shift of COM. The COMof the carnivore will be shifted when it runs with a prey inits mouth. The running dynamics will be changed with thedisplacement of COM. So, we analyze the influence of theCOM shift on the stability and dynamics of carnivore. Theadditional mass is in the mouth of the carnivore and variesfrom 0 to 75 kg. The largest additional mass is twelve percentof the carnivore mass. The ratio between additional weightand carnivore weight can mimic the case that the carnivoreshold a prey in the mouth. The simplified force diagram isshown in Figure 20, where 𝑚

𝑎indicates the body mass of

Page 9: Dynamic Imbalance Analysis and Stability Control of ... · Dynamic Imbalance Analysis and Stability Control of ... The spring loaded inverted pendulum (SLIP) model was suitable to

Applied Bionics and Biomechanics 9

0 0.05 0.1 0.15 0.20

0.20.4

00.10.20.3

00.5

1

B Hz

0

B HB

H

BH

t0 t1 t2 t3

t

(A)

(B)

z (m

)z B

(m)

0 0.05 0.1 0.15 0.2(C)

0 0.05 0.1 0.15 0.2(D)

0 0.05 0.1 0.15 0.2

(E)Time (s)

𝜃(r

ad)

rtrl

(a)

0 0.02 0.04 0.06 0.08 0.1 0.12 0.14 0.160.29

0.30.310.32

0.20.30.4

00.5

B H B H B H B H

z (m

)z B

(m)

𝜃(r

ad)

(B)

0 0.02 0.04 0.06 0.08 0.1 0.12 0.14 0.16(C)

0 0.02 0.04 0.06 0.08 0.1 0.12 0.14 0.16(D)

0 0.02 0.04 0.06 0.08 0.1 0.12 0.14 0.16

(E)Time (s)

−0.5

z

0 t0 t1 t2 t3

t

(A)

rtrl

(b)

0 0.05 0.1 0.15 0.2 0.250.20.30.4

0.20.4

02

B H B HBH

BH

z (m

)

(B)

0 0.05 0.1 0.15 0.2 0.25(C)

0 0.05 0.1 0.15 0.2 0.25(D)

0 0.05 0.1 0.15 0.2 0.25

(E)Time (s)

z H(m

)

−2−4−6

𝜃(r

ad)

z

0 t0 t1 t2 t3

t

(A)

rtrl

(c)

0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9 1 1.10.040.060.08

0.10.120.140.160.18

0.20.220.24

Zero of 𝜃Peak of z

Zero

tim

e of𝜃

and

peak

tim

e of C

OM

(s)

𝛽tdrt (rad)

(d)

Figure 14: Imbalance and balance postures of cat. (a)The imbalance posturewhen𝛽tdrt = 0.15 rad; (b) the balance posturewhen𝛽td

rt = 0.35 rad;(c) the imbalance posture when 𝛽td

rt = 0.80 rad; (d) the zero time of pitching angle and the peak time of COM.

Page 10: Dynamic Imbalance Analysis and Stability Control of ... · Dynamic Imbalance Analysis and Stability Control of ... The spring loaded inverted pendulum (SLIP) model was suitable to

10 Applied Bionics and Biomechanics

0 0.1 0.2 0.3 0.4 0.5 0.60

0.51

0

0.51

0123

B H B H

BH

BH

BHz

0t0 t1 t2 t4t3

t

(A)

(B)

0 0.1 0.2 0.3 0.4 0.5 0.6(C)

0 0.1 0.2 0.3 0.4 0.5 0.6(D)

0 0.1 0.2 0.3 0.4 0.5 0.6

(E)Time (s)

z (m

)z B

(m)

𝜃(r

ad)

rtrl

(a)

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.40.650.7

0.750.8

0.40.60.8

1

0

1

B H BH B HB Hz

0

z (m

)

t0 t1 t2 t3

t

(A)

−1z B

(m)

(B)

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4(C)

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4(D)

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4

(E)Time (s)

𝜃(r

ad)

rtrl

(b)

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4 0.45

0.650.7

0.750.8

0.40.60.8

1

02

B Hz

0

B H BH

B H

t0 t1 t2 t3

t

(A)

(B)

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4 0.45(C)

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4 0.45(D)

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4 0.45

(E)Time (s)

z (m

)z H

(m)

−2𝜃(r

ad)

rtrl

(c)

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9

0.2

0.25

0.3

0.35

0.4

0.45

0.5

0.55

Zero of 𝜃Peak of z

Zero

tim

e of𝜃

and

peak

tim

e of C

OM

(s)

𝛽tdrt (rad)

(d)

Figure 15: Imbalance and balance postures of greyhound. (a) The imbalance posture when 𝛽tdrt = 0.07 rad; (b) the balance posture when

𝛽tdrt = 0.21 rad; (c) the imbalance posture when 𝛽td

rt = 0.39 rad; (d) the zero time of pitching angle and the peak time of COM.

Page 11: Dynamic Imbalance Analysis and Stability Control of ... · Dynamic Imbalance Analysis and Stability Control of ... The spring loaded inverted pendulum (SLIP) model was suitable to

Applied Bionics and Biomechanics 11

0 0.05 0.1 0.15 0.2 0.25 0.3 0.350.40.60.8

1

00.5

1

00.5

1

B Hz

0

B HB H

B H

t0 t1 t2 t3

t

(A)

z (m

)

(B)

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35(C)

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35(D)

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35

(E)Time (s)

z B(m

)𝜃

(rad

)

rtrl

(a)

0 0.05 0.1 0.15 0.2 0.250.78

0.80.820.84

0.70.80.9

1

0

0.5

B H B HB H B H

t0 t1 t2 t3

t

(A)

(B)

0 0.05 0.1 0.15 0.2 0.25(C)

0 0.05 0.1 0.15 0.2 0.25(D)

0 0.05 0.1 0.15 0.2 0.25

(E)Time (s)

z B(m

)z

(m)

−0.5𝜃

(rad

)

z

0

rtrl

(b)

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.40.70.80.9

1

0.40.60.8

1

02

B H B H

BH

BH

t0 t1 t2 t3

t

(A)

z (m

)z H

(m)

𝜃(r

ad)

−2−4

(B)

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4(C)

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4(D)

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4

(E)Time (s)

z

0

rtrl

(c)

0.2 0.4 0.6 0.8 1 1.20

0.1

0.2

0.3

0.4

0.5

0.6

0.7

Zero of 𝜃Peak of z

Zero

tim

e of𝜃

and

peak

tim

e of C

OM

(s)

𝛽tdrt (rad)

(d)

Figure 16: Imbalance and balance postures of lion. (a) The imbalance posture when 𝛽tdrt = 0.12 rad; (b) the balance posture when 𝛽td

rt =

0.36 rad; (c) the imbalance posture when 𝛽tdrt = 0.64 rad; (d) the zero time of pitching angle and the peak time of COM.

Page 12: Dynamic Imbalance Analysis and Stability Control of ... · Dynamic Imbalance Analysis and Stability Control of ... The spring loaded inverted pendulum (SLIP) model was suitable to

12 Applied Bionics and Biomechanics

0 0.1 0.2 0.3 0.4 0.50.5

1

1.5

00.5

11.5

0

1

2

B H B H

BH

BHB

Hz

0 t0 t1 t3t2 t4

t

(A)

(B)

0 0.1 0.2 0.3 0.4 0.5(C)

0 0.1 0.2 0.3 0.4 0.5(D)

0 0.1 0.2 0.3 0.4 0.5

(E)Time (s)

z (m

)z B

(m)

𝜃(r

ad)

rtrl

(a)

1.31.41.51.6

0.51

1.52

01

B H BH

B H B H

(B)

z (m

)z B

(m)

𝜃(r

ad)

z

0 t0 t1 t3t2

t

(A)

−1

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4 0.45 0.5

(C)0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4 0.45 0.5

(D)0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4 0.45 0.5

(E)Time (s)

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4 0.45 0.5

rtrl

(b)

0 0.1 0.2 0.3 0.4 0.5 0.61

1.5

2

11.5

2

02

B H B H

BH

BHz

0 t0 t1 t3t2

t

(A)

z (m

)

(B)

0 0.1 0.2 0.3 0.4 0.5 0.6(C)

0 0.1 0.2 0.3 0.4 0.5 0.6(D)

0 0.1 0.2 0.3 0.4 0.5 0.6

(E)Time (s)

z H(m

)𝜃

(rad

)

−2−4

rtrl

(c)

0.4 0.5 0.6 0.7 0.8 0.9 1 1.1 1.2 1.30.2

0.3

0.4

0.5

0.6

0.7

0.8

0.9

Zero of 𝜃Peak of z

Zero

tim

e of𝜃

and

peak

tim

e of C

OM

(s)

𝛽tdrt (rad)

(d)

Figure 17: Imbalance and balance postures of racehorse. (a) The imbalance posture when 𝛽tdrt = 0.21 rad; (b) the balance posture when

𝛽tdrt = 0.60 rad; (c) the imbalance posture when 𝛽td

rt = 0.76 rad; (d) the zero time of pitching angle and the peak time of COM.

Page 13: Dynamic Imbalance Analysis and Stability Control of ... · Dynamic Imbalance Analysis and Stability Control of ... The spring loaded inverted pendulum (SLIP) model was suitable to

Applied Bionics and Biomechanics 13

0 0.02 0.04 0.06 0.08 0.1 0.12 0.14 0.16 0.18

0.290.3

0.310.32

00.10.20.3

00.5

11.5

B HB H BH

BHBHz

0 t0 t1 t2 t3 t4

t

(A)

z (m

)

(B)

0 0.02 0.04 0.06 0.08 0.1 0.12 0.14 0.16 0.18(C)

0 0.02 0.04 0.06 0.08 0.1 0.12 0.14 0.16 0.18(D)

0 0.02 0.04 0.06 0.08 0.1 0.12 0.14 0.16 0.18

(E)Time (s)

z B(m

)𝜃

(rad

)

rtrl

(a)

0 0.05 0.1 0.15 0.2 0.25 0.3 0.350.20.30.40.5

00.20.4

0

1

BHB H B H B H

z (m

)

t0 t1 t2 t3

t

(A)

(B)

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35(C)

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35(D)

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35

(E)Time (s)

−1

z B(m

)𝜃

(rad

)

z

0

rtrl

(b)

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.40.20.30.40.5

00.20.4

01

BHHB B H B

H

BHz

0 t0 t1 t2 t3 t4

t

(A)

z (m

)𝜃

(rad

)z H

(m)

−1

−2

(B)

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4(C)

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4(D)

0 0.05 0.1 0.15 0.2 0.25 0.3 0.35 0.4

(E)Time (s)

rtrl

(c)

0 0.02 0.04 0.06 0.08 0.1 0.12 0.14 0.16 0.18 0.20.25

0.3

0.35

0.20.4

00.5

1

B HB H B H B H

z (m

)𝜃

(rad

)z H

(m)

−0.5

z

0 t0 t1 t2 t3

t

0 0.02 0.04 0.06 0.08 0.1 0.12 0.14 0.16 0.18 0.2

0 0.02 0.04 0.06 0.08 0.1 0.12 0.14 0.16 0.18 0.2

0 0.02 0.04 0.06 0.08 0.1 0.12 0.14 0.16 0.18 0.2Time (s)

(A)

(B)

(C)

(D)

(E)

rtrl

(d)

Figure 18: Continued.

Page 14: Dynamic Imbalance Analysis and Stability Control of ... · Dynamic Imbalance Analysis and Stability Control of ... The spring loaded inverted pendulum (SLIP) model was suitable to

14 Applied Bionics and Biomechanics

0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9 1 1.10.1

0.15

0.2

0.25

0.3

0.35

0.4

0.45

0.5

Zero of 𝜃Peak of z

Zero

tim

e of𝜃

and

peak

tim

e of C

OM

(s)

𝛽tdrt (rad)

(e)

Figure 18: Imbalance and balance postures of basset hound. (a) the imbalance posture when 𝛽tdrt = 0.20 rad; (b) the balance posture when

𝛽tdrt = 0.40 rad; (c) the imbalance posture when 𝛽td

rt = 0.49 rad; (d) the balance posture when 𝛽tdrt = 0.78 rad; (e) the zero time of pitching angle

and the peak time of COM.

prey and 𝑚 indicates the body mass of the carnivore. Thesimulation parameters and the initial values of the carnivoreare shown in Table 1.

All of the simulations comply with the stability criterionequation (8) when the additional mass varies from 0 to 75 kg.However, the stable point, that is, the intersection of the zerotime curve of pitching angle and the peak time curve ofCOM, increases almost linearly with the increasing of theprey weight (Figure 21). In other words, the larger the preyweight, the larger the STA and the longer the time needed toachieve the stable state. As a result, larger thrusts providedby the hind limb are needed. However, as shown in Figure 21,the zero time of pitching angle varies from 0.2565 to 0.2632 s,and the time difference of 0.0067 s is a very small interval.The same case emerges in the STA which varies from 0.315 to0.365 rad. Hence, the angular difference (namely, 0.05 rad) isalso a small interval. In conclusion, the influence induced bythe COM shift is so little that it could be even neglected.

4.4. The Control Strategy Based on Passive Dynamics. Thestructural parameters of a robot have been fixed when thedynamic model is built; in this case, the stable running couldbe achieved by adjusting the stiffness and the touchdownangle of leg when the initial conditions are given [21]. Whenthe quadruped robot exposes an imbalance posture with theinstable touchdown angle, the leg stiffness is adjusted tocompensate the attitude deviation. On the contrary, when therobot exposes an imbalance posture for certain leg stiffness,touchdown angle could be adjusted to compensate the atti-tude deviation. The latter method is same as the process inwhich we achieve the stability criterion. At last, both of thecontrol methods comply with the stability criterion equation(8). In this paper, the dynamic equation of the robot issimulated passively which could reveal the inherent dynamic

characteristics of the robot. Meanwhile, the control methodpresented in this paper is also based on the passive dynamics.If a robot runs with the passive stable state, just as the statemeets the stability criterion of (8), then it needs a little controlaction to maintain the stable running [11]. Additionally, thestrength of the control action varies monotonously with thedeviation degree between the zero time of pitching angle andthe peak time of COM. Although the model simulated in ourstudy is simple, the stability criterion is instructive for thedesign theory and the control strategy of robot.

5. Conclusions

In the paper, a stability criterion is presented based onthe passive dynamic galloping. First, the dynamical modelof the quadruped robot is constructed on the basis of theenergy conservation law. Through the mathematical model,the imbalance and balance postures of a passive quadrupedrobot are analyzed. Then, a necessary and sufficient balancecondition that is the stability criterion is attained. In addi-tion, the validity of the stability criterion is verified againstcat, greyhound, lion, and racehorse with the body weightvarying from small to large. Besides, the stability criterionis applicable to the basset hound and giraffe, whose legs aremuch shorter or much longer than the torso. Furthermore,the applicability of the stability criterion is verified whenthe carnivore holds a prey in its mouth. The results supportthe conclusion that the influence of the COM shift on thestability criterion is almost negligible. Next, the controlledthrust is obtained with an optimization dichotomy algorithmfor seeking the zero point of the stability criterion when theanimal exposes imbalance postures. Finally, the imbalancepostures of a galloping gait are stabilized with the controlled

Page 15: Dynamic Imbalance Analysis and Stability Control of ... · Dynamic Imbalance Analysis and Stability Control of ... The spring loaded inverted pendulum (SLIP) model was suitable to

Applied Bionics and Biomechanics 15

22.05

2.12.15

1.81.6

22.2

0

1

2

B HB H

BH

BH

z

0 t0 t1 t3t2

t

(A)

0 0.10.05 0.15 0.25 0.350.2 0.3 0.4(B)

0 0.10.05 0.15 0.25 0.350.2 0.3 0.4(C)

0 0.10.05 0.15 0.25 0.350.2 0.3 0.4(D)

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9 1

(E)Time (s)

z (m

)z B

(m)

𝜃(r

ad)

rtrl

(a)

012

2

2.2

2.4

BH

B H B H B Hz

0 t0 t1 t3t2

t

(A)

z (m

)

1.52

2.53

z B(m

)𝜃

(rad

)

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7(B)

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7(C)

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7(D)

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7

(E)Time (s)

−1

rtrl

(b)

BH

B H B H BH

z

0 t0 t1 t3t2

t

(A)

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9(B)

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9(C)

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9(D)

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9

(E)Time (s)

1.5

2

2.5

z (m

)

02

1.52

2.53

𝜃(r

ad)

−2

z H(m

)

rtrl

(c)

BH

B H B H B Hz

0 t0 t1 t3t2

t

(A)

(E)Time (s)

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9 1(B)

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9 1(C)

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9 1

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9 1

(D)

z (m

)

0

2

1.52

2.53

1.52

2.53

𝜃(r

ad)

−2

z H(m

)

rtrl

(d)

Figure 19: Continued.

Page 16: Dynamic Imbalance Analysis and Stability Control of ... · Dynamic Imbalance Analysis and Stability Control of ... The spring loaded inverted pendulum (SLIP) model was suitable to

16 Applied Bionics and Biomechanics

0123

BH

B H

BH

BH

t0 t1 t3t2

t

(A)

z

0

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9 1(B)

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9 1(C)

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9 1(D)

0 0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8 0.9 1

(E)Time (s)

z (m

)

1.52

2.53

22.5

3.53

𝜃(r

ad)

z H(m

)

rtrl

(e)

0.1 0.2 0.3 0.4 0.5 0.6 0.7 0.8

0.4

0.5

0.6

0.7

0.8

0.9

1

Zero of 𝜃Peak of z

Zero

tim

e of𝜃

and

peak

tim

e of C

OM

(s)

𝛽tdrt (rad)

(f)

Figure 19: Imbalance and balance postures of giraffe. (a) The imbalance posture when 𝛽tdrt = 0.14 rad; (b) the balance posture when 𝛽td

rt =

0.34 rad; (c) the imbalance posture when 𝛽tdrt = 0.42 rad; (d) the balance posture when 𝛽td

rt = 0.50 rad; (e) the imbalance posture when𝛽tdrt = 0.53 rad; (f) the zero time of pitching angle and the peak time of COM.

mg mag

Figure 20: The diagram of force analysis when the carnivores holda prey in the mouth.

thrust by adjusting the stiffness of the legs. The validity ofthe stability criterion and the control method are verified bythe controlled results.

Conflict of Interests

The authors declare that there is no conflict of interestsregarding the publication of this paper.

0.315 0.32 0.325 0.33 0.335 0.34 0.345 0.35 0.355 0.36 0.3650.256

0.257

0.258

0.259

0.26

0.261

0.262

0.263

0.264

0.265

75kg

60kg45kg

30kg

15kg

0

Zero

tim

e of𝜃

and

peak

tim

e of C

OM

(s)

ma =

ma =

ma =

ma =

ma =

ma =

𝛽tdrt (rad)

Figure 21: Zero time of pitching angle and peak time of COM.Thedark triangles indicate different intersections between the zero timecurve of the pitching angle and the peak time curve of COM withdifferent weights of prey.

Acknowledgment

This project is supported by the National Natural ScienceFoundation of China (Grant no. 51375303).

Page 17: Dynamic Imbalance Analysis and Stability Control of ... · Dynamic Imbalance Analysis and Stability Control of ... The spring loaded inverted pendulum (SLIP) model was suitable to

Applied Bionics and Biomechanics 17

References

[1] M. H. Raibert, H. B. Brown Jr., and M. Chepponis, “Exper-iments in blance with a 3D one-legged hopping machine,”International Journal of Robotics Research, vol. 3, no. 2, pp. 75–92, 1984.

[2] H. Geyer, A. Seyfarth, and R. Blickhan, “Spring-mass running:simple approximate solution and application to gait stability,”Journal of Theoretical Biology, vol. 232, no. 3, pp. 315–328, 2005.

[3] A. Seyfarth, H.Geyer, andH.Herr, “Swing-leg retraction: a sim-ple control model for stable running,” Journal of ExperimentalBiology, vol. 206, no. 15, pp. 2547–2555, 2003.

[4] Y. Blum, S. W. Lipfert, J. Rummel, and A. Seyfarth, “Swing legcontrol in human running,” Bioinspiration & Biomimetics, vol.5, no. 2, Article ID 026006, 2010.

[5] T. Qing, X. Rong, and C. Jian, “Tip over avoidance control forbiped robot,” Robotica, vol. 27, no. 6, pp. 883–889, 2009.

[6] Q. Deng, S. G. Wang, Q. H. Liang, and J. Q. Mo, “The effect ofbody pitching on leg-spring behavior in quadruped running,”Journal of Bionic Engineering, vol. 7, no. 3, pp. 219–227, 2010.

[7] X. Wei, C. Wang, Y. Long, and S. Wang, “Pitch angular velocitydynamics property in transverse galloping pattern from thepassive dynamic perspective,” Proceedings of the Institution ofMechanical Engineers, Part C: Journal ofMechanical EngineeringScience, 2014.

[8] P. Nanua and K. J. Waldron, “Energy comparison betweentrot, bound, and gallop using a simple model,” Journal ofBiomechanical Engineering, vol. 117, no. 4, pp. 466–473, 1995.

[9] I. Poulakakis, J. A. Smith, andM. Buehler, “Modeling and exper-iments of untethered quadrupedal running with a boundinggait: the scout II robot,” The International Journal of RoboticsResearch, vol. 24, no. 4, pp. 239–256, 2005.

[10] I. Poulakakis, E. Papadopoulos, and M. Buehler, “On thestability of the passive dynamics of quadrupedal running witha bounding gait,” International Journal of Robotics Research, vol.25, no. 7, pp. 669–687, 2006.

[11] P. Chatzakos and E. Papadopoulos, “Bio-inspired design ofelectrically-driven bounding quadrupeds via parametric analy-sis,”Mechanism andMachineTheory, vol. 44, no. 3, pp. 559–579,2009.

[12] J. A. Smith, I. Poulakakis, M. Trentini, and I. Sharf, “Boundingwith active wheels and liftoff angle velocity adjustment,” Inter-national Journal of Robotics Research, vol. 29, no. 4, pp. 414–427,2010.

[13] D.W.Marhefka, D. E. Orin, J. P. Schmiedeier, and K. J.Waldron,“Intelligent control of quadruped gallops,” IEEE/ASMETransac-tions on Mechatronics, vol. 8, no. 4, pp. 446–456, 2003.

[14] Q. Deng, S. Wang, W. Xu, J. Mo, and Q. Liang, “Quasipassive bounding of a quadrupedmodel with articulated spine,”Mechanism and Machine Theory, vol. 52, pp. 232–242, 2012.

[15] X.Wei, Y. Long, C.Wang, and S.Wang, “Rotary gallopingwith alock–unlock elastic spinal joint,” Proceedings of the Institution ofMechanical Engineers, Part C: Journal ofMechanical EngineeringScience, 2014.

[16] M. D. Berkemeier, “Modeling the dynamics of quadrupedalrunning,”The International Journal of Robotics Research, vol. 17,no. 9, pp. 971–985, 1998.

[17] Q. Zhao, H. Sumioka, K. Nakajima, X. Yu, and R. Pfeifer,“Spine as an engine: effect of spinemorphology on spine-drivenquadruped locomotion,” Advanced Robotics, vol. 28, no. 6, pp.367–378, 2014.

[18] D. P. Krasny and D. E. Orin, “Evolution of a 3d gallop in aquadrupedal model with biological characteristics,” Journal ofIntelligent and Robotic Systems:Theory and Applications, vol. 60,no. 1, pp. 59–82, 2010.

[19] G. S. Hornby, S. Takamura, T. Yamamoto, and M. Fujita,“Autonomous evolution of dynamic gaits with two quadrupedrobots,” IEEE Transactions on Robotics, vol. 21, no. 3, pp. 402–410, 2005.

[20] K. G. Chae and J. H. Park, “Trajectory optimization withGA and control for quadruped robots,” Journal of MechanicalScience and Technology, vol. 23, no. 1, pp. 114–123, 2009.

[21] A. Seyfarth, H. Geyer, M. Gunther, and R. Blickhan, “Amovement criterion for running,” Journal of Biomechanics, vol.35, no. 5, pp. 649–655, 2002.

[22] H.M. Herr and T. A. McMahon, “A galloping horse model,”TheInternational Journal of Robotics Research, vol. 20, no. 1, pp. 26–37, 2001.

[23] F. Kashiwamura, A. Avgaandorj, and K. Furumura, “Relation-ships among body size, conformation, and racing performancein banei draft racehorses,” Journal of Equine Science, vol. 12, no.1, pp. 1–7, 2001.

[24] G. Mitchell, S. J. Van Sittert, and J. D. Skinner, “Sexual selectionis not the origin of long necks in giraffes,” Journal of Zoology,vol. 278, no. 4, pp. 281–286, 2009.

[25] S. Toma, S. Colombo, L. Cornegliani et al., “Efficacy and tolera-bility of once-daily cephalexin in canine superficial pyoderma:an open controlled study,” Journal of Small Animal Practice, vol.49, no. 8, pp. 384–391, 2008.

[26] F. Cecchi, G. Carlini, E. Ciani, A. Bramante, and R. Ciampolini,“A survey on morphological traits of Basset Hound dogs raisedin Italy,” Journal of Life Sciences, vol. 5, pp. 381–386, 2011.

[27] L. M. Day and B. C. Jayne, “Interspecific scaling of themorphology and posture of the limbs during the locomotionof cats (Felidae),” Journal of Experimental Biology, vol. 210, no.4, pp. 642–654, 2007.

[28] P. E. Hudson, S. A. Corr, and A.M.Wilson, “High speed gallop-ing in the cheetah (Acinonyx jubatus) and the racing greyhound(Canis familiaris): spatio-temporal and kinetic characteristics,”The Journal of Experimental Biology, vol. 215, no. 14, pp. 2425–2434, 2012.

[29] Q. Cao and I. Poulakakis, “Quadrupedal bounding with asegmented flexible torso: passive stability and feedback control,”Bioinspiration & Biomimetics, vol. 8, no. 4, Article ID 046007,2013.

[30] A. O. Kapti andM. S. Yucenur, “Design and control of an activeartificial knee joint,” Mechanism and Machine Theory, vol. 41,no. 12, pp. 1477–1485, 2006.

[31] C. Francois and C. Samson, “A new approach to the controlof the planar one-legged hopper,” The International Journal ofRobotics Research, vol. 17, no. 11, pp. 1150–1166, 1998.

[32] J. Ferrer, “Zeroes of real polynomials on C(K) spaces,” Journalof Mathematical Analysis and Applications, vol. 336, no. 2, pp.788–796, 2007.

[33] A. J. Bento and C. M. Silva, “Generalized nonuniformdichotomies and local stable manifolds,” Journal of Dynamicsand Differential Equations, vol. 25, no. 4, pp. 1139–1158, 2013.