Position based visual servoing using a non-linear approach

Texte intégral

(1)Position based visual servoing using a non-linear approach Philippe Martinet, J. Gallice. To cite this version: Philippe Martinet, J. Gallice. Position based visual servoing using a non-linear approach. IROS’99 - IEEE/RSJ International Conference on Intelligent Robots and Systems, Oct 1999, Kyongju, South Korea. pp.531-536, �10.1109/IROS.1999.813058�. �hal-02465645�. HAL Id: hal-02465645 https://hal.inria.fr/hal-02465645 Submitted on 4 Feb 2020. HAL is a multi-disciplinary open access archive for the deposit and dissemination of scientific research documents, whether they are published or not. The documents may come from teaching and research institutions in France or abroad, or from public or private research centers.. L’archive ouverte pluridisciplinaire HAL, est destinée au dépôt et à la diffusion de documents scientifiques de niveau recherche, publiés ou non, émanant des établissements d’enseignement et de recherche français ou étrangers, des laboratoires publics ou privés..

(2)

(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)

(29) +

(30) .

(31)

(32)

(33) (

(34)

(35) . +

(36). . +

(37). ! " # $ % ! & ' ( $ % ' ! ) *

(38) + ,,- . ! +

(39) +

(40) )! ! +

(41) /! 0 1 1 2 ' 3 4 5 , 6 4 4 . "$ , !

(42) ( $ 3

(43) 7 7 ! 8 9 7

(44) - 7 : ! 9 ! $ ! ; - 1 &< 1 7 * ! ! .

(45) ' 1 7 ! 7< ! " # - 7 1 ! / ! ! 1 1 .

(46)

(47)

(48)

(49)

(50)

(51) . . "& # = " # 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 ! ! .

(52) . . . " #. . "4# ? 6 . ? " " " ###. "7# " " ## ! " #. " # ? " # " # "(# " " # " # " # . ! # < 4 .

(53)

(54) ?. > < = 1 7< 7< ! = . ? . . . 6. . . . 6. "

(55) #. . .

(56)

(57) ? " # ? . ? "@# . . "-#. "5#.

(58) ! "@# ! . ! @ . 1 - 5 -/ ? " # " # . . < "A0 7# 8 7 . . ? 4" " ## " " ## . "+#. . "# ? 4 " # ? " " ## " " ##. ",#. . A0 ( . ? " " "# ## " #. " 6#. : 0 !.

(59) ? " #

(60). " #. ? " " # " # ? . . . @ #. ? " "# # . 6 6 6 ? 6 6 6 6 6 6. . 6 6 ? 6 6 6 6 . . 0 ! / ' ! ! " # 1 ! 9 ? B 1 "6 # " # " 4# " # ? . . < ! ". . ¾ . . #. . . ¾ . " " ##.

(61) ! ! ! & . ! / 9 ! 1 ? " # " 7# ? 1 9 ! Æ . ! . 7< ! ! . ! / $ ! * .

(62) - ! > ' 7 1 <3 . - / ! . .

(63)

(64)

(65) . . 3 1 ! 4 Yc. Ra A 3D Sensor c P0. P1 Xo. P3 o Ro. ual. Virt. link. Rct Xc. Zc. P2 Yo Zo 3D Object. > 4 C . ! > <3 - . 0 +6 ' = " > 7# $ ' % ! ! "& # 0 A0 " # $ 0 ! ! ' ! . > 7 C ? 6

(66) > . ´Ñ¸Æµ "6 6 6

(67) 6 6 6# "6 6 4

(68)

(69) 76#. ´Ñ¸Æ µ "6 6 4

(70)

(71) 76# "6 6 6

(72) 6 6 6#. > 7 " # . ´Ñµ "6 57 66(, 6577# "67 7 676

(73) 6- ,#. "6 5

(74) 6767 6(

(75) (# "6 5+ 676- 6(

(76) 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. > ( ! " # . ! .

(77) . . 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. >

(78) & 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 >

(79) . ! ! 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 ! " ! # "<3 # . ! . ! .

(80) . ! ! ! ! > ! /! .

(81)

(82)

(83)

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

(85) 4/ -

(86) ,,7. 4 A 2 > ' & 8 E$ E ... " / - +"7# 7 7/74- F ,,4. 7 > ' E& ! / E " 0 +

(87) GH'1 % ,,+. ( ' & E% / $ E 1

(88) 1 * ; /7 ,,7.

(89) ' ! 8 * E1 E + 2 $ & 1H' ,,+. - < <> G < E3/2 C & 4

(90) G 'E

(91) 3

(92) +

(93) " /4# 47/ ( F ,,

(94) . 5 > F. C8 3 E% / / ! E ... " / -

(95) "

(96) # -, /566 C ,+,. + * )< * & ' E. % 'E. ...

(97) + / - 3 3 : $ 44/4+ $ ,,-. , ; < ) 3! & 3 F ) > ' E% 8 : 'IG/ E. ... " / - 4"

(98) # 5(7/5(, C ,,-. 6 3 & > 2! F ) E: % E . ...

(99) + / - 3 3 : $ ( 7( 7/7( , $ ,,-. 3 & < ; F ) E% 2 ' G 7< % >E

(100) - + 3 > % 7 (,5/

(101) 64 3! ,,-. 4 & H &; ; . ; E% ! $ E ... " / - ," # (/7

(102) >! ,,7. 7 8 C 1

(103) 44 # # 4.

(104) 4

(105) 5 6

(106)

(107) 5

(108) 4 . 4

(109) 4 4 4. #

(110) 1 F 3J 0 0J .

(111) 7+6/((6 +(6. ( ' 3 G 2 2 A . +

(112) 7 " "$ , - 1 : ! & ,, . 1/. C.

(113) $' GA E1/ E. ...

(114) + / - 65(/ 655 ,+6. - F ' ' * ) 2 E8 A/A= ' : ' & 2 % E. ... " / - 4"

(115) # -+(/-,- C ,,-.

(116)