Creating Robots

Embed Size (px)

Citation preview

  • 7/29/2019 Creating Robots

    1/4

    C r e a t i n g R o b o t M o d e l s f o r M P K - A R o u g h G u i d e

    S a g a r B e h e r e

    b e h e r e @ k t h . s e

    A u g u s t 2 , 2 0 0 9

    A b s t r a c t

    T h i s d o c u m e n t s u m m a r i z e s t h e s t e p s I t o o k t o c r e a t e a r o b o t m o d e l f o r t h e 6 D O F K U K A K R 5 S i x x R 8 5 0

    r o b o t i c a r m .

    1 I n t r o d u c t i o n

    R o b o t m o d e l s f o r u s e w i t h t h e M P K l i b r a r y n e e d t o h a v e a c o l l i s i o n m o d e l i n O p e n I n v e n t o r ' s . i v l e f o r m a t .

    T h e s e c o l l i s i o n m o d e l s a r e b a s i c a l l y . i v m o d e l s o f i n d i v i d u a l r o b o t l i n k s . T h e r o b o t d e n i t i o n ( . r o b ) l e c o n t a i n s

    p a r a m e t e r s n e e d e d t o a s s e m b l e t h e l i n k m o d e l s i n t o t h e e n t i r e r o b o t a r m . T h e p r o c e s s o f g e n e r a t i n g a s u i t a b l e l i n k

    m o d e l i n . i v f o r m a t a n d n d i n g t h e a s s e m b l y p a r a m e t e r s i s n o t i m m e d i a t e l y o b v i o u s . T h i s d o c u m e n t d e s c r i b e s

    t h e s t e p s I h a d t o t a k e t o b u i l d a . r o b l e f o r m y r o b o t i c a r m .

    2 Q u i c k s t a r t

    1 . G e n e r a t e C A D m o d e l o f i n d i v i d u a l l i n k s

    2 . O p e n e a c h m o d e l i n b l e n d e r 3 d . S a v e i t i n b l e n d e r f o r m a t .

    3 . S h i f t o r i g i n o f g l o b a l c o o r d i n a t e s y s t e m o f e a c h l i n k t o t h e p o i n t a b o u t w h i c h t h e l i n k r o t a t e s

    4 . E x p o r t m o d e l o b t a i n e d i n s t e p 3 t o . i v f o r m a t

    5 . U s e b l e n d e r t o c a l c u l a t e o s e t s o f c o o r d i n a t e s y s t e m o r i g i n o f e a c h l i n k f r o m c o o r d i n a t e s y s t e m o r i g i n o f

    p r e v i o u s l i n k .

    3 D e t a i l e d d e s c r i p t i o n

    1 . D o w n l o a d a C A D m o d e l o f t h e r o b o t f r o m K U K A w e b s i t e i n . S T L f o r m a t

    2 . I m p o r t t h e m o d e l i n t o b l e n d e r ( h t t p : / / w w w . b l e n d e r . o r g ) . I u s e d v e r s i o n 2 . 4 8 a

    3 . G o t o e d i t m o d e , s e l e c t a l l v e r t i c e s ( ' A ' k e y ) , s e t t h e l i m i t t o 0 a n d r e m o v e d o u b l e s . T h i s s t e p m a k e s i t

    e a s i e r t o s e l e c t p a r t s o f t h e m o d e l w h i c h n e e d t o b e d e l e t e d l a t e r . A l s o , i t c o u l d l e a d t o a s m a l l e r . i v f o r m a t

    r e p r e s e n a t i o n ( l e s s v e r t i c e s )

    4 . N o w , w e n e e d m o d e l s f o r t h e i n d i v i d u a l l i n k s . D e c i d e w h i c h l i n k i s n e e d e d a n d t h e d e l e t e a l l o t h e r p a r t s o f

    t h e m o d e l . S a v e t h e l e a s a . b l e n d l e . N e x t , e x p o r t i t t o t h e . i v f o r m a t . V i e w t h e r e s u l t i n g . i v l e w i t h t h e

    i v v i e w p r o g r a m .

    5 . R e p e a t s t e p 4 u n t i l y o u h a v e . b l e n d a n d . i v l e s f o r a l l l i n k s .

    6 . I f y o u f o l l o w e d e x a c t l y t h e s a m e s t e p s w h i l e g e n e r a t i n g t h e l i n k m o d e l s f o r a l l l i n k s , t h e r e s u l t i n g . i v l e m o d e l s

    w i l l b e t o s c a l e a n d t h e i n d i v i d u a l l i n k m o d e l s w i l l b e p o s i t i o n e d a t t h e r i g h t p l a c e s . T h i s m e a n s t h a t i f y o u

    c o l l e c t t o g e t h e r a l l t h e . i v l i n k m o d e l s i n a s i n g l e . i v l e ( s e e b o x t o s e e h o w ) , y o u ' l l s e e t h e e n t i r e r o b o t a r m

    w i t h a l l t h e l i n k s i n t h e i r r i g h t p l a c e s .

    1

  • 7/29/2019 Creating Robots

    2/4

    # I n v e n t o r V 2 . 1 a s c i i

    # r o b o t m o d e l

    S e p a r a t o r

    {

    F i l e { n a m e " k u k a _ 0 . i v " }

    F i l e { n a m e " k u k a _ 1 . i v " }

    F i l e { n a m e " k u k a _ 2 . i v " }

    F i l e { n a m e " k u k a _ 3 . i v " }

    F i l e { n a m e " k u k a _ 4 . i v " }

    F i l e { n a m e " k u k a _ 5 . i v " }

    F i l e { n a m e " k u k a _ 6 . i v " }

    }

    7 . N e x t , w e n e e d t o m e s s w i t h t h e l i n k m o d e l s i n o r d e r t o p o s i t i o n t h e l o c a l c o o r d i n a t e s y s t e m ( i n t h e e x p o r t e d

    . i v l e s ) a t t h e r i g h t p o i n t a n d o r i e n t a t i o n . T h i s i s i m p o r t a n t b e c a u s e i n t h e r o b o t d e n i t i o n l e s , t h e j o i n t

    r o t a t i o n s a r e s p e c i e d a r o u n d t h e a x e s o f t h e l o c a l c o o r d i n a t e s y s t e m . U n l e s s t h e l o c a l c o o r d i n a t e s y s t e m i s

    i n t h e r i g h t p l a c e i n e a c h l i n k m o d e l , y o u r r o b o t l i n k s w i l l g o a l l o v e r t h e p l a c e w h e n y o u u s e t h e . r o b l e i n

    M P K

    8 . T h e l o c a l c o o r d i n a t e s y s t e m i n t h e e x p o r t e d . i v l e m a t c h e s t h e g l o b a l c o o r d i n a t e s y s t e m i n b l e n d e r . T h u s ,

    y o u n e e d t o m o v e t h e g l o b a l c o o r d i n a t e s y s t e m t o t h a t p o i n t o n a l i n k , a b o u t w h i c h t h e l i n k r o t a t e s , w h e n

    c o n n e c t e d t o t h e p r e v i o u s l i n k . S e e g u r e 1 t o s e e w h e r e I h a d t o p o s i t i o n t h e g l o b a l c o o r d i n a t e s y s t e m f o r

    e a c h l i n k o f m y r o b o t . O n c e y o u h a v e s h i f t e d t h e g l o b a l c o o r d i n a t e s y s t e m t o t h e r i g h t p l a c e , s a v e t h e . b l e n d

    m o d e l a n d e x p o r t i t t o . i v f o r m a t a g a i n .

    9 . N o w , i f y o u u s e t h e c o d e g i v e n i n t h e b o x a b o v e t o c o l l e c t t h e l i n k s t o g e t h e r i n t o a r o b o t m o d e l , i t s n o t g o i n g

    t o w o r k . T h i s i s b e c a u s e i n v e n t o r w i l l p l a c e a l l t h e l i n k s s u c h t h a t t h e o r i g i n s o f t h e i r l o c a l c o o r d i n a t e s y s t e m

    c o i n c i d e . Y o u n e e d t o s p e c i f y t h e o s e t o f t h e o r i g i n o f t h e c o o r d i n a t e s y s t e m o f e a c h l i n k , f r o m t h e o r i g i n o f

    t h e c o o r d i n a t e s y s t e m o f t h e p r e v i o u s l i n k . F o r e x a m p l e , l e t s s a y w e n e e d t o n d t h e o s e t o f l i n k 3 w . r . t l i n k

    2 . T o d o t h i s , o p e n t h e . b l e n d m o d e l o f l i n k 2 . Z o o m i n t o t h e p o i n t o n t h e l i n k , w h e r e l i n k 3 ' s c o o r d i n a t e

    s y s t e m o r i g i n w i l l t o u c h , w h e n i t i s p r o p e r l y a s s e m b l e d . G e t t h e c o o r d i n a t e s o f t h i s p o i n t . T h e s e w i l l b e t h e

    o s e t o f l i n k 3 w . r . t l i n k 2 . N o t e t h i s d a t a c a r e f u l l y . Y o u ' l l n e e d i t t o b u i l d t h e . r o b l e .

    1 0 . R e p e a t t h e s t e p s o f p o i n t 9 t i l l y o u k n o w t h e o s e t o f e a c h l i n k w . r . t i t s p r e v i o u s l i n k .

    1 1 . W i t h t h e d a t a f r o m p o i n t 1 0 a n d t h e . i v m o d e l s f r o m p o i n t 8 y o u c a n n o w a s s e m b l e t h e c o o r d i n a t e s y s t e m

    s h i f t e d . i v m o d e l s i n t o a c o m p l e t e r o b o t m o d e l . T h e s a m e d a t a i s u s e d t o c r e a t e a . r o b l e . S e e l e s r o b o t . i v

    a n d k u k a . r o b f o r t h e r o b o t m o d e l a n d . r o b l e f o r m y r o b o t .

    4 A p p e n d i x : C o o r d i n a t e s y s t e m v i s u a l i z a t i o n

    I t i s o f t e n u s e f u l t o i n s e r t 3 a r r o w s ( t h e X - , Y - a n d Z - a x e s ) t o d e p i c t t h e c o o r d i n a t e s y s t e m i n y o u r . i v m o d e l . U s e

    t h e c o d e b e l o w i n y o u r . i v l e t o g e t a n i d e a o f w h e r e t h e o r i g i n l i e s a n d h o w t h e c o o r d i n a t e s y s t e m i s o r i e n t e d .

    2

  • 7/29/2019 Creating Robots

    3/4

    F i g u r e 1 : L i n k m o d e l s

    F i g u r e 2 : T h e a s s e m b l e d r o b o t

    3

  • 7/29/2019 Creating Robots

    4/4

    # C o o r d i n a t e s y s t e m v i s u a l i z a t i o n

    S e p a r a t o r

    {

    # Y - a x i s

    S e p a r a t o r

    {

    B a s e C o l o r { r g b 0 1 0 }

    R o t a t i o n { r o t a t i o n 0 0 0 - 1 . 5 7 0 7 }

    C y l i n d e r {

    p a r t s A L L # S F B i t M a s k

    r a d i u s 1 # S F F l o a t

    h e i g h t 2 0 0 # S F F l o a t

    }

    T r a n s l a t i o n { t r a n s l a t i o n 0 1 0 0 0 }

    C o n e {

    b o t t o m R a d i u s 4

    h e i g h t 8

    }

    }

    # X - a x i s

    S e p a r a t o r

    {

    B a s e C o l o r { r g b 1 0 0 }

    R o t a t i o n { r o t a t i o n 0 0 - 1 1 . 5 7 0 7 }

    C y l i n d e r {

    p a r t s A L L # S F B i t M a s k

    r a d i u s 1 # S F F l o a t

    h e i g h t 2 0 0 # S F F l o a t

    }

    T r a n s l a t i o n { t r a n s l a t i o n 0 1 0 0 0 }

    C o n e {

    b o t t o m R a d i u s 4

    h e i g h t 8

    }

    }

    # Z - a x i s

    S e p a r a t o r

    {

    B a s e C o l o r { r g b 0 0 1 }

    R o t a t i o n { r o t a t i o n 1 0 0 1 . 5 7 0 7 }

    C y l i n d e r {

    p a r t s A L L # S F B i t M a s k

    r a d i u s 1 # S F F l o a t

    h e i g h t 2 0 0 # S F F l o a t

    }

    T r a n s l a t i o n { t r a n s l a t i o n 0 1 0 0 0 }

    C o n e {

    b o t t o m R a d i u s 4

    h e i g h t 8

    }

    }

    }

    4