비영리-변경금지 2.0 - CHOSUN

(1)

저작자표시-비영리-변경금지 2.0 대한민국 이용자는 아래의 조건을 따르는 경우에 한하여 자유롭게

l 이 저작물을 복제, 배포, 전송, 전시, 공연 및 방송할 수 있습니다. 다음과 같은 조건을 따라야 합니다:

l 귀하는, 이 저작물의 재이용이나 배포의 경우, 이 저작물에 적용된 이용허락조건 을 명확하게 나타내어야 합니다.

저작권법에 따른 이용자의 권리는 위의 내용에 의하여 영향을 받지 않습니다. 이것은 이용허락규약(Legal Code)을 이해하기 쉽게 요약한 것입니다.

Disclaimer

저작자표시. 귀하는 원저작자를 표시하여야 합니다.

비영리. 귀하는 이 저작물을 영리 목적으로 이용할 수 없습니다.

변경금지. 귀하는 이 저작물을 개작, 변형 또는 가공할 수 없습니다.

(2)

[UCI]I804:24011-200000265939

(3)

(4)

(5)

(6)

(7)

(8)

(9)

(10)

(11)

(12)



(13)

(14)



 

^



_

_

_

_ ^ˆ

_ ^ˆ

_ ^ˆ

_

_^

_^

_^

_^



  ×  ×   × 

^



_





(15)

(16)

(17)

(18)

(19)

(20)

(21)

(22)

(23)

(24)

(25)

(26)

(27)

(28)

axis _{  }  _{  }  _ _ 

1 0 0 387 _

2 0 400 0 _

3 180 250 _ 0

4 -180 0 0 _



  



 







^

 cos_ sin_  _{ }



sin_cos_{ }cos_cos_{ }sin_{ }sin_{ }_ sin_sin_{ }cos_sin_{ } cos_{ } cos_{ }_

   













^

 cos_sin_ 



sin_ cos_  

   

   











^





cos_sin_ 

sin_ cos_  

   

   











^





   _

    

     

   











^





cos_ sin_  

sin_cos_  

    

   

(29)



_^_^_^_^











^

 cos_ _ _ sin_ _ _  cos_ _ _cos_



sin_ _ _ cos_ _ _  _sin_ _ _sin_

    __ _

   

^ 

^ _^ _^ _^^



_^^^







^





cos_ __ sin_ _ _  _cos___cos_ sin_ __ cos__ _  _sin___sin_

    _ _ _

   







^^^^^^^^^









    

_^cos_^ _^ _^_^sin_^ _^ _^_^

 _cos_^ _^ _cos_^

_^sin_^ _^ _^_^cos_^ _^ _^_^

 _sin_^ _^ _sin_^

_^_^ _ _^ _

 _^ _^ _^ _^

 

(30)

_ _ _ _ _^ _^

_^

_   _   _   _  

^ _^ _^ _^         

^ _^ _^ _^         

^ _^ _^ _^         

^ _^ _^ _^         

(31)

 

_^

_^ _^ _^ _^ _^



 

_^

 ∙

^

  

_

_ 







^^^^^^

_^







^^





^cos^sin^^^^{ }^{ }^^^{ }^{ }^^^^^^^^^^^sin^cos^^^^{ }^{ }^^^{ }^{ }^^^^^^^^^{ }^{ }^^^cos^sin^^^^^{ }^{ }^^^{  }^{  }^^^cos^sin^^^^^^^^^^^

_^ _ _ __^











_{ }

 

_

 

 

 

 

_

 

 

^{ }







  _ _ _ _^

  _^ _^ _^^

(32)

úú ú û ù êê

ê ë é

× úú úú úú ú

û ù

êê êê êê ê

ë é

¶

¶ - úú úú û ù

êê êê ë é

= úú úú û ù

êê êê ë é

-

+ + + +

) (

1

4 4 4

3 3 3

2 2 2

1 1 1

, 4 , 3 , 2 , 1

1 , 4

1 , 3

1 , 2

1 , 1

k j z

k j y

k j x

j z

j y j x

j z

j y j x

j z

j y j x

j z

j y j x

k k k k

f f f f

f f

d f d f d f

f f f

d

d q

q q

q q q

_{   } _{ }







^ ^





^{ }^





^ ^





  × 

 ≻  ^{ }⇒^^{ }^

 ≺  ^{ }⇒^^^{ }

_{   } _ ^^{ }^

_ 

(33)

1

4 4 3 4 2 4 1

4 4

4

3 4

2 4

1

4 4

4 3 4 2 4 1 4

4 1 3 1 2 1 1

1 4

1

3 1

2 1

1

1 4

1 3 1 2 1 1

1 -

úú úú úú úú úú úú úú úú ú

û ù

êê êê êê êê êê êê êê êê ê

ë é

¶

=

q q

q

q q

q

q q

q

q q

q

q q

q

q q

q

z z z z

y y y y

x x x x

z z z z

y y y y

x x x x

f d f f f

A M M M M

úú úú úú úú ú

û ù

êê êê êê êê ê

ë é

=

) (

4 4 4 1 1 1

k z

k y

k x

k z

k y

k x

f f f f f f

R

q q q q q q

M

_

_^

sin_ _ __^cos_ _ __^ _sin_ _ _sin_

_

_^

sin_ _ __^cos_ _ __^ _sin_ _

_

_^

 

_

_^

sin_ _ __^cos_ _ __^

(34)

_

_^

cos__ __^sin__ __^_cos_ _ _cos_

_

_^

cos__ __^sin__ __^_cos_ _

_

_^

 

_

_^

cos__ __^sin__ __^

_

_^

 

_

_^

 

_

_^

 

_

_^

 



  







^   _



^{≺ }

(35)

_∼_

∼

_ _



  

^^



_^



   

  

 



_



_



_



_



_



_



   

^^^^



_^



      

^



_



 

__^_^_^_^ _  ____

_ ____ _ ____

__^_^_^_^ _  ____

_^ _^_^_^_^_^ _____^{ }

 _____^_

_^ _____^ _^_^_^_^_^{ }

 _____^_

_^{ } _^{ } _^{ }  

_^{ } _^{ }  

(36)

(37)

_∼_

_



_

  

  





  



 







_

  

_^



^

  







_

  

_^



^

 _^{ } _^{ }

 

_{   }_ 

_^^{ }^

 

i j 

i j  

(38)

úú úú úú úú úú ú

û ù

êê êê êê êê êê ê

ë é

¶

=

6 , 5 , 4 , 3 , 2 , 1

, 6

, 5

, 4

, 3 , 2

, 1 ,

6 1 , 1 5

1 , 1 4

1 , 1 3

1 , 1 2

1 , 1 1

1 ,

1 6

1 , 1 5

1 , 1 4

1 , 1 3

1 , 1 2

1 , 1 1

1 , 1

C Y C Y C Y C Y C Y C Y

C X C X C X C X C X C Y

C Y C Y C Y C Y C Y C Y

C X C X C X C X C X C X

A

j i m j i m j i m j i m j i m j i m

m m

M M

úú úú úú

û ù

êê êê êê

ë é

- - - -

=

j i c j i m

c m

Y Y

X X

Y Y

X X R

, ,

1 , 1 1 , 1

M



The weight matrix model is developed in section 3.1.3. This estimation model is applied to each camera used for this study in order to calculate the six camera parameters.

_∼ _

_



_

  

  





  





_^



_^



_



_^



_



_^



_



_^

  

_^



^

 

^



^

 

^

 

^

 

^

  

^



^

(39)

  _^{ }

_^{ }  

_∼_

_{   } _

 _^^{ }^

 

q j 

q j

úú úú úú úú úú ú

û ù

êê êê êê êê êê ê

ë é

¶

=

4 ,

3 ,

2 ,

1

, 4

,

3 ,

2 ,

1 ,

4 1 , 1

3 1 , 1

2 1 , 1

1 1 ,

1 4

1 , 1

3 1 , 1

2 1 , 1

1 1 , 1

q q

j q m j q m j q m j q m

m m

Y Y

X X

Y Y

X X

B M M M M

úú úú úú

û ù

êê êê êê

ë é

- - - -

=

j q c j q m

c m

Y Y

X X

Y Y

X X R

, ,

1 , 1 1 , 1

M



(40)



 i j i j

 







^





⋱

_{  }^{ }

_{  }^{ } ∅

_{  }^{ }

   

_{  }^{ }

_{  }^{ }

∅ _{  }^{ }

_^{ }

⋱

 

_{ }^  



^ _^{ }



^{ }^

_{ }^  



^ _^{ }



^{ }^

_{ }^  



^

 _^{ }



^{ }^

_{ }^  



^

 _^{ }



^{ }^

_{ }^  



^

 _^{ }



^{ }^

^  



^^{ }^^^{ }



^{ } ^^

(41)

_^{ } _^{ }   

 _^{ } _^{ } 

   

_  _  



   



_^

_^

(42)

Block diagram of robot’s vision control scheme in

(43)



i j

  





   

  

^^



_^



   

  

^^



_^



 

_^ _^_^_^_^_^ _____^{ }

 _____^_

_^ _____^ _^_^_^_^_^{ }

 _____^_

_^

_^



^_____



^

_

_ _

(44)

__^_^__^_^___^^{ }

_ _^__ _^

_  ___^

_^



i j _ i j

___^

__{ }



 _{ ∼ }

^

û ù

ë é

¶

=

6 ,

5 ,

4 ,

3 ,

2 ,

1

, 6

, 5 , 4 , 3 , 2 , 1 ,

6 2 , 1

5 2 , 1

4 2 , 1

3 2 , 1

2 2 , 1

1 2 ,

1 6

2 , 1 5

2 , 1 4

2 , 1 3

2 , 1 2

2 , 1 1

2 ,

1 6

1 , 1

5 1 , 1

4 ,

3 1 , 1

2 1 , 1

1 1 ,

1 6

1 , 1 5

1 , 1 4

1 , 1 3

1 , 1 2

1 , 1 1

1 , 1

C h C h C h C h C h C h

j i y j i y j i y j i y j i y j i y

j i x j i x j i x j i x j i x j i x

y y y y y y

x x x x x x

y y j i y y y y

x x x x x x

M M M M M M

_ _

i j



_^

  







_^



_^



_^

⋯ 

_^



_^



^

(45)

_∼ _

_∼_



q j



_

  



 

^^



_^





  



 

^^



_^







_^ _^_^_^_^^_^_ ____^_^_

 ____^_^__^

_^ ____^_^__^_^_^_^^_^_

 ____^_^__^

 ∼  _^{ } _^{ }

  

 _^ _^ _^

_ _^

_^



^ _ _ _



^

(46)

_

_ _

__^_^__^_^___^^{ }

_ _^__ _^

_  ___^



 

q j

_ q j

___^

__{ }



 _

^{ }

û ù

ë é

¶

=

4 ,

3 ,

2 ,

1

, 4

,

3 ,

2 ,

1 ,

4 2 , 1

3 2 , 1

2 2 , 1

1 2 ,

1 4

2 , 1

3 2 , 1

2 2 , 1

1 2 ,

1 4

1 , 1

3 1 , 1

2 1 , 1

1 1 ,

1 4

1 , 1

3 1 , 1

2 1 , 1

1 1 , 1

θ h d h θ h θ h

j q y j q y j q y j q y

j q x j q x j q x j q x

y y y y

x x x x

y y y y

x x x x

M M M M

(47)



_^

  





_^



_^



_^

⋯ 

_^



_^{ }



_^{ } _�