Position based visual servoing using a non-linear approach

10 downloads 0 Views 211KB Size Report
criteria of camera calibration, hand-eye calibration, robot modelling, scene and target modelling, and also regarding the processing time required to compute.
                              !"" #$  % & 

     

        

    

   

                               

            

                                  

     

        

  

   !  "  #    $         

        !   %

   !       &

 ! 

         

   

   

   !

      "   

   

$    '      $      (     &  

  )  

     

   ! 

   * "     

   

                                   +           

     

          (          

                                                      

   + 

                                    

  + 

                  !      "  # $        %           ! & '  (  $    %   '    ! ) *   +  ,,- . !                   +               +   )! !        +                     /!                     0        1     1 2 '                       3   4 5 , 6 4          4  .    "$ ,   !     (             $      3           7         7    !         8        9   7   -           7          :        ! 9                !      $ !               ;            -  1                       &<  1           7    *              !  ! 

         '   1  7      !    7< !         "     #      -           7    1                !    /     !      !   1                                   1             





          

.            "& #    =  "      #           z Object frame

V

Mp t x

O



y Sensor frame

x

C(t)

z

y Mo

z M

A y

x

Sensor frame at equilibrium (Absolute frame)



                        



                           !          0  " ?  #       0       "  # . 0            1              !                !     

   



                    

" #

.                           "4#  ? 6                                      

 ? " " " ###

"7#   " " ##    !             " #

" # ?  " # " # "(# " " #       " #  " #  

   ! #   < =      1            7<      7< !      =             

 ?   

 



6

 





6

" #

     



 ?

" #  ? 

?  "@#         



"-#

"5#

    !           "@#   !       

    ! @         

1      -  5                    -/     ? "    # "     # 

                 

                                     7# $      '      %    !                !                "&       #   0  A0 " # $  0                !        !      '           !                             

>  7 C          ? 6   >                   

   ´Ñ¸Æµ "6 6 6  6 6 6# "6 6 4    76#

   ´Ñ¸Æ µ "6 6 4    76# "6 6 6  6 6 6#

>             7         "    #    

 ´Ñµ "6 57 66(, 6577# "67 7 676  6- ,#

 "6 5  6767 6( (# "6 5+ 676- 6( 7#

>  (    !  '         . !    !             Sensor frame trajectory (x,y,z view) Z axis (m)

Nonlinear feedback - K diagonal Rectilinear trajectory

-0.5 -0.6 -0.7 -0.8 -0.9 -1 -1.1 -1.2

0 -0.05 -0.1 Y axis (m) -0.15 -0.2 -0.25 -0.25

-0.2

-0.1 -0.15 X axis (m)

-0.05

0

>  (   ! "  # .               !    

            .                                    

Position x(t) (m)

Orientation y(t) 0.2

x component y component z component

0.2 0

x component y component z component

0.1 0 -0.1

-0.2 -0.2 -0.4

-0.3 -0.4

-0.6

-0.5 Position x(t) (m)

0

Orientation y(t)

0.8

20

40

60

80 100 120 140 160

0

20

40

60

80 100 120 140 160

0.5 x component y component z component

0.6

x component y component z component

0.4 0.3

0.4

0.2

0.2

0.1

>  + &     C   

0 0

Translation velocities (mm/s) 500

-0.1

-0.2

-0.2 0

20

40

60

80 100 120 140 160

0

20

40

60

80 100 120 140 160

>   &     C   

x component y component z component

5

300

0

200

-5

100

-10

0

-15

-100

-20 0

Translation velocities (mm/s)

Rotation velocities (degre/s) 10

x component y component z component

400

20

40

60

80 100 120 140 160

0

20

40

60

80 100 120 140 160

Rotation velocities (degre/s)

200

20 x component y component z component

100

x component y component z component

15

0

10

-100

5

-200

0

-300

-5

-400

-10 0

20

40

60

80 100 120 140 160

0

20

40

60

80 100 120 140 160

>  - '  "  @# 1 >               .         !      !          66   >  -         1                             >  5      !  '   Sensor frame trajectory (x,y,z view) Z axis (m)

Nonlinear feedback - K diagonal Rectilinear trajectory

-0.5 -0.6 -0.7 -0.8 -0.9 -1

>  , '  "  @#                 !   7  .         Æ!                    !  0      !           .                             - 



  

3!         :   1 2        !    1        7<      7<         "        #     !        &         ! 

-1.1 -1.2

0 -0.05 -0.1 Y axis (m) -0.15 -0.2 -0.25 -0.25

-0.2

-0.1 -0.15 X axis (m)

-0.05

0

>  5   ! >  +  ,     !           ! 

      !    !                              8     !          "   !  #      "                                 ! /!    

    

& ; $  $ .   2 D   & 3  E$              /! !E ... "    /    -   % ,"4#  4/ - ,,7

4 A  2 > ' & 8  E$          E ... "    /    -    +"7#  7 7/74- F ,,4

7 > ' E&      !         /    E "  0     +  GH'1     % ,,+

( ' & E%       / $  E  1   1 *  ;      /7 ,,7

 ' !  8 * E1        E    +     2   $  & 1H' ,,+

- E   -   +  3  > % 7  (,5/ 64 3! ,,-

4 &  H &; ; . ; E%         !       $         E ... "    /    -    ," #  (/7 >! ,,7

7 8  C 1  44 # # 4

 4    5  6    5          4  

  4    4 4 4

  #     1 F  3J 0    0J . 7+6/((6 +(6

(  ' 3 G 2 2 A 

+  7 "  "$ ,  -  1 :  ! & ,, 

1/

C

 $' GA   E1/            E

   

 ...     +    /    -    65(/ 655 ,+6

-   F ' '    * )  2 E8  A/A= ' :  '  &   2 %   E

... "    /    -    4" #  -+(/-,- C ,,-