Professional Documents
Culture Documents
Downloaded from https://www.cambridge.org/core. CRAI de la Universitat de Barcelona, on 22 Sep 2021 at 12:48:45, subject to the Cambridge Core terms of use, available at
https://www.cambridge.org/core/terms. https://doi.org/10.1017/S0263574704000591
2 Biped robot
Double support
phase Swing phase Contact phase
Yo
Xo
Downloaded from https://www.cambridge.org/core. CRAI de la Universitat de Barcelona, on 22 Sep 2021 at 12:48:45, subject to the Cambridge Core terms of use, available at
https://www.cambridge.org/core/terms. https://doi.org/10.1017/S0263574704000591
Biped robot 3
Z Z
Support polygon F F
Resultant forces formed by the foot
and moments X Y X Y
ZMP
Z2
Z1
Reaction F2
force F1 X2
X1 Y2
Y1
Fig. 3. ZMP under the sole. A support polygon made between the
sole and the ground.
Virtual plane S1 Virtual plane S2
Also, the velocity and acceleration along this trajectory are (a) (b)
as follows:
Fig. 4. Virtual planes and frames: (a) Virtual frame F1 fixed on
the virtual plane S1 and (b) Virtual frame F2 fixed on the virtual
ẋs (t) = c1 + 2c2 t + 3c3 t + 4c4 t + 5c5 t + 6c6 t ,
2 3 4 5
plane S2 .
(4)
ẍs (t) = 2c2 + 6c3 t + 12c4 t + 20c5 t + 30c6 t .
2 3 4
as shown in Figure 4(2). Also, the virtual plane is made
between the fore and hind foot in the double support phase.
Combining Equation (3) and Equation (4) with the seven These virtual planes are formed along the walking path as
constraints, the seven coefficients can be obtained. Then, well as the number of the step.
substituting these coefficients for Equation (3), the foot
pattern will be obtained. Also, a waist pattern is set by a 3.2. ZMP trajectory
polynomial, considering the movable range of the legs. In In order to calculate the compensatory motion of the trunk,
addition, a knee pattern is geometrically computed on the ZMP trajectory is arbitrarily desired in the stable region
basis of the foot and waist pattern. formed according to a foot length and a step length. Figure 5
shows the examples of the X and Y time ZMP trajectories,
p p
X̄zmp and Ȳzmp , planned in the virtual planes such as planes
3. VIRTUAL PLANE AND ZMP TRAJECTORY A, B, C and so on. In the double support phase, we consider
In this section, a virtual plane is discussed to calculate the stable region of 0.2 m × 0.38 m excepting the step length,
ZMP (Zero Moment Point). Also, a preset ZMP trajectory is while in the single support phase, the stable region of 0.2 m ×
described for a moment compensation motion. 0.17 m.
Downloaded from https://www.cambridge.org/core. CRAI de la Universitat de Barcelona, on 22 Sep 2021 at 12:48:45, subject to the Cambridge Core terms of use, available at
https://www.cambridge.org/core/terms. https://doi.org/10.1017/S0263574704000591
4 Biped robot
Virtual Virtual
0.3 plane C plane B
Virtual
plane A
Stable resign
X [m]
0.2
0.1 -X zmp
p
0
5 10 15 Time[s] 20
-0.1
-0.2
-0.3
Virtual Virtual
0.3 plane A plane C Virtual
Stable resign
plane B
Y [m]
0.2
0.1
-Yzmp
p
0
5 10 15 Time [s] 20
-0.1
-0.2
-0.3
(6)
n k n k
i=1 mi z̈i + gz yi − mi ÿ + gy zi
k k k k
k
Yzmp = n k i=1 i .
i=1 mi z̈i + gz
k
Fig. 6. Coordinate frames.
Downloaded from https://www.cambridge.org/core. CRAI de la Universitat de Barcelona, on 22 Sep 2021 at 12:48:45, subject to the Cambridge Core terms of use, available at
https://www.cambridge.org/core/terms. https://doi.org/10.1017/S0263574704000591
Biped robot 5
4.2. Linearization Z t = const.
In order to obtain the trunk motion from Equation (6) derived mt
on the uneven terrain, we assume the biped model walks on a
horizontal plane. A world coordinate frame Fo is fixed on the
horizontal plane where the robot can walk (Figure 6). Also,
a waist coordinate frame F̄ is attached on the center of the Z
Z
waist to consider the relative motion of each particle. ZMP F
Zq = const.
equations, X̄zmp and Ȳzmp , can be written with respect to the F Y
F̄ as follow: X
Nx Ny
X̄zmp = , Ȳzmp = , (7) Z Z
D D
where Fo X Fo Y
n Fig. 7. Linearized model.
Nx = mi (z̄¨ i + z̈q + gz )(x̄i + zq )
i=1
Thus, the decoupled linear differential equations are as
n
− mi (x̄¨ i + ẍq + gx )(z̄i + zq ), follows:
i=1
n (t) = (z̄t + zq )x̄¨ t − gz x̄t ,
Ny = mi (z̄¨ i + z̈q + gz )(ȳi + yq ) (12)
(t) = (z̄t + zq )ȳ¨ t − gz ȳt ,
i=1
n
where
− mi (ȳ¨ i + ÿq + gy )(z̄i + zq ), (8)
i=1
(t) = Kx (t) − z̄t ẍq − z̄t gx
n
(13)
D= mi (z̄¨ i + z̈q + gz ), (t) = Ky (t) − z̄t ÿq − z̄t gy .
i=1
Kx (t) = z̄¨ t (ẍq + gx ) + z̄¨ t X̄zmp + (z̄t + zq )ẍt 4.3. Strict compensatory motion
− (z̄¨ t + z̈q + gz )x̄t , (9) The approximate solutions derived from Equation (12) are
effective when the trunk is quite long and the walking speed
Ky (t) = z̄¨ t (ÿq + gy ) + z̄¨ t Ȳzmp + (z̄t + zq )ÿt is relatively slow compared to that of a human. To obtain
− (z̄¨ t + z̈q + gz )ȳt , (10) strict periodic solutions of ZMP Equation (6), an iteration
method is employed. Firstly, we project the ZMP planned
on the virtual plane onto the horizontal plane formed by
where x̄t , ȳt and z̄t are the positions of trunk with respect to the X and Y axes of world frame Fo and substitute the
the F̄. projected ZMP into the decoupled linear Equation (12). As
These equations, however, are interferential and non-linear a result, the approximate periodic motions of the trunk, x̄t
because each equation has the same variable z̄t , and the trunk and ȳt , are derived. Secondly, we substitute both the lower-
is connected to the lower-limbs through rotational joints. limb motion and the approximate trunk motion into the ZMP
Therefore, it is difficult to derive analytic solutions from the Equation (6), and calculate the ZMP relative to the waist
equations. We assume that the trunk particle mt does not kc kc
frame, X̄zmp and Ȳzmp . Then, we compute the ZMP errors
move vertically, as shown in Figure 7. between the calculated ZMP and planned ZMP as
Downloaded from https://www.cambridge.org/core. CRAI de la Universitat de Barcelona, on 22 Sep 2021 at 12:48:45, subject to the Cambridge Core terms of use, available at
https://www.cambridge.org/core/terms. https://doi.org/10.1017/S0263574704000591
6 Biped robot
Inverse FFT
- kc - kc
Calculate X zmp & Y zmp
on the virtual surfaces Iteration times
Calculate ZMP errors Fig. 9. Convergence of iteration solutions. When the walking speed
from Equation (14) is 2.6 s/step, the trunk length is changed.
No
Ezmp < zmp ?
Yes
Trunk pattern
End
4.4. Trunk motion simulation Fig. 10. Convergence of iteration solutions. When the trunk length
is 0.6 m, the walking speed is changed.
We have numerically verified the convergence of the
solutions. In simulation, two parameters are considered: the
length of the trunk and the walking speed. We can see that
the errors of the ZMP drop below 1.0 mm after 10 iteration Equation (15) is generally known as the Lorentz function,
times, as shown in Figures 9 and 10. and its primitive function is written as
Consider only the motion of the trunk around the pitch
axis to investigate the compensatory motion. The transfer ȳt (t) = qe−p|t| . (17)
function in the frequency domain between the trunk motion
ȳt and the leg motion (t) of Equation (12), ȳt (ω), can be We can imagine from Equation (17) that the casual law
expressed as may not be applied anymore. If the walking speed of the
biped robot is increased, it goes without saying that ȳt (t)
2p 1 1 affects stability more badly. The trunk, therefore, should be
ȳt (ω) = 2 q= + q, (15)
ω + p2 p − jω p + jω in motion earlier than the shift of ZMP on the floor to cancel
the effect of the produced moments.
where The relationship between the trunk motion and the applied
force has been simulated. When a biped robot is not in
gz 1 gz motion, an impulse moment 1000 Nm is applied to the pitch
p= , q=− . (16)
z̄t − z̄zmp 2gz z̄t − z̄zmp trunk. Figure 11 shows the pitch motion of the trunk. In this
Downloaded from https://www.cambridge.org/core. CRAI de la Universitat de Barcelona, on 22 Sep 2021 at 12:48:45, subject to the Cambridge Core terms of use, available at
https://www.cambridge.org/core/terms. https://doi.org/10.1017/S0263574704000591
Biped robot 7
Start
Terrain surfaces
5. WALKING EXPERIMENT
In order to confirm the validity of the control method,
dynamic walking experiments on planes, stairs and slopes
are conducted. In this section, we describe the structure of
the experimental system and show the experimental results.
Downloaded from https://www.cambridge.org/core. CRAI de la Universitat de Barcelona, on 22 Sep 2021 at 12:48:45, subject to the Cambridge Core terms of use, available at
https://www.cambridge.org/core/terms. https://doi.org/10.1017/S0263574704000591
8 Biped robot
Table I. Mass Parameters of WL-12RIII.
Part Weight kg
Angle [deg]
Trunk 30.5
Waist (pitch) 5.0
Waist (roll) 5.0
Hip 7.5
Knee 7.0
Ankle 6.5
Time [sec]
(a) Right ankle angle history.
Table II. Length Parameters of WL-12RIII.
Part Length mm
Angle [deg]
Trunk 625
Thigh 358
Shank 355
Sole 200 × 170
Time [sec]
(b) Right knee angle history.
Angle [deg]
Time [sec]
(a) (b) (c)
(c) Right hip angle history.
Fig. 14. Walking simulation on the trapezoid floor: (a) sagittal plane,
(b) latteral plane, (c) horizontal plane.
Angle [deg]
All the computations to control WL-12RIII are carried (d) Pitch trunk angle history.
out by the control computer and the control program that is
written in C and assembly language. The servo rate is 1 kHz.
The computer system is mounted on the on the right and left
side of the waist.
Angle [deg]
Downloaded from https://www.cambridge.org/core. CRAI de la Universitat de Barcelona, on 22 Sep 2021 at 12:48:45, subject to the Cambridge Core terms of use, available at
https://www.cambridge.org/core/terms. https://doi.org/10.1017/S0263574704000591
Biped robot 9
Torque [Nm]
Angle [deg]
Time [s]
Angle [deg]
Time [s]
Angle [deg]
Time [s]
Time [sec]
(c) Right hip torque history.
(c) Right hip angle history.
Torque [Nm]
Angle [deg]
Time [s]
Angle [deg]
Time [s]
Time [sec]
(e) Roll trunk torque history. (e) Roll trunk angle history.
Fig. 16. Torque history in an experiment going up the stair. The Fig. 17. Angle history in an experiment walking on the trapezoid
dotted lines denote desired torques and the solid lines denote terrain. The dotted lines denote desired angles and the solid lines
response torques. denote response angles.
Downloaded from https://www.cambridge.org/core. CRAI de la Universitat de Barcelona, on 22 Sep 2021 at 12:48:45, subject to the Cambridge Core terms of use, available at
https://www.cambridge.org/core/terms. https://doi.org/10.1017/S0263574704000591
10 Biped robot
trunk, going down the slope. It means that the torque of the
Torque [Nm]
dotted lines denote desired values and the solid lines response
values.
These response patterns follow very well the desired
patterns, excepting some steep change points of angle. The
angles are sharply increased or decreased immediately after
Time [s] the swing phase is changed to the stance phase, as shown
in Figures 15 and 17. The reason is that the angle patterns are
(c) Right hip torque history. determined using inverse kinematics after the foot and the
waist trajectories are smoothly planned with respect to the
word coordinate frame. If the biped robot takes more time in
the swing phase, these patterns can be made more smoothly.
Torque [Nm]
Time [sec]
6. CONCLUSION
To realize dynamic walking on even and uneven terrain, we
have proposed a compensatory motion control algorithm.
The control algorithm consists of three main parts. Firstly,
(e) Roll trunk torque history.
a virtual plane on the terrain is introduced to consider ZMP,
Fig. 18. Torque history in an experiment walking on the trapezoid which is formed according to the contact state of the robot
terrain. The dotted lines denote desired torques and the solid lines feet. Secondly, the compensatory motion of the trunk is
denote response torques. calculated using the motion of the lower-limbs and the ZMP
Downloaded from https://www.cambridge.org/core. CRAI de la Universitat de Barcelona, on 22 Sep 2021 at 12:48:45, subject to the Cambridge Core terms of use, available at
https://www.cambridge.org/core/terms. https://doi.org/10.1017/S0263574704000591
Biped robot 11
planned on the virtual plane. Finally, a program control 5. R. L. Farnsworth and H. Hemami, “Postural and gait stability of
is introduced into the WL-12RIII, based on a complete a planar five link biped by simulation,” IEEE Trans. Automatic
walking pattern consisting of the motions of the lower- Control 22, No. 3, 452–458 (June, 1977).
6. H. Hemami and B. F. Wyman, “Modeling and control of
limbs, waist and trunk. This algorithm is applicable to not constrained dynamics systems with application to biped
only the steady walking but also the complete walking. locomotion in the frontal plane,” IEEE Trans. Automatic
Through hardware experiments using the complete walking Control 24, 526–535 (1992).
pattern, the effectiveness of the proposed control approach 7. T. McGeer, “Passive bipedal walking,” Int. J. Robotics
was verified. Research 9, No. 2, 60–74 (1990).
8. H. Miura and I. Shimoyama, “Dynamic walk of a biped,” Int.
J. Robotics Research 3, No. 2, 60–74 (Summer, 1984).
9. J. Furusho and M. Masubuchi, “Control of a dynamical biped
locomotion system for steady walking,” ASME J. Dynamics
Acknowledgment Systems, Measurement, and Control 108, 111–118 (June,
The authors would like to thank Kuroda Precision Industries 1986).
Ltd., Moog Japan Ltd. and Toray Industries Inc. for 10. J. Pratt, P. Dilworth and G. Pratt, “Virtual mode control of a
supporting us in developing the hardware. bipedal walking robot,” Proc. IEEE Int. Conf. Robotics and
Automation, Albuquerque, NM (Apr., 1997) pp. 193–198.
11. Y. Zheng and J. Shen, “Gait synthesis for the sd-2 biped robot to
climb sloping surface,” IEEE Trans. Robotics and Automation
6, No. 1, 86–96 (1990).
References 12. S. Kajita and K. Tani, “Study of dynamic biped locomotionon
1. M. Vukobratovic, A. A. Frank and D. Juricic, “On the stability rugged terrain: Theory and basic experiment,” Proc. Int. Conf.
of biped locomotion,” IEEE Trans. of Biomedical Engineering Advanced Robotics (1991) pp. 741–746.
17, No. 1, 25–36 (1970). 13. J. Yamaguchi, A. Takanishi and I. Kato, “Development of a
2. A. Takanishi, M. Ishida, Y. Yamazaki and I. Kato, “The biped walking robot adapting to a horizontally uneven surface,”
realization of dynamic walking by the biped walking robot,” Proc. IEEE/RSJ Int. Conf. Intelligent Robots and Systems,
Proc. IEEE Int. Conf. Robotics and Automation, St. Louis, MO Munich, Germany (Sep., 1994) pp. 1156–1163.
(Mar., 1985), pp. 459–466. 14. K. Hirai, M. Hirose, Y. Haikawa and T. Takenaka, “The
3. A. Takanishi, Y. Egusa, M. Tochizawa, T. Takebayashi and development of honda humanoid robot,” Proc. IEEE Int.
I. Kato, “Realization of dynamic walking stabilized with trunk Conf. Robotics and Automation, Leuven, Belgium (May 1998)
motion,” Proc. CISM-IFToMM Symp. Theory and Practice of pp. 1321–1326.
Robots and Manipulators (1988), pp. 68–79. 15. J. W. Cooley, P. A. Lewis and P. D. Welch, “The finite fourier
4. M. H. Raibert, Legged Robots That Balance (MIT Press, transform,” IEEE Trans. of Audio and Electroacostics AU-17,
Cambridge, MA, 1986). No. 2, 77–85 (1969).
Downloaded from https://www.cambridge.org/core. CRAI de la Universitat de Barcelona, on 22 Sep 2021 at 12:48:45, subject to the Cambridge Core terms of use, available at
https://www.cambridge.org/core/terms. https://doi.org/10.1017/S0263574704000591