Professional Documents
Culture Documents
IROS '90
F o o t T r a je c t o r y
f o r a Quadruped W a l k i n g Machine
Y o s h i h i r o SAKAKIBARA, K a z u t o s h i KAN, Y u u j i HOSODA,
M a k o t o HATTORI and M a s a k a t s u
FUJIE
M e c h a n i c a l E n g i n e e r i n g Research L a b o r a t o r y , H i t a c h i , L t d .
5 0 2 Kandatu. T s u c h i u r a , I b%raki 3 0 0 , J a p a n
Abstract
1.
Introduction:
- 315
F i g . 1.
S e q u e n t i a l photography o f
compact quadruped machine
Walking P a t t e r n Generation:
Authorized licensed use limited to: Khajeh Nasir Toosi University of Technology. Downloaded on December 21, 2009 at 05:56 from IEEE Xplore. Restrictions apply.
2.1
F i 9.2.
Quadruped wa I k i ng mach i n e
316 -
contact
Robot Specifications
Data Input
the f l o o r .
Therefore,
the f o o t motion
w i t h non-dimensional equations h i
d i v i d i n g t i m e I. by s w i n g i n g p e r i o d Ty.
as follons.
The c o o r d i n a t e s t h a t e x p r e s s t h e f o o t m o t i o n a r e
s u c h t h a t t h e X a x i s i s t a k e n on a l i n e a r l i n e
c o n n e c t i n g t h e d e p a r i i n g p o i n t and l a n d i n g p o t n ~on a
3.1
and t h e Z a x i s i s on t h e v e r t i c a l
f l a t floor,
Waist Trajectory
Analysis of Body Motion
Foot Trajectory
Analysis of Foot Motion
Relative Motion
to the Floor
Velocity. Acceleration
with
i s descrihed
line.
Sinusoidal Trajectory:
When t h e d e p a r t i n g p o i n t ,
l a n d i n g p o i n t , and t h e
maximum f o o t h e i g h t a r e d e s i g n a t e d , one r o o t
Dynamics Analysis
Joint Torque
t r a j e c t o r y c a n be d e t e r m i n e d b y i n t e r p o l a t , i o n
those p o i n t s u s i n g a s i n u s o i d a l curve.
&
of
Assuming t h e
u n i f o r m speed m o t i o n i n t h e f o r w a r d d i r e c t i o n and
sinusoidal motion i n the v e r t i c a l d i r e c t i o n ,
l e n g t h i s So,
Reference
t,he s t e p
and t h c
s w i n g i n g l e g m o t i o n s on t h e g r o u n d c o o r d i n a t e s can be
e x p r e s s e d by
Fig.3.
Process o f w a l k i n g
X = So t / T y
Z = Ho s i n ( z t / T y )
pattern generation
(1)
(2)
v e l o c i t y and a c c e l e r a t i o n .
t r a j e c t o r y dat.a and w a i s t p o s i t i o n t r a j e c t o r y ,
determined,
used i n a s i n g l e - l e g e x p e r i m e n t a l s y s t e m ; a
The f o o t
s i m p l i f i e d s y s t e m o f t h e q u a d r u p e d machine i n a c t u a l
thus
a r e p u t i n t o the j o i n t angle c a l ~ u l a t i n g
s e c t i o n and a r e c o n v e r t e d i n t o t a r g e t j o i n t a n g l e s .
s i z e w h i c h i s shown i n F i g . 2.
These a r e a n a l y z e d i n t h e j o i n t a n g u l a r m o t i o n
and t h e p a r a m e t e r s
analysis section.
above e q u a t i o n s .
angular v e l o c i t y ,
On each j o i n t ,
the j o i n t angles,
and a n g u l a r a c c e l e r a t i o n s as v a r i e d
l e n g t h So = 450
p e r i o d =0.7 sec.,
of
Shown i n F i g .
generated.
these
These a n a l y s e s were r e p e a t e d ,
and z.
and t h e w a l k i n g p a t t e r n was
walking p a t t e r n i n t o the
we s e l e c t e d as t h e
step
m m , f o o t h e i g h t Ho = 100 m m , w a l k i n g
The m o t i o n s a r e d i v i d e d i n t o h o r i z o n t a l and
v e r t i c a l d i r e c t i o n s , and t h e i r p o s i t i o n s , v e l o c i t i e s ,
and a c c e l e r a t i o n s as v a r i e d a g a i n s t t h e t i m e a x i s as
The f i n a l d a t a g e n e r a t e d f o r t h e t a r g e t
j o i n t a n g l e s a r e s t o r e d i n t h e memory.
of t h e
F o r example,
and s w i n g i n g t i m e Ty = 0.35 s e c .
6 a r e t h e f o o t t r a j e c t o r i e s on p l a n e x
Torque
v a r i a t i o n s a r e o b t a i n e d by d y n a m i c a n a l y s e s
t h e r e s u l t s were s t u d i e d ,
the f o o t motion
p a r a m e t e r s t o s a t i s f y a speed o f 2 k a / h o u r . t h e
c o n t i n u i t y and maxiflum v a l u e s a r e c h e c t e d .
j o i n t angular motions.
Then,
i s o b t a i n e d by a s s i g n i n g t h e d i m e n s i o n s o f t h e r o b o t
shown i n F i g . 7.
I t a r e then
o u t p u t t o a j o i n t a c t u a t o r on t h e r o b o t by a w a l k i n g
Figures.
7 ( 1 ) and 7 ( 4 ) a r e t h e
p o s i t i o n a l v a r i a t i o n s o f the f o o t i n d i r e c t i o n s o f x
3.
Walking Patterns:
v b :wim srem
(KQY
SPEEDI
of t h e f o u r f e e t and t h e
of t h e body c e n t e r as
d e s c r i b e d by t h e p o s i t i o n s
position o r orientation
d e t e r m i n e d d u r i n g t h e passage o f t i m e .
-1IIC
a t t e n t i o n i s p a i d t o t h e m t i o n s o f each l e g .
II&IIMIR
IN ffi
I n t h i s paper
The
moment when t h e f o o t l e a v e s t h e f l o o r i s e x p r e s s e d as
t=O,
t h e l a n d i n g moment as t i m e T Y , and t h e n e x t
moment o f d e p a r t u r e as
T.
I n o t h e r words,
w a l k i n g p e r i o d w i l l be T,the
the stance p e r i o d T
t
<
T,
Ty=Tr.
one
s w i n g i n g p e r i o d Ty, and
When t h e t i m e t i s
the f o o t remains on t h e f l o o r .
Ty <
The o b j e c t i v e
Fig.4.
i.e.
Composition o f
t h e e x p e r i m e n t a l system
when t h e l e g i s n o t i n
- 317
(P,-P,)
:raIVlmmwe
'E
Stance Phase
X V
Swing Phase
.z2
x
Fig.5.
Simulation model
40000-4000-8000.
(2)
4,
N l
o
0
100
o
200
300
axis v e l o c i t y
1
400 X
(mm)
-2
-4
-0.25T
OT
time
0.25T
0.5T
(T=0.7sec)
x axis
(3)
0.75T
acceleration
Fi9.6.
-100
-200
._
d
'si
Sinusoidal f o o t trajectory
C o m p o s i t e Cycloid T r a j e c t o r y :
Beside t h e t r a j e c t o r y d e s c r i b e d i n t h e previous
paragraph, c o n s i d e r a t i o n i s given t o a t r a j e c t o r y
where t h e f o o t v e l o c i t y and a c c e l e r a t i o n can he
continuous both a t the time of d e p a r t u r e and l a n d i n g .
F i r s t , l e t s look a t t h e motion in the d i r e c t i o n of
-0.25T
OT
time
(4) z a x i s
-16001
-0.25T
>
OT
time
-41
$m
-0.25T
0.25T
0.5T
(T=0.7sec)
position
I
I
0.25T
0.5T
(T=0.7sec)
0 5T
OT
time
0.25T
0.5T
(T=0.7sec)
(6) Z
axis a c c e l e r a t i o n
- 318 -
0.75T
0.75T
X = Am sin 2 n t/Ty
TY
' The.speed
is obtained by integrating Eqiiation ( 1 0 )
when Z=O at. 1.=0, TyJ2 b y
*
Am2 Ty
t
2 =
I
_
(1
cos 4n-)
(11)
TY
4K
__
= Am2 sin 4 n
Ty
Am2 Ty
AmlTy
x.
___ ( I - c o s
t
2 n __ 1
4n
(4)
2n
TY
and the position i s obtained by integraiing
Equation ( I ) with t
TY
__ sin 4 % -
(--
2 =
(12)
TY
4n
8 IC Ilo
Am2 =
TY'
TY
AmlTy
sin
(t
X z -
2 x
2xt
)
c1
TY
2n
_
I
_
_
TY'
so
TY
27t
1
t
__ sin 4n4n
TY
(16)
4n
TY
1
(15)
= ZHo(tn
- __ sin 2n-
X = So(-
TY
TY
TY
cos 4 n ___ )
TY
2 = 2110 (-
t
- cos z n - )
-(1
- (1 TY
TY'
2110
=
TY
N
= So(tn
1
- __ sin 2 n tn)
2n
100
200
300
400 X (mm)
(1) Ground coordinate foot trajectory
(9)
I
I n z axis movements, the boundary conditions of the
'
100
200
O
300
400 XZ (mm)
0
(2) Waist fixed coordinate fool trajectory
Fi9.8.
- 319 -
Authorized licensed use limited to: Khajeh Nasir Toosi University of Technology. Downloaded on December 21, 2009 at 05:56 from IEEE Xplore. Restrictions apply.
Shown
iii
F i g . 8 a r e the f o o t tra.jert.ories
exiirpc-
-5001
.:.
-1000
-0.257-
0.25T
0.5T
(T=0.7sec)
OT
time
(I) X
l,'ip,iir<>!I
i i i r l i i : . ~ ~ c st 1 1 v
IIICII
i r j l i s i n x :11ir1
(1irrr.l i '
7.
S w i n g i n g 1r:g p e r i o i l c ~ ~ r v ci sn
v a r i e d hy t i m e .
1 . 1 ~ :
0.75T
l r a j e c t o r y cxprc:ssc:d
t i y groi11111v o o r t l i n i i L e s
w i l l lic
of r o o t mot.ions i n ( l i e x arid 7, d i r e c t i c l t i e r e f o r c , wc s h a l l c a l l I . h i s l o o t t . r a , i e c t o r y a
composit,ion
"
axis p o s i t i o n
composi l e c y c l o i d t , r a j e c t o r y " .
n o t e d where,
trajectory
An improvement. call .
i n c o m p a r i s o n L O t.he s i n ~ i s o i d a lwave
i n t,he p r e v i o i i s s e c t i o n ,
the v e l o c i t y arm-
a c c e l e r a t i o n h e r e c a n v a r y c o n t i n u o r ~ s l ywhen t.-0 a r
=Ty=0.5T.
I f t.he f o o t v e l o c i t y i s c o n t i n u o i i s a t
ii,.-
(T=0.7sec)
time
(2)
,
axis v e l o c i t y
41
JN
'i
Ai:
thus rcdiicinl:
i m p a c t a t t h e t,ime o f c o l i t a c t .
time
(I)
m E
N.5
.-3
-
8000-800-1600
time
(2)
I
(T=0.7sec)
acceleration (sinusoid)
(T,=0.7sec)
Fig.10.
F o o t m o t i o n for v a r i o u s
t ra j e c t o r i es
We h a v e t.hus f a r d e s c r i b e d two t y p e s o f f o o t
trajectories.
The aiit.hors a r i a l y z c d t h e p u s i t i o r i ,
v e l o c i t y , and a c c e l e r a t i o n o f e a c h f o o t
t ra.iPc:tory.
d e v e l o p e d a new t r a j e c t o r y , o b ~ a i n e da s m o o t h e r
v e l o c i t y and a c c e l e r a t . i o n ,
and r e d u c e d t h c maximum
v e l o c i t y and maximum a c c c r l e r a t i o n .
accelerations
Fig.9.
Composite c y c l o i d ' f o o t m o t i o n
The r e s u l t . a n t
of t h e foot i n t h e vert,ic:al
and
10(2). foot
a c c e l e r a t i o n s show c o n t i n u o u s v a r i a t i o n s f r o m t h e
stance position.
- 320 -
4.
Leg
A n a l y t i c a l R e s u l t s o f J o i n t Angular Motions o f
Walking P a t t e r n s :
c y c l o i d t r a j e c t o r y . W i t h r e g a r d s to a c r e l e r a t i o n ,
t h e form of a c c e l e r a t i o n v a r i e d i n the v e r t i c a l
d i r e c t i o n irl a composite c y c l o i d t r a j e c t o r y ( F i g . 9 ( 6 ) )
a p p e a r s e x a c t l y the same a s ' the a c c e l e r a t i o n
v a r i a t i o n o f the knee j o i n t ( F i g . t l ( 7 ) ) . At the
same time, the w a i s t a n g u l a r v e l o c i t y v a r i a t i o n ( i ' i g .
l l ( 2 ) ) a l s o shows i n f l e c t i o n p o i n t s . One .can
r e c o g n i z e an improvement i n the follow-up performance
of j o i n t motions d u r i n g swinging, r e d u c t i o n of
g e n e w t i o n of i n e r t i a b y swinging the l e g , and
r e d u c t i o n of body s h a k i n g .
Conclusion:
5.
;:
i
i
/
h
-40
.g
.s
-80
OT
-0.25T
'-
time
(I)
0.25T
0.5T
(T~0.7sec)
10.75T
-80
time
waist j o i n t angle
(T~0.7sec)
>U
M
-- -8001
.s
OT
-0.25T
time
0.25T
0.5T
(T=0.7sec)
-400
-800
0.75T
time
20
.2%
10-
54
2%
0 -
,"E
E!
-10-20
-10
.-0t
._
(3)
'
-6
time
(T=0.7sec)
waist j o i n t angle acceleration
.-0C
0
-0.25T
time
._
(7)
(T~0.7sec)
- -80
-80
-160
'-
(T=0.7sec)
OT
time
0.25T
0.5T
* (T=0.7sec)
0.75T
time
(8)
(T=0.7sec)
knee j o i n t torque
F i g . 11. J o i n t mot i o n
- 321 -
Authorized licensed use limited to: Khajeh Nasir Toosi University of Technology. Downloaded on December 21, 2009 at 05:56 from IEEE Xplore. Restrictions apply.
References
322 -