MODELING OF BIPEDAL ROBOT NEGOTIATING SLOPES A dissertation submitted to the Department of Electrical Engineering, University of Moratuwa in partial fulfilment of the requirements for the Degree of Master of Science by M.G.A.P. ABEYRATNE Supervised by: Prof. Lanka Udawatta Department of Electrical Engineering University of Moratuwa Sri Lanka 2010 94547 Abstract This research shows how the robotics theories are applied to model the bipedal walking robot. Utilizing the direct kinematics and inverse kinematics, the kinematic model for the robot is developed. The derivation of joint angle equations for 6 links Robot, walking on a slopping surface, is a direct approach in this research. The development of hip trajectory is another important invention specific to this research. The dynamic stability is analyzed by utilizing ZMP criteria. The calculation of ZMP for this model is very complex and based on mechanics theories. The selection of iteration method to calculate linear accelerations of each link (which are used to calculate ZMP) is guaranteed by simulation results. The dynamic stability is analyzed for lower body using ZMP simulation results. For this case the "Dynamic" Balance Margin (DBM) is introduced and requirement for stability is also introduced. The methods or precautions that can be used to improve ZMP are identified. The most effected method for improve the stability is selected as control of torso angle. Finally, the modified ZMP is re-derived with the term of torso angle and it is found that the ZMP can be moved to safe margin by controlling torso angle. The results show the effectiveness of the proposed methodology. D E C L A R A T I O N " T h e w o r k s u b m i t t e d i n t h i s d i s s e r t a t i o n i s t h e r e s u l t o f m y o w n i n v e s t i g a t i o n , e x c e p t w h e r e o t h e r w i s e s t a t e d . I t h a s n o t a l r e a d y b e e n a c c e p t e d f o r a n y d e g r e e , a n d i s a l s o n o t b e i n g c o n c u r r e n t l y s u b m i t t e d f o r a n y o t h e r d e g r e e . N a m e o f C a n d i d a t e - M . G . A . P . A b e y r a t n e D a t e - 8 1 h F e b r u a r y 2 0 1 0 W e l l e n d o r s e t h e d e c l a r a t i o n b y t h e c a n d i d a t e . l j / I . / \ N a m e o f t h e S u p e r v i s o r - P r o f . L a n k a U d a w a t t a D e c l a r a t i o n A b s t r a c t A c k n o w l e d g e m e n t L i s t o f F i g u r e s L i s t o f T a b l e s C h a p t e r s 1 . I n t r o d u c t i o n C o n t e n t s 1 . 1 G e n e r a l i n t r o d u c t i o n t o r o b o t i c s 1 . 1 . 1 W h a t i s a n d w h a t i s n o t a r o b o t 1 . 1 . 2 L a w s o f r o b o t i c s 1 . 1 . 3 R o b o t i c a n a t o m y 1 . 1 . 4 R o b o t a p p l i c a t i o n s 1 . 2 R o b o t l o c o m o t i o n 1 . 2 . 1 K e y i s s u e s o f l o c o m o t i o n 1 . 3 L e g g e d m o b i l e r o b o t 1 . 3 . 1 L e g c o n f i g u r a t i o n a n d s t a b i l i t y 1 . 3 . 2 B i p e d r o b o t 1 . 3 . 3 B i p e d w a l k i n g 1 . 4 R e s e a r c h o b j e c t i v e s 1 . 5 O v e r v i e w 2 . L i t e r a t u r e r e v i e w a n d P r o b l e m S t a t e m e n t 2 . 1 L i t e r a t u r e R e v i e w 2 . 2 P r o b l e m S t a t e m e n t 2 . 2 . 1 P r e l i m i n a r i e s 2 . 2 . 2 P r o b l e m I d e n t i f i c a t i o n 2 . 2 . 3 N e w s u g g e s t i o n s 3 . S w i n g l e g k i n e m a t i c s f o r B i p e d r o b o t 3 . 1 P r e l i m i n a r i e s 3 . 1 . 1 M a n i p u l a t o r k i n e m a t i c s 3 . 1 . 2 L i n k d e s c r i p t i o n s 3 . 1 . 3 L i n k p a r a m e t e r s 3 . 1 . 4 D e r i v a t i o n o f l i n k t r a n s f o r m a t i o n s 3 . 1 . 5 C o n c a t e n a t i n g l i n k t r a n s f o r m a t i o n s . . 3 . 2 D e r i v a t i o n o f j o i n t a n g l e e q u a t i o n f o r s w i n g l e g 3 . 2 . 1 D e r i v a t i o n o f e q u a t i o n f o r j o i n t a n g l e B 2 3 . 2 . 2 D e r i v a t i o n o f e q u a t i o n f o r j o i n t a n g l e B 1 4 . G a i t d e v e l o p m e n t 4 . 1 I n t u i t i v e a p p r o a c h 4 . 2 P e r i o d i c f u n c t i o n a p p r o a c h 4 . 3 F o o t t r a j e c t o r y 5 . S t a n c e l e g k i n e m a t i c s 5 . 1 S t a n c e l e g m o d e l i n g 5 . 2 M a t h e m a t i c a l m o d e l i n g l V v V l V l l 1 1 2 4 4 5 6 8 8 9 9 9 1 1 1 1 1 2 1 2 1 6 1 6 1 6 1 6 1 7 1 7 1 7 1 7 1 9 2 0 2 1 2 2 2 4 2 5 2 6 2 7 2 7 2 8 2 9 2 9 2 9 1 1 . . . . . 5 . 2 . 1 D H p a r a m e t e r s f o r s t a n c e l e g 5 . 2 . 2 L i n k t r a n s f o r m a t i o n , h o m o g e n e o u s t r a n s f o r m a t i o n a n d E n d e f f e c t o r m a t r i c e s f o r s t a n c e l e g 5 . 2 . 3 D e r i v a t i o n o f j o i n t a n g l e e q u a t i o n s 5 . 3 M o d i f i c a t i o n o f s w i n g l e g k i n e m a t i c s 5 . 3 . 1 T r a j e c t o r y p l a n n i n g o f h i p 5 . 3 . 2 R i m l e s s w h e e l s i m u l a t i o n 5 . 3 . 3 C a l c u l a t i o n o f h i p m o v e m e n t 6 . D y n a m i c s t a b i l i t y a n a l y s i s f o r l o w e r b o d y 7 . 6 . 1 M e t h o d s f o r s t a b i l i t y a n a l y s i s o f b i p e d a l r o b o t s 6 . 1 . 1 Z e r o m o m e n t p o s i t i o n 6 . 2 Z M P c a l c u l a t i o n f o r l o w e r b o d y . ; 6 . 2 . 1 C a l c u l a t i o n o f i n e r t i a t e r m 6 . 2 . 2 C a l c u l a t i o n o f a n g u l a r a c c e l e r a t i o n t e r m 6 . 2 . 3 F i n d i n g o f m a s s - c e n t r e c o o r d i n a t e s 6 . 3 C a l c u l a t i o n o f i n d i v i d u a l 1 i n k a c c e l e r a t i o n s 6 . 3 . 1 N e w t o n E u l e r f o r m u l a t i o n 6 . 3 . 2 K i n e m a t i c s o f l i n k s 6 . 3 . 3 L i n k a c c e l e r a t i o n s 6 . 3 . 4 R e c u r s i v e N e w t o n E u l e r f o r m u l a t i o n 6 . 3 . 5 F o r w a r d i t e r a t i o n 6 . 4 A p p l i c a t i o n o f N E r e c u r s i v e i t e r a t i o n t o b i p e d r o b o t 6 . 4 . 1 N E f o r w a r d i t e r a t i o n f o r s w i n g l e g 6 . 4 . 2 N E f o r w a r d r e c u r s i v e i t e r a t i o n f o r s t a n c e l e g 6 . 5 D y n a m i c s t a b i l i t y a n a l y s i s f o r r o b o t l o w e r b o d y 6 . 5 . 1 D y n a m i c b a l a n c e m a r g i n 6 . 5 . 2 S i m u l a t i o n r e s u l t o n s t a b i l i t y - R o b o t l o w e r b o d y Z M P c a l c u l a t i o n a f t e r a d d i n g t o r s o 7 . 1 M o d i f i c a t i o n o f Z M P 7 . 1 . 1 M e t h o d f o r i m p r o v i n g t h e Z M P 7 . 2 C a l c u l a t i o n o f i m p r o v e d Z M P 7 . 2 . 1 C a l c u l a t i o n o f l i n e a r a c c e l e r a t i o n t e r m s 7 . 3 S t a b i l i t y A n a l y s i s f r o m s i m u l a t i o n r e s u l t s 7 . 3 . 1 Z M P v a r i a t i o n w i t h s l o p e a n g l e 7 . 3 . 2 Z M P v a r i a t i o n w i t h s t e p l e n g t h 7 . 3 . 3 Z M P v a r i a t i o n w i t h m a s s o f t o r s o 7 . 3 . 4 Z M P v a r i a t i o n w i t h t o r s o a n g l e 7 . 3 . 5 V a r i a t i o n o f Z M P w i t h s t e p t i m e 7 . 3 . 6 Z M P v a r i a t i o n w i t h l i n k l e n g t h L 1 a n d L 2 7 . 4 A p p l i c a t i o n o f s i m u l a t i o n r e s u l t s 8 . C o n c l u s i o n 8 . 1 D e r i v e d k i n e m a t i c m o d e l F u t u r e w o r k R e f e r e n c e s 2 9 3 0 3 1 3 2 3 3 3 3 3 4 3 5 3 5 3 5 3 8 3 8 3 9 4 1 4 2 4 2 4 4 4 5 4 5 4 6 4 8 4 8 5 3 5 6 5 6 5 7 5 9 5 9 5 9 5 9 6 0 6 2 6 3 6 4 6 6 6 6 6 7 6 7 6 8 6 9 6 9 7 0 7 1 1 1 1 A c k n o w l e d g e m e n t I e x p r e s s m y g r a t i t u d e t o m y s u p e r v i s o r , P r o f e s s o r L a n k a U d a w a t t a , f o r h i s g r e a t s u p e r v i s i o n , g u i d a n c e a n d s u p p o r t p r o v i d e d t o m e t o d o t h i s r e s e a r c h . M y s i n c e r e t h a n k s g o t o t h e o f f i c e r s i n P o s t G r a d u a t e O f f i c e , F a c u l t y o f E n g i n e e r i n g , U n i v e r s i t y o f M o r a t u w a , S r i L a n k a f o r h e l p i n g m e i n v a r i o u s w a y s t o c l a r i f y t h e t h i n g s r e l a t e d t o m y a c a d e m i c w o r k s i n t i m e w i t h e x c e l l e n t a s s i s t a n c e . S i n c e r e g r a t i t u d e i s a l s o e x t e n d e d t o t h e p e o p l e w h o s e r v e i n t h e D e p a r t m e n t o f E l e c t r i c a l E n g i n e e r i n g o f f i c e f o r t h e i r i m m e n s e s u p p o r t p r o v i d e d t o m e . 1 e x t e n d m y s i n c e r e a p p r e c i a t i o n t o D r . T h r i s h a n t h a N a n a y , S J . k k a r a i n K i n g s t o n C o l l e g e , L o n d o n f o r h i s v a l u a b l e s u p p o r t a n d f o r f u r n i s h i n g n e w i n f o r m a t i o n i n t h e f i e l d o f b i p e d r o b o t . A l s o , t h a n k s a r e d u e t o M r . S . M . W e l i h i n d a , w h o h e l p e d m e b y s i m u l a t i n g t h e d e r i v e d m o d e l a n d s h o w i n g t h e c o r r e c t n e s s o f t h e d e r i v a t i o n s . A n e s p e c i a l t h a n k i s d u e t o m y s p o u s e , M r s . H . M . S . N . K u l a r a t n e , f o r p r o v i d i n g u t m o s t s u p p o r t i n p r e p a r i n g t h i s d i s s e r t a t i o n p r o p e r l y . S i n c e r e t h a n k s a r e d u e t o m a n y i n d i v i d u a l s , f r i e n d s a n d c o l l e a g u e s w h o h e l p e d m e i n v a r i o u s w a y s t o c o m p l e t e t h i s p r o j e c t . M a y b e I w o u l d n o t b e a b l e t o m a d e i t w i t h o u t t h e s u p p o r t o f y o u a l l . v . . L i s t o f F i g u r e s F i g u r e I I P i c t u r e o f a u t o a s s e m b l y p l a n t - S p o t w e l d i n g r o b o t K U K A 1 . 2 A n i n d u s t r i a l r o b o t t h a t l e a s t l o o k s l i k e a h u m a n I J T h e b a s e , a r m , w r i s t , a n d e n d - e f f e c t o r f o r m i n g t h e m e c h a n i c a l s t r u c t u r e o f a m a n i p u l a t o r I . 4 A p p r o x i m a t e d b i p e d a l w a l k i n g s y s t e m 1 . 5 S t a b i l i t y i n s t a t i c w a l k i n g 2 . 1 A p h o t o g r a p h o f s h a d o w b i p e d r o b o t 2 . 2 A p h o t o g r a p h o f w a b i a n r o b o t 3 . 1 R e l a t i o n s h i p o f l i n k l e n g t h a n d l i n k t w i s t " 3 . 2 P a r a m e t e r s u s e d t o d e s c r i b e t h e c o n n e c t i n g b e t w e e n n e i g h b o u r i n g l i n k s 3 . 3 A t t a c h m e n t o f f r a m e { i } r i g i d l y t o t h e l i n k i 3 . 4 R o b o t l o w e r b o d y a n d n o m e n c l a t u r e 4 . 1 I l l u s t r a t i o n o f t h e g a i t c y c l e a n d d y n a m i c b i p e d w a l k i n g 5 . 1 S t a n c e l e g a n d n o m e n c l a t u r e 5 . 2 R o b o t l o w e r b o d y w i t h m o v i n g h i p 5 . 3 T h e s i m u l a t i o n o f r i m l e s s w h e e l 6 . 1 S i n g l e s u p p o r t p h a s e 6 . 2 T h e v e l o c i t y d i s t r i b u t i o n o f s w i n g l e g 6 . 3 M a s s c e n t r e c o o r d i n a t e s o f e a c h l i n k 6 . 4 T h e g e o m e t r y a n d k i n e m a t i c s o f l i n k i f o r N E f o r m u l a t i o n 6 . 5 C h a r a c t e r i z a t i o n o f t w o a d j u t a n t l i n k s f o r m i n g t h e j o i n t i f o r N E f o r m u l a t i o n 6 . 6 T w o - p a s s r e c u r s i v e N E f o r m u l a t i o n o f d y n a m i c e q u a t i o n 6 . 7 I n i t i a l p o s i t i o n o f t h e s w i n g l e g 6 . 8 I n i t i a l a n d f i n a l p o s i t i o n o f t h e s t a n c e l e g d u r i n g o n e g a i t c y c l e 6 . 9 D B M f o r s i n g l e s u p p o r t p h a s e 6 . 1 0 D B M f o r d o u b l e s u p p o r t p h a s e 6 . 1 1 V a r i a t i o n o f Z M P v s t i m e o f l o w e r b o d y f o r o n e g a i t c y c l e 7 . 1 V a r i a t i o n o f Z M P w i t h t o r s o a n g l e a t s l o p e a n g l e e q u a l t o 5 " 7 . 2 V a r i a t i o n o f Z M P w i t h t o r s o a n g l e a t s l o p e a n g l e e q u a l t o 1 0 " 7 . 3 V a r i a t i o n o f Z M P w i t h t o r s o a n g l e a t s l o p e a n g l e e q u a l t o 1 5 " 7 . 4 Z M P v a r i a t i o n w i t h t o r s o a n g l e w h e n s t e p l e n g t h i s 7 0 0 m m 7 . 5 Z M P v a r i a t i o n w i t h t o r s o a n g l e w h e n s t e p l e n g t h i s 3 5 0 m m 7 . 6 Z M P v a r i a t i o n w i t h t o r s o a n g l e w h e n s t e p l e n g t h i s 1 5 0 m m 7 . 7 V a r i a t i o n o f Z M P w i t h d i f f e r e n t v a l u e s o f t o r s o w e i g h t 7 . 8 V a r i a t i o n o f Z M P f o r d i f f e r e n t v a l u e s o f t o r s o l e n g t h 7 . 9 V a r i a t i o n o f Z M P w i t h d i f f e r e n t s t e p t i m e i n t e r v a l s 7 . 1 0 V a r i a t i o n o f Z M P w i t h d i f f e r e n t v a l u e s o f L 1 a n d L 2 P a g e 1 2 4 7 1 0 1 5 1 5 1 8 1 9 2 0 2 2 2 6 2 9 3 2 3 3 3 5 4 0 4 1 4 2 4 4 4 6 4 8 5 3 5 6 5 7 5 8 6 3 6 3 6 4 6 4 6 5 6 5 6 6 6 6 6 7 6 7 V l L i s t o f T a b l e s I a b l e P a g e j \ D H p a r a m e t e r s o f s w i n g l e g 2 2 ) I D H p a r a m e t e r s o f s t a n c e l e g 3 0 7 . \ S e l e c t e d p h y s i c a l p a r a m e t e r s f o r s i m u l a t i o n 5 8 7 . l P h y s i c a l p a r a m e t e r s f o r s i m u l a t i o n 1 6 3 7 . 2 P h y s i c a l p a r a m e t e r s f o r s i m u l a t i o n 2 6 3 7 . 3 P h y s i c a l p a r a m e t e r s f o r s i m u l a t i o n 3 6 4 7.~ P h y s i c a l p a r a m e t e r s f o r s i m u l a t i o n 4 6 4 7 . 5 P h y s i c a l p a r a m e t e r s f o r s i m u l a t i o n 5 6 5 7 . 6 P h y s i c a l p a r a m e t e r s f o r s i m u l a t i o n 6 6 5 7 . 7 P h y s i c a l p a r a m e t e r s f o r s i m u l a t i o n 7 " 6 6 7 . 8 P h y s i c a l p a r a m e t e r s f o r s i m u l a t i o n 8 6 6 7 . 9 P h y s i c a l p a r a m e t e r s f o r s i m u l a t i o n 9 6 7 7 . 1 0 P h y s i c a l p a r a m e t e r s f o r s i m u l a t i o n 1 0 6 7 V l l . . .