Dynamic Walking Robot
Dynamic Walking Robot
net/publication/269099032
CITATIONS READS
4 277
4 authors:
Some of the authors of this publication are also working on these related projects:
ANR-ARROW: Accurate and Rapid Robots with large Operational Workspace View project
All content following this page was uploaded by Ahmed Chemori on 04 December 2014.
F
Optimal Pattern Generator For Dynamic
Walking in humanoid Robotics
OO
LIRMM, Université Montpellier 2
LIRMM - UMR 5506 - CC 477, 161 rue Ada, 34095 Montpellier Cedex 5, France.
Abstract This paper deals with an optimal Zero Moment Point (ZMP)
based pattern generator for stable dynamic walking in humanoid
robotics. The proposed method is based on a Three-Mass Linear
Inverted Pendulum Model (3MLIPM), used as a simplified model
of the biped robot. The 3MLIPM considers the biped robot as
a three point masses and two-link system. A ZMP based per-
formance index is then used in an optimization problem whose
solution gives the best values of the model’s parameters w.r.t.
dynamic walking stability. Numerical simulations are presented
to show the effectiveness of the proposed optimal pattern gener-
ator for the case of the biped walking robot SHERPA.
F
Most of the proposed control schemes in the literature are based on
the use of some reference trajectories that should be tracked in real-
time. This fact shows the importance of a pattern generator in humanoid
walking control. Several types of pattern generators have then been
proposed in the literature. However, those who guarantee an a-priori
walking stability are often based on one of the following stabilization
criteria:
OO
The Center Of Mass (COM)
The Zero Moment Point (ZMP)
The Foot Rotation Indicator (FRI)
The COM [1] is the mean location of all masses of the robot links. It
is usually used as a static stability criterion. The ZMP [2, 3] is the point
of junction between the center of the vertical reaction forces and the
ground. It is the most used dynamic stability criterion. The FRI [4] is a
point on the foot/ground-contact surface where the net ground-reaction
force would have to act to keep the foot stationary. It is an indication
of postural stability and, in case of instability, indicates how the robot
will fall. It is used as a dynamic stability criterion.
2. Related works
PR
In the literature several methods have been proposed for generating
walking trajectories in humanoid robotics.
A method based on a motion capture of human walking has been
proposed in [5]. This method can gives human-like motions, however its
main drawback lies in the captured data that can be hard to adapt to
the humanoid robot.
Another method of trajectory generation for stable dynamic walking
is proposed in [6]. It consists in using a 3rd order spline function to
generate feet and hip trajectories. The foot trajectories can be adapted
to the ground variations to generate a stable dynamic walking on a rough
terrain.
In [7] another pattern generation method has been proposed. It con-
sists in using Fourier series to generate stable walking, with an iterative
Optimal Pattern Generator For Dynamic Walking 3
F
(IPM) [8, 9] that considers the robot as a single point mass and massless
legs. This method simplifies the dynamics of the robot to an inverted
pendulum with a point mass linked by a telescopic leg to a spherical
ground/leg joint.
The Linear Inverted Pendulum Model (LIPM) [10, 11] is an extension
of the IPM where the height of the torso is considered to be constant
leading to a more natural movement.
OO
The IPM ignores the dynamics of the legs since it considers the stance
leg as an inverted pendulum with a point mass. This fact can involve
a loss of walking stability since the considered model is considerably
simplified and consequently not sufficiently accurate. For instance, this
is the case when the robot has heavy legs or has no torso (case of our
robot SHERPA). In order to approximate the robot with a more accurate
model, it would be necessary to consider the whole-body dynamics by
using a preview control to correct the error between the IPM and the
real robot as in [12] or to use a multiple point mass model instead of
considering a one point mass model.
For instance, a Two-Mass Inverted Pendulum Model (TMIPM) and
Multiple Mass Inverted Pendulum Model (MMIPM) extending the IPM
were proposed in [13]. In the MMIPM, the considered model is composed
by more than one mass. For instance these masses are located at the hip
and along the swinging leg in the case of a two-mass model.
PR
The Gravity-Compensated Inverted Pendulum Model (GCIPM) [14]
uses also one mass to represent the body of the robot and an additional
mass to represent the swing leg.
A three-mass model using the concept of ZMP has been studied in
[15]; however, it doesn’t use any LIPM to generate trajectories and the
torso of the biped robot moves up and down.
A generation of walking trajectories using a three point mass model
to calculates center of mass trajectories from footstep locations has been
proposed in [16]. This approach use offline optimization of some free
geometrical parameters like the trunk angular motion w.r.t. the speed
of the robot. These parameters are then used in a real-time fast planning
to compute the reference torque patterns to apply on the robot.
Another three-mass model using the inverted pendulum concept is
proposed in [17]. However, it has one important drawback related to
4 D. Galdeano et al.
F
The proposed solution is an extension of the method proposed in [17]
to deal with dynamic stability of walking in the generated trajectories,
as well as changes in direction during walking. As in [17], the robot’s
dynamics will be approximated by a Three-Mass Linear Inverted Pen-
dulum. The hip and feet trajectories are generated by the movement of
masses. The walking movement of the robot is generated in the sagit-
tal and frontal planes separately. The joint trajectories are computed
OO
using inverse kinematics of the biped robot. In order to ensure a sta-
ble dynamic walking, the parameters of the model must be well tuned.
The best way to perform such a tuning is through an optimization of
the generated joints’ trajectories to minimize the ZMP excursion within
the footprint which will increase the stability margins. The second con-
tribution of this work is to propose online change of walking direction,
where new optimal trajectories are generated to ensure a-priori stability
during walking while turning.
This paper is organized as follows: in the next section, the proto-
type of our demonstrator SHERPA is introduced. Section 4 introduces
the simplified model that will be used in the generation of the reference
trajectories and how it was used in the pattern generator proposed in
[17]. In section 5, the proposed extension of this method is presented,
where our contributions are highlighted. Numerical simulations are pre-
sented and discussed in Section 6, where the effectiveness of the pro-
posed method is shown and compared with the original one for the case
PR
of SHERPA robot. The paper ends with some concluding remarks.
F
OO
Fig. 1. SHERPA kine-
matics model
Fig. 2. CAD model of
SHERPA
Fig. 3.
robot
The SHERPA
F
moduleOO
Fig. 4. CAD view of an actuator Fig. 5. View of a real manufactured
module
PR
Fig. 6. Cable/Pulley transmission system used in actuation module of
SHERPA.
F
tion to find the articular positions expressed in terms of operational space
positions of the hip and feet. The inverse kinematic model can then be
written as:
q = g(Xr ) (2)
where Xr ∈ R9×1 represents the operational space position of the hip
(3 × 1) and the feet (6 × 1). The orientation of the hip and the feet are
OO
kept constant and equal to zero.
The computation of the ZMP and CoM of the robot is based on
the formalism presented in [20], in which the ZMP evaluation uses the
angular momentum with the overall dynamic model of the robot.
m2
m1
m3
Y
X
F
i=1 i=1
3
X 3
X
τy = mi ẍi zi − mi (g + z̈i )xi (4)
i=1 i=1
where τx and τy are the torques applied on the ankle, mi represents the
value of the ith point mass, (xi , yi , zi ) are the Cartesian positions of the
OO
ith point mass (i = 1, 2 or 3 represent respectively the stance leg, the
torso and the swing leg), (ẍi , ÿi , z̈i ) are their corresponding accelerations.
For simplification, the height of the masses is assumed to be constant
and the torque applied on the supporting ankle is assumed to be zero
[17]. With these assumptions, (3) and (4) can be simplified into:
3
X
i=1
mi ÿi zi =
3
X
i=1
mi gyi and
3
X
i=1
mi ẍi zi =
3
X
i=1
mi gxi (5)
F
4.2 Motion study in the sagittal plane
The movement in the sagittal plane and the associated notations are
illustrated in Fig. 8.
OO
Fig. 8. Illustration of movement in the sagittal plane.
PR
With the above assumptions, heights and masses can be normalized
as follows:
where γ, λ and k are the parameters extracted from the robot’s model.
Considering (6), equation (5) can be simplified into:
x3 = A cos(ωt + φ) (9)
F
where parameters φ and A are given in the sequel by equation (13).
Here, ω is not the step frequency, it is a parameter that must be chosen
to keep the foot position and velocity positive in order to ensure a forward
movement of the foot during the step.
Using (7) and (9), x1 can be expressed by:
√a √a
x1 = C1 cos(ωt + φ) + C2 e( b )t + C3 e−( b )t
OO
With the above assumptions given in section 4.1, initial conditions
can be fixed as:
x1 (0) = −
x1
T
2
Ds
2λ
= 0 , x3
Ds
, x3 (0) = − (2λ − 1)
2λ
T
2
=0
(10)
(11)
(12)
where xst , zst represent Cartesian positions of the stance foot along x
and z axis respectively. xh , zh are the Cartesian positions of the hip
along x and z axis respectively.
During the step, the vertical position of the swing foot needs to be
higher than the floor. A sinusoidal shape can then be an appropriate
Optimal Pattern Generator For Dynamic Walking 11
function for the swing foot trajectory along the z axis. However, due
to the previous assumptions, the influence of this change of height is
neglected in computations.
λx3 (t) − λxh (t)
xsw (t) = for 0 ≤ t ≤ T
F
λ−1
√ s (17)
2Hs 2π π
zsw (t) = 1 + sin t− for 0 ≤ t ≤ T
2 T 2
where xsw , zsw are the positions of the swing foot along the x and z
axis respectively, and Hs is the maximal height of the swing foot during
OO
walking.
m2 Z
Hip
Knee
PR
m1 m1 m3
Y
0 Ls
F
The trajectory of the mass m1 along the y axis is then computed and
expressed by:
√v √v w
y1 (t) = C1 e u t + C2 e− u t − (21)
v
Where:
√v
OO C1 =
w 1 − e uT
√v
v 1 − e2 u T
√v
, C2 = e u t C1
robot
The SHERPA robot is a biped robot without a torso (cf. Fig. 3). In
order to simplify the model, the torso point mass is set on the hip. This
modification results in γ = λ.
It is worth to note that the basic principle of the proposed method
in [17] and summarized above uses some geometrical parameters of the
PR
robot (such as m1 , m2 , m3 and z1 , z2 , z3 ) but doesn’t give a method to
calculate them. In order to take into account the dynamic stability of
the resulting walking trajectories, we propose to tune these parameters
using optimization to enhance the walking performance. The idea of
such contribution is detailed in the following section.
F
OO
Fig. 10. ZMP displacement inside the footprint and stability margins.
F
r
ẑ1 1 1
= arg min max (xzmp − xdzmp )2 + (yzmp − ydzmp )2
m̂1 z α β
1
m1
(24)
OO
where xzmp and yzmp are the positions of the computed ZMP, xdzmp
and ydzmp are those of the desired one. z1 and m1 are the optimization
parameters, α and β are the length and the width of the foot (i.e. along
x axis and y axis respectively, cf. Fig. 10).
By minimizing the maximum normalized deviation of the ZMP tra-
jectory as cost function, the objective function computes the mass dis-
tribution to ensure the largest stability margins.
R πt
Ω=− cos (25)
2 T
6. Simulation results
A simulator for SHERPA biped robot was developed using the Graph-
ical User Interface of MatlabTM software. Its graphical interface is shown
in Fig. 11.
F
OO
Fig. 11. View of the Graphical User Interface of SHERPA biped robot simu-
lator.
F
Weight of the torso m2 mass − 2m1
Height of the mass m1 z1 Optimized
Height of the hip z2 0.95(Lshin + Lthigh )
Step time T 0.7 s
Step length Ds 0.4 m
Calculus variable ω π/(5T )
F
OO
Fig. 12. Joints’ positions generated by the proposed optimal pattern generator.
PR
Fig. 13. Joints’ velocities generated by the proposed optimal pattern generator.
Figures 14, 15 and 16 represent the evolution of the ZMP and the
CoM positions with respect to the footprints of the biped robot on the
ground generated respectively by the linear inverted pendulum model
18 D. Galdeano et al.
F
Fig. 14. Evolution of ZMP and CoM trajectories with the LIPM.
OO
Fig. 15. Evolution of ZMP and CoM trajectories with the original 3MLIPM.
Fig. 16. Evolution of ZMP and CoM trajectories with the proposed optimal
3MLIPM.
F
OO Fig. 17. CoM evolution versus time with optimization.
PR
Fig. 18. Evolution of the swing foot trajectories.
F
OO
Fig. 19. Evolution of ZMP and CoM trajectories with change of direction.
Indeed, when the robot changes the walking direction, the position
of the ZMP is moving within footprints, being sometimes outside of the
stance footprint, therefore the robot becomes unstable. Consequently, a
computation of optimal parameters in this scenario will be necessary to
improve the dynamic walking stability. This is the objective of the next
simulation scenario.
improved the dynamic stability of the biped robot for both scenarios:
straight walking and change of direction.
F
OO
Fig. 20. Joints’ positions with change of direction generated by the proposed
optimal pattern generator.
PR
Fig. 21. Joints’ velocities with change of direction generated by the proposed
optimal pattern generator.
22 D. Galdeano et al.
F
OO
Fig. 22. Evolution of ZMP and CoM trajectories in case of change of direction
generated by the proposed optimal pattern generator.
F
Table 4. Step length influence on stability margins
OO Stability
Mx
My
stable
0.105
0.028
Acknowledgments
This research was supported by the French National Research Agency,
within the project R2A2 (ANR-09-SEGI-011).
24 D. Galdeano et al.
References
[1] S. Ma, T. Tomiyama and H. Wada. Omnidirectional static walking of a
quadruped robot. IEEE Trans. on Robotics, 21(2):152–161, 2005.
[2] M. Vukobratovic and B. Borovac. Zero-moment point-thirty five years of
F
its life. Int. J. of Humanoid Robotics, 1(1):157–173, 2004.
[3] P. Sardain and G. Bessonnet. Forces acting on a biped robot. Center of
pressure-zero moment point. IEEE Trans. on Systems, Man and Cyber-
netics, Part A: Systems and Humans, 34(5):630–637, 2004.
[4] A. Goswami. Postural stability of biped robots and the foot-rotation in-
dicator (FRI) point. Int. J. of Robotics Research, 18(6):523–533, 1999.
[5] K. Harada, K. Miura, M. Morisawa, K. Kaneko, S. Nakaoka, F. Kane-
OO
hiro, T. Tsuji and S. Kajita. Toward human-like walking pattern gener-
ator. IEEE/RSJ Int. Conf. on Intelligent robots and systems (IROS’09),
(Albuquerque, NM, USA), :1071–1077, 2009.
[6] Q. Huang, S. Kajita, N. Koyachi, K. Kaneko, K. Yokoi, H. Arai, K. Ko-
moriya and K. Tanie. A high stability, smooth walking pattern for a biped
robot. IEEE Int. Conf. on Robotics and Automation (ICRA’99), :65–71,
Detroit, Michigan, USA, 1999.
[7] J. Yamaguchi, E. Soga, S. Inoue, and A. Takanishi. Development of
a bipedal humanoid robot-control method of whole body cooperative
dynamic biped walking. IEEE Int. Conf. on Robotics and Automation
(ICRA’99), 1:368–374, Detroit, Michigan, USA, 1999.
[8] S. Kajita, F. Kanehiro, K. Kaneko, K. Fujiwara, K. Yokoi and
H. Hirukawa. Biped walking pattern generation by a simple three-
dimensional inverted pendulum model. Advanced Robotics, 17(2):131–
147, 2003.
[9] Z. Tang and M. Er. Humanoid 3D Gait Generation Based on In-
verted Pendulum Model. IEEE 22nd Int. Symp. on Intelligent Control
(ISIC’07), :339–344, Singapore, 2007.
PR
[10] S. Kajita, F. Kanehiro, K. Kaneko, K. Yokoi and H. Hirukawa. The 3D
Linear Inverted Pendulum Mode: A simple modeling for a biped walk-
ing pattern generation. IEEE/RSJ Int. Conf. on Intelligent Robots and
Systems (IROS’01), :239–246, Maui, Hawaii, USA, 2001.
[11] S. Feng and Z. Sun. A simple trajectory generation method for biped
walking. 10th Int. Conf. on Control, Automation, Robotics and Vision
(ICARCV’08), :2078–2082, 2 Hanoi, Vietnam, 008.
[12] S. Kajita, F. Kanehiro, K. Kaneko, K. Fujiwara, K. Harada, K. Yokoi
and H. Hirukawa. Biped walking pattern generation by using preview
control of zero-moment point. IEEE Int. Conf. on Robotics and Automa-
tion (ICRA’03), 2:1620–1626, 2003.
[13] A. Albert and W. Gerth. Analytic Path Planning Algorithms for Bipedal
Robots without a Trunk. J. of Intelligent and Robotic Systems, 36(2):109–
127, 2003.
[14] J. Park and K. Kim. Biped robot walking using gravity-compensated
inverted pendulum mode and computed torque control. IEEE Int. Conf.
Optimal Pattern Generator For Dynamic Walking 25
F
(ICARA’04), :458–463, Palmerston North, New Zealand, 2004.
[16] T. Buschmann, S. Lohmeier, M. Bachmayer, H. Ulbrich and F. Pfeiffer. A
collocation method for real-time walking pattern generation. IEEE/RAS
Int. Conf. on Humanoid Robots, :1–6, 2007.
[17] S. Feng and Z. Sun. Biped robot walking using three-mass linear inverted
pendulum model. Proceedings of the Int. Conf. on Intelligent Robotics
and Applications (ICIRA’08), :371–380, Springer-Verlag, Wuhan, China,
OO 2008.
[18] http://www.lirmm.fr [Online].
[19] I. M. C. Olaru, S. Krut and F. Pierrot. Novel mechanical design of biped
robot sherpa using 2 dof cable differential modular joints. Proceedings
of the 2009 IEEE/RSJ Int. Conf. on Intelligent Robots and Systems
(IROS’09), :4463–4468, St. Louis, MO, USA, 2009.
[20] S. Kajita, H. Hirukawa, K. Harada and K. Yokoi. Introduction à la
commande des robots humanoides. Translated in French by Sakka, S.
Springer, 2009.
[21] S. Kajita, F. Kanehiro, K. Kaneko, K. Fujiwara, K. Yokoi and
H. Hirukawa. A realtime pattern generator for biped walking. IEEE Int.
Conf. on Robotics and Automation, ICRA’02, 1:31–37, IEEE, 2002.
[22] J. T. Kim and J. H. Park. Quick change of walking direction of biped
robot with foot slip in single-support phase. 11th IEEE-RAS Int. Conf.
on Humanoid Robots (Humanoids’11), :339–344, 2011.
[23] J. C. Lagarias, J. A. Reeds, M. H. Wright and P. E. Wright. Convergence
properties of the nelder–mead simplex method in low dimensions. SIAM
PR
J. on Optimization, 9(1):112–147, 1998.
Biographies
F
search scientist in Automation and Robotics at the Mont-
pellier Laboratory of Informatics, Robotics, and Micro-
electronics. His research interests include nonlinear, adap-
tive and predictive control and their applications in hu-
manoid robotics, underactuated systems, parallel robots, and underwater ve-
hicles.