Professional Documents
Culture Documents
I. INTRODUCTION
11. PROBLEM
CONSIDERED
ANDPREVIOUS
WORKS
There are two assumptions for the force distribution: (1) the
foot contacts with the ground by a point or a small area,
and (2) the walking machine walks in a statically stable
way. Based on these assumptions, the equilibrium
equations can be expressed in terms of the coordinate
system ( o b & Y b z b ) (see Fig. 1): .
2f, +Fx = 0 ,
,=I
i=l
,=I
866
Authorized licensed use limited to: Khajeh Nasir Toosi University of Technology. Downloaded on December 21, 2009 at 05:46 from IEEE Xplore. Restrictions apply.
fl, are the forces acting at the i-th foot along x, y, and z axis
of the body-fixed frame (0,xb Yb Zb), respectively; F,, F,,
F,, T,, T,, are the forces and torques acting at the frame
(obXb Yb Z b ) ; Mg iS the weight Of the body; Xi, y;, Z; are the
coordinates of i-th leg-end in the body-fixed frame; x,, yc,
and z, are the coordinates of the center of the gravity of the
walking machine in the frame (obXb Yb Zb). For simplicity,
the frame (obxb Yb zb) will always keep its orientation the
same as that of the terrain-fixed frame (0,X,Y,Z,) in the
following discussion.
867
Authorized licensed use limited to: Khajeh Nasir Toosi University of Technology. Downloaded on December 21, 2009 at 05:46 from IEEE Xplore. Restrictions apply.
Q = bqXf , f q y f ,
. F = { - 4 - L z -Fy-Ly
fn)T
fqz
(3b)
Mg-t-&
xyl
M a c- T - f , Y p + f p y z p
- Mg4 - T, + f P P P- f P J P
1
0
1
0
0
1
0
1
T + f,Y,
0
0
- f,.,
k3C)
-Y, -Y,
x,
xr
0
0
The forces acting at other two leg-ends can then be
obtained by using Equations (3).
rJ&
3-leg
i
4-leg
i
3-leg
\supporting p h a s e . supporting p h a s e ; supporting phase
Leg 1
t2
-_-_lifting leg
t4
Time (s)
supporting leg
Authorized licensed use limited to: Khajeh Nasir Toosi University of Technology. Downloaded on December 21, 2009 at 05:46 from IEEE Xplore. Restrictions apply.
12/12;
- lS6PciS + 1 2 S ~ P S ( t S + , k )
4.
lC,PctS
[g=[
+ 12C#PS(6+,k)
z]
+2s(6+k)][
12S(,S+,k)
eP;
(4)
ek;
ek).
Leg 1
Leg 2
Leg 3
Leg 4
Leg is in supportingphases
In addition, we compared the FriCoM with the pseudoinverse method [7] and an incremental method [8]. It was
found that the FriCoM gave a better result than that
obtained from the pseudo-inverse method if a supporting
leg is near to the center of gravity. By employing the
Matlab software, the force distribution according to the
incremental method takes 2 s to 12 s depending on the
initial values, while the FriCoM takes less than 0.01s.
Because of the shorter computation time, the FriCoM will
be more efficient and suitable in the real-time control of
walking machines.
3-
1---
V. DISCUSSION
A. Variation of the Force Distribution during CG Shift
-1
10
Time(s)
Fig. 5. Trajectory of the 1 leg end.
Leg-end trajectory
is changed to hipfixed frame
--*
Inverse kinematics
(Incorporate the
Motors
each joint
Motion controller,
such as PID
controller
Encoders
Fig. 6. Signal flow chart of the computation of the force distributionand torques for a quadruped robot.
869
Authorized licensed use limited to: Khajeh Nasir Toosi University of Technology. Downloaded on December 21, 2009 at 05:46 from IEEE Xplore. Restrictions apply.
f, + f , +f, +Fy = o ,
f p y x p+fqyxq - f p x Y p - s , Y , - L Y ,
-100
(6c)
so it is still an undetermined system. The pseudo-inverse
method [7] is then used to solve Equations (6).
J
2
(6b)
+T = 09
10
C. Singularity
Time[@
(a)
10
Time(@
(b)
'
.......... .........
.................i..
-54
0
I
2
.6
10
Time($
(c)
Fig. 7. Force distribution in a locomotion cycle:
(a) Forces in Z, direction;
(b) Forces in Xb direction; ( c ) Forces in Yb direction.
.................. ................... .................. ................... ..................
.............
?------.
a
10
Time(s)
f p z Y p+ f q z Y ,+ f,Y, = M a , - FYZl - T,
f p x p + f& + f , x , = Ty - F A + w v c .
9
VI. CONCLUDING
REMARKS
t 5b)
(5c)
870
Authorized licensed use limited to: Khajeh Nasir Toosi University of Technology. Downloaded on December 21, 2009 at 05:46 from IEEE Xplore. Restrictions apply.
VII. ACKNOWLEDGMENTS
The authors would like to thank Dr. Teresa Zielinska for
her various discussions and suggestions on the project.
Thanks are also due to the reviewers for their constructive
comments. The work is under the support of the Robotics
Research Center, NTU.
VIII. REFERENCES
[ l ] V. R. Kumar and K. J. Waldron, Force Distribution in Closed
Kinematic Chains, IEEE Journal of Robotics and Automation, vol. 4,
no. 6, pp. 657-664, 1988.
[2] H. Lehtinen, Force Rased Motion Control of a Walking Machine,
Ph.D. Thesis, Technical research Center of Finland, VTT Publications
179, Finland, 1994.
[3] Debao Zhou, K. H. Low and Teresa Zielinska, An Efficient Force
Distribution Algorithm for the Legs of Quadruped Walking Machines
with Friction Constraints, Accepted for presentation at the Tenth
World Congress on the Theory of Machines and Mechanisms
(IFToMM), Oulu, Finland, June 1999.
[4] H. Y. Liu and B. C. Wen, Force Distribution for the Legs of a
Quadruped Walking Vehicle, Journal of Robotic Systems, vol 14, no.
1, pp. 1-8, 1997.
[SI C. A. Klein and T . 4 . Chung Force Interaction and Allocation for the
Legs of a Walking Vehicle, IEEE Journal of Robotics and
Automation, vol. RA-3, no. 6, pp. 546-555, 1987.
[6] P. Alexandre, An Autonomous Micro Walking Machine with
Rollover Recovery Capability, Workshop II: New Approaches on
Dynamic Walking and Climbing Machines of the Bth International
Conference on Advanced Robotics, Monterey, CA, USA, pp. 48-55,
1997.
[7] Y. Nakamura, Advanced Robotics: Redundancy and Optimization,
Addison-Wesley, Reading, Massachusetts, USA, 1991.
[SI The Mathworks Inc., Users Guide for Optimization Toolbox of
Matlab 5.0, the Mathworks, Inc., Natick, MA, USA, 1996.
[9] P. V. Nagy, W. L. Whittaker and S. Desa, A Walking Prescription for
Statically-Stable Walkers Based on Walkermerrain Interaction,
Proceedings of the IEEE International Conference on Robotics and
Aufomation, Nice, France, pp. 149-156, 1991.
[lo] X. C. Gao and S. M. Song, Stiffness Matrix Method for Foot Force
Distribution of Walking Vehicles, Proceedings of the International
Conference on Robotics and Automation, Los Alamitos, CA, USA, pp.
1470-1475, 1990.
[ I l l X. C. Ciao, S. M. Song and C. Q. Zheng, A Generalized Stiffness
Matrix Method for Force Distribution of Robotic Systems with
Indeterminacy, Journal of Mechanical Design, vol. 115, no. 3, pp.
585-591, 1993.
[!2] F. T. Cheng and D. E. Orin, Efficient Algorithm for Optimal Force
Distribution - The Compact-Dual LP Method, IEEE Transactions on
Robotics andAutomation, vol. 6, no. 2, pp. 178-187, 1990.
[I31 C. A. Klein and S. Kittivatcharapong, Optimal Force Distribution for
the Legs of a Walking Machine with Friction Cone Constraints, IEEE
Transactions on Robotics and Automation, vol. 6, no. 1, pp. 73-85
1990.
141 J. F. Gardner, Efficient Computation of Force Distributions for
Walking Machines on Rough Terrain, Robotica, vol. 10, pp. 427-433,
1992.
151 K. J. Waldron, Force and Motion Management in Legged
Locomotion IEEE Journal of Robotics and Automation, vol. 2, no. 4,
pp. 102-109, 1986.
161 M. Kaneko, K. Tanie and M. N. M. Than, A Control Algorithm for
Hexapod Walking Machine over Soft Ground, IEEE Journal of
Robotics and Automation, vol. 4, no. 3, pp. 194-202, 1988.
[17] K. Yoneda, H. Iiyama and S. Hirose, Sky-hook Suspension Control
of a Quadruped Walking Vehicle, Proceedings of the IEEE
International Conference on Robotics and Aufomation, Piscataway,
NJ, USA, vol. 2, pp. 999-1004, 1994.
[ 181 P. J. McKerrow, Introduction fo Robotics, Addison-Wesley, Reading,
Massachusetts, USA, 1991.
gears
Fig. 10. Mechanical structure of one leg
87 1
Authorized licensed use limited to: Khajeh Nasir Toosi University of Technology. Downloaded on December 21, 2009 at 05:46 from IEEE Xplore. Restrictions apply.