Академический Документы
Профессиональный Документы
Культура Документы
David E. Orin
I. I NTRODUCTION
Legged systems offer many advantages over wheeled vehicles, particularly over broken terrain. A legged system can
use obstacles as footholds in order to climb or jump, rather
than navigate around them as wheeled vehicles must often do.
The potential of legged locomotion is evident in nature as the
cheetah can dynamically maneuver at extremely high speeds
over uneven terrain and as dogs are used to search through
dense wreckage for potential survivors. At the present time,
legged systems are simply not fast enough to be useful for tasks
like military reconnaissance and time-critical search and rescue
operations. To address the issue of speed, this paper presents an
algorithm for high-speed trotting and a set of useful principles
that can be applied to the control of quadruped systems of
different scales and actuation schemes.
In nature, cursorial quadrupeds select gaits at various speeds
based mainly on energy considerations. Although many animals
gallop at top speeds, there is a signicant range of intermediate
speeds for which trotting is the most energy efcient gait [1],
[2]. A number of researchers have studied the quadruped bound
as a high-speed dynamic gait [3], [4], [5], but very few animals
naturally bound. Instead, trotting is often used by animals as
the precursor to galloping. Figure 1 shows the complete trotting
Fig. 1. Trotting stride showing two stance phases interleaved with two ight
phases. The quadruped is largely uncontrollable during ight [9].
stride with two ight phases, during which the body is largely
uncontrollable, and two stance phases, during which the legs
can apply corrective forces onto the body. Also notice that
diagonal leg pairs are synchronized throughout the entire stride.
During the short intervals of stance, compliant elements
and high-power actuators combine to perform a complex interchange of potential and kinetic energy. The high forces
necessary to overcome frictional and contact losses, and to
redirect the vertical momentum of the body, are strongly coupled to rotations about all three axes in a 3D quadruped. This
coupling is difcult to manage for control purposes because of
the many degrees of freedom. The attitude of the quadruped
becomes largely uncontrollable during ight, and the required
leg movements in preparation for touchdown cause undesired
effects on body motion, especially pitch. The control problem
is further complicated by the fact that the inter-limb and intralimb coordination and actuation schemes that animals use to
run at high speeds are not well understood.
Because of these difculties, much of the previous work on
quadruped control has only considered motion in the sagittal
plane (forward, vertical, and pitch motion) [6], [7]. Algorithms
have also been implemented on quadrupeds limited to move in
steady state trajectories, or that operate around a single speed
[4], [8]. These results show that the highly nonlinear quadruped
system can be linearized and successfully controlled around a
xed point, but these controllers only maintain stability when
the system is well initialized and without the presence of
signicant disturbances. Other assumptions such as massless
legs have also been made to simplify the quadruped system for
control.
This paper presents a control algorithm that overcomes
the above difculties to dynamically stabilize a high-speed
quadruped trot. Dynamic stability here is described as sustained
5743
Authorized licensed use limited to: Khajeh Nasir Toosi University of Technology. Downloaded on December 21, 2009 at 05:40 from IEEE Xplore. Restrictions apply.
Fig. 2.
Fig. 3.
5744
Authorized licensed use limited to: Khajeh Nasir Toosi University of Technology. Downloaded on December 21, 2009 at 05:40 from IEEE Xplore. Restrictions apply.
Fig. 5. Attitude control system. Yaw rate, forward velocity, and height are tracked through the step controller which runs once per step while pitch and roll
are regulated through continuous force redistribution during stance.
PROTRACT
SHORTEN
LENGTHEN
Flight
Stance
liftoff
THRUST
Fig. 4.
touchdown
COMPRESS
Fig. 6. The ab/ad angles at touchdown cause lateral ground reaction forces
to produce lateral motion as in (a) and yaw motion as in (b).
the front legs to the outside of the turn and the hind legs to the
inside.
The response of the body during stance to the provided
touchdown conguration and energy addition depends on the
tilt angles of the body, namely pitch and roll. The online
learning done by the adaptive fuzzy controller assumes that the
body tilt angles at touchdown and during stance are predictable
and repeatable. During ight, the step controller outputs a
commanded pitch, c , pitch rate, c , roll, c , and roll rate, c ,
for the body during stance. The commanded pitch and pitch rate
are nominally zero, but can be changed to match the inclination
angle on sloped terrain.
Animals have been observed to bank into turns, as shown
in Fig. 7, to keep their ab/ad angles with respect to the body
(1)
5745
Authorized licensed use limited to: Khajeh Nasir Toosi University of Technology. Downloaded on December 21, 2009 at 05:40 from IEEE Xplore. Restrictions apply.
0.0 m/s
1.0 m/s
20
20
ab/ad angle
conus angle
10
10
10
10
20
40
20
40 20
3.0 m/s
bank angle (deg)
2.0 m/s
20
10
20
40 20
20
10
40
20
40 20
4.0 m/s
20
40
5.0 m/s
20
20
20
10
10
10
10
10
10
20
20
20
40 20
0
20 40 40 20
0
20 40 40 20
0
20 40
yaw rate (deg/s)
yaw rate (deg/s)
yaw rate (deg/s)
Fig. 8. Comparison between ab/ad angles and the conical pendulum angle.
The trained ab/ad angles with respect to the vertical, shown as circles, are very
similar to the computed conus angles, shown as triangles. Both slopes have an
approximate linear relationship with turning rate at a single velocity, but the
slopes diverge from each other as speed increases.
to the leg forces, the ab/ad angles with respect to the vertical
are still very similar to the conus angles, as shown in Fig.
8. Equation 1 was used to calculate the conus angles, shown
as triangles, for 7 turning rates at 6 forward velocities. The
fuzzy controller outputs the desired touchdown ab/ad angles
with respect to the vertical. These are shown as circles. Both
slopes have an approximate linear relationship with turning rate
at a single velocity, but the slopes diverge from each other
as speed increases. From the discrete circled data in Fig. 8,
a continuous equation for ab/ad angles can be developed for
all velocities and turning rates. To keep the ab/ad angles with
respect to the body small, the body roll angle is commanded
to match the ab/ad angles with respect to the vertical.
The next section on force redistribution shows how the
commanded pitch and roll motions are achieved during the
stance phase.
f i = J ( i )T i
a,i
ni = s,i ,
(3)
c,i
where a,i is the ab/ad actuator torque, s,i is the swing actuator
torque of leg i, and c,i is a constraint torque about the bodys
z b axis. The total moment on the body, nb , is given by
4
ni + i (bpi f i ) .
nb =
(4)
i=1
where i is 1 for legs in contact with the ground and 0 for legs
in ight. The vector b pi gives the position of leg i relative to
the body. With only diagonal leg pair (1,4) on the ground, this
equation becomes
nb = n1 +
B. Force Redistribution
At most two legs simultaneously interact with the ground
during high-speed quadruped trotting, eliminating the possible
use of static stability techniques. Running also requires much
larger leg forces than walking, and these forces are strongly
coupled to all six directions of motion. This coupling motivates
the need for continuous control of the body tilt angles, pitch
and roll, during stance.
(2)
p1 bR1 J T
1 1 + n2
.
+ n3 + n4 + bp4 bR4 J T
4
4
(5)
5746
Authorized licensed use limited to: Khajeh Nasir Toosi University of Technology. Downloaded on December 21, 2009 at 05:40 from IEEE Xplore. Restrictions apply.
(6)
0
0
fbz = z1 (k,1
+ k,1 ) + z4 (k,4
+ k,4 ) mg .
Again, the new force, Efbz , is the sum of the original force,
plus the effects of the change in knee torques:
E z,0
fb ,
fbz =
y
y
nby = ny,0
b + 1 k,1 + 4 k,4 .
nby
,
= kp (c ) + kd ( c )
(9)
4
i ERi J T
i i + mg .
(11)
i=1
E z
fb
= z1 k,1 + z4 k,4 mg ,
(13)
(15)
E z,0
fb
(16)
(17)
y1
z1
y4
z4
k,1
k,4
ny,0
kp (c ) + kd ( c )
b
=
. (18)
0
The k,1 and k,4 produced by this set of equations effectively change the pitch moment of the body without affecting
the vertical dynamics. When there is no pitch or pitch rate
error, the stance legs simply negate the moment caused by the
swing legs. As the quadruped trots faster, swing leg torques
must increase to generate faster protraction trajectories. Without
compensating for the disturbances on the body caused by swing
torques, pitch will become unstable at high speeds.
2) Roll Control: As mentioned before, modied knee
torques produce an unwanted change in the roll dynamics.
A controller must be developed for the roll axis that negates
the effect of this unwanted moment. The roll moment to be
negated is computed, added to a stance roll controller, and then
delivered to the system by applying torques to the ab/ad axes
of the two stance legs. This is the rst constraint on the ab/ad
torques, a,1 and a,4 . These torques (plus the redistributed
knee torques) should not produce an unwanted yaw moment,
so a second constraint equation must be derived such that the
natural yaw dynamics are not affected by either the pitch or
roll controller.
With diagonal leg pair (1,4) on the ground, the roll moment
on the body is given by:
nxb = a,1 + x1 k,1 a,2 a,3 a,4 + x4 k,4 ,
(12)
+ z1 k,1 + z4 k,4 .
fbz =
(8)
Constraining the new pitch moment to be equal to a commanded moment from a linear controller,
E z,0
fb
0
0
nby = y1 (k,1
+ k,1 ) s,2 s,3 + y4 (k,4
+ k,4 ) , (7)
0
where k,i
is the torque produced by the passive spring at
the knee without movement of the spring anchor. This torque
naturally increases during leg compression as the spring absorbs
energy and decreases back to zero as the spring returns
all of
y
its energy to the system. The new pitch moment, nb is given
as the sum of the original pitch moment ny,0
plus the pitch
b
moment produced by k,1 and k,4 :
(14)
(19)
5747
Authorized licensed use limited to: Khajeh Nasir Toosi University of Technology. Downloaded on December 21, 2009 at 05:40 from IEEE Xplore. Restrictions apply.
0
0
k,1
+ k,1 and k,4
+ k,4 , respectively. Again, ight leg
torques, a,2 and a,3 , that affect body motion are accounted
for. Setting the roll moment of Eq. 19 equal to a desired roll
moment, from a linear controller, results in the rst constraint
equation for a,1 and a,4 :
Fig. 9.
z1 a,1
z1 k,1
z4 a,4
z4 k,4
velocity (m/s)
nzb
(21)
z4 a,4
z1 k,1
z4 k,4
desired
actual
3
2
1
0
1
0
(22)
40
60
80
100
desired
actual
20
15
10
5
0
5
0
1
1
a,1
=
z1 z4
a,4
x
1 k,1 a,2 a,3 + x4 k,4
kp (c ) kd ( c )
. (23)
z
z
1 k,1 4 k,4
20
25
yaw rate (deg/s)
z1 a,1
Fig. 10.
20
40
60
step
80
100
sweep angle for protraction becomes very large and the moment
on the body created by the resultant swing torques cannot be
overcome. At very low speeds, swing leg compensation is not
needed to maintain pitch stability. As speed increases and more
swing torque is needed to return the leg during protraction, the
algorithm must compensate for the undesired effect.
Figure 11 shows the pitch motion of the quadruped running at
3.0 m/s with and without swing torque compensation. During
ight, the body is uncontrolled and body pitch error increases
based upon the pitch rate at liftoff and the dynamic swing
effects of all four legs. During stance, the pitch is controlled
back toward zero. Without compensating for the swing torques,
the pitch motion during stance reaches an angle of zero but has
nonzero rate. This steadily causes the pitch angle to diverge
toward instability. With compensation, the pitch excursions
during ight remain bounded because the pitch rate at liftoff
is near zero. This results in predictable and repeatable tilt
angles during stance, which improve the performance of the
step controller. The maximum speed achieved without swing
torque compensation is 2.75 m/s for straight ahead locomotion.
This speed is limited further when a turning rate is desired.
The ability of the quadruped to turn at high speeds is directly
related to the success of the stance controller to keep the tilt
errors small.
V. S UMMARY AND F UTURE W ORK
A hybrid control system using a discrete controller running
once per step and a continuous controller during stance was
presented that dynamically stabilized a quadruped running at
3.75 m/s and turning at 20 deg/s. These speeds and turning
5748
Authorized licensed use limited to: Khajeh Nasir Toosi University of Technology. Downloaded on December 21, 2009 at 05:40 from IEEE Xplore. Restrictions apply.
and the correlation between the ab/ad leg angles and the conical
pendulum angles. The present system and controller can also
serve as a testbed for use of other biomimetic strategies such
as early leg retraction and the use of neuro-oscillators. We also
expect that elements of this controller will be useful for other
high-speed quadruped gaits such as the canter and gallop.
pitch (deg)
4
2
0
2
4
0
pitch
stance
0.5
1.5
2.5
3.5
pitch (deg)
ACKNOWLEDGMENTS
0
2
4
0
pitch
stance
0.5
1.5
2
time (s)
2.5
3.5
Fig. 11. Running at 3.0 m/s with and without swing leg compensation.
Without swing leg compensation (top gure), body pitch oscillates between
large angles and quickly goes unstable. With swing leg compensation (bottom
gure), pitch motion is under control. In both gures, legs are in contact
with the ground when the stance signal is high. During ight, the body
is uncontrolled and body pitch error increases. During stance, the pitch is
controlled back to zero.
Fig. 12.
R EFERENCES
[1] D. F. Hoyt and C. R. Taylor, Gait and the energetics of locomotion in
horses, Nature, vol. 292, pp. 239240, 1981.
[2] K. J. Waldron and P. Nanua, Energy comparison between trot, bound,
and gallop using a simple model, Journal of Biomechanical Engineering,
vol. 117, no. 4, pp. 466473, 1995.
[3] M. Buehler, R. Battaglia, A. Cocosco, G. Hawker, J. Sarkis, and K. Yamazaki, SCOUT: A simple quadruped that walks, climbs, and runs,
in Proceedings of the IEEE International Conference on Robotics and
Automation, (Leuven, Belgium), pp. 17071712, 1998.
[4] M. D. Berkemeier, Modeling the dynamics of quadrupedal running,
International Journal of Robotics Research, vol. 17, pp. 971985, September 1998.
[5] A. Neishtadt and Z. Li, Stability proof of Raiberts four-legged hopper in
bounding gait, Tech. Rep. 578, New York University, September 1991.
[6] M. H. Raibert, Trotting, pacing, and bounding by a quadruped robot,
Journal of Biomechanics, vol. 23, suppl. 1, pp. 7998, 1990.
[7] H. M. Herr and T. A. McMahon, A trotting horse model, International
Journal of Robotics Research, vol. 19, pp. 566581, June 2000.
[8] D. P. Krasny and D. E. Orin, A 3D galloping quadruped robot, in
8th International Conference on Climbing and Walking Robots (CLAWAR
2005), (London, U.K.), pp. 467474, September 2005.
[9] P. P. Gambarian, How Mammals Run. New York: John Wiley & Sons,
1974.
[10] R. Blickhan, The spring-mass model for running and hopping, Journal
of Biomechanics, vol. 22, pp. 12171227, 1989.
[11] C. Farley, J. Glasheen, and T. McMahon, Running springs: speed and
animal size, Journal of Experimental Biology, vol. 185, pp. 7186, 1993.
[12] D. W. Marhefka, D. E. Orin, J. P. Schmiedeler, and K. J. Waldron,
Intelligent control of quadruped gallops, IEEE/ASME Transactions on
Mechatronics, vol. 8, pp. 446456, December 2003.
[13] D. V. Lee, J. E. A. Bertram, and R. J. Todhunter, Acceleration and
balance in trotting dogs, Journal of Experimental Biology, vol. 202,
pp. 35653573, 1999.
[14] F. T. Cheng and D. E. Orin, Efcient formulation of the force distribution equations for simple closed-chain robotic mechanisms, IEEE
Transactions on Systems, Man, and Cybernetics, vol. 21, pp. 2532,
January/February 1991.
[15] K. Yoneda, H. Iiyama, and S. Hirose, Sky-hook suspension control of
a quadruped walking vehicle, in Proceedings of the IEEE International
Conference on Robotics and Automation, (San Diego, CA), pp. 9991004,
1994.
[16] L. R. Palmer III and D. E. Orin, 3D control of a high-speed quadruped
trot, Industrial Robot, vol. 33, no. 4, pp. 298302, 2006.
[17] S. McMillan, D. E. Orin, and R. B. McGhee, Dynamechs: An object
oriented software package for efcient dynamic simulation of underwater
robotic vehicles, in Underwater Robotic Vehicles: Design and Control,
pp. 7398, Albuquerque, NM: TSI Press, 1995.
[18] J. G. Nichol, S. P. Singh, K. J. Waldron, L. R. Palmer III, and D. E.
Orin, System design of a quadrupedal galloping machine, International
Journal of Robotics Research, vol. 23, no. 10-11, pp. 10131027, 2004.
5749
Authorized licensed use limited to: Khajeh Nasir Toosi University of Technology. Downloaded on December 21, 2009 at 05:40 from IEEE Xplore. Restrictions apply.