Simultaneous Estimation of Landmark Location and Robot Pose Using Particle Filter Method
8
0
0
전체 글
(2)
(3) .
(4) !"#$% &'(!)*+ , !"#$% &'
(5) - ./0 1 2 345 &'6 6 &'+ 78 9:;< 0=>? / &'>? @ A6 B 4
(6) / C DE )) FGH"#$% &')I!)J+ KLM ;<N OP 9 : ;<- QRS &'6 6 &'+ KLM ;< & 'T ?U 1V- WX/Y OP 9: ;<T DET ZS 1V- WX/ &'6 6N [ 6 6\?U DE 1V ]@T Z/^ _? ` ;<- abc>?_ de fgh i6 &'6 23j)k 23l "#$% &'+ DE 0=>? m- no /Y KLM ;<pqFrHstuv suHvrw)x&' 6b/^ ?U DEy ]@S z{T_ abl m n o &'+ 6\?U m no &'y)| } /~? ^ "#$% y|)!)(T_m ab4 6 &'+ T ZS DEy ]@/^ noc >?_Y 0/a @- no/ m &'T de6 C no6 ./ P S 23l KLM ;< &'+ 6\?U T_ 6 _Y K _Y q"_ S _y6 ab4 + 6B4I*!IIY T }?U 1V]@ T_m 23 IJ!Ik 6\?U 1V- 0 1S &' } / ~ ¡XIx KLM ;< &' ¢/^ £Y ¡X+ J¡ ¤6? < ?U 1Vp¥Y¦w§ >~ ?U &8pw AY m N ?U ¨6T P©ª6 «¬ ® ¯°l 1V]@ =£TY KLM ;< ?U 1VN &8 ± ² 6\?U \³ _´µ¶y · O¸h6 ¹4 ¡X {2 ¯ . I| º z{T_ 23l "#$% &'+ 0« KLM ; <- 6bS y »¼ 6\?U ½¾ ± : ² DEyT Z/^ ¿À KLMy? no/ &' 23S Á¼ m @ DEy ·O ¸h ?U 6 ¨6T ·ÃÄ/Å «¬ ¿a P©ªT ZS ¹ &' 2S S ¸Æ Ç 23l "#$% .N ÈÉ_ - 6b/^ 0/a m h .- º z{ h+ [ IPT_ 23/ "#$% &'T Z Ê o@ ËS JP T_ ¸2 6\?U "#$% abS .S >? kPT_ º z{ . qr. º z{T_ 23/ "#$%&'+ KLM ;< & 'T 0=/ I| 6 &'+ 6\?U 1VN DET Z KLMy? no/ "#$% &' >? 6 &' "#$% .- 6b/^ 0/a m@- h º T_ KLM ;<6b/^ 6\?U "#$%T ÌS &' ËS 4. I>L. 23l "#$% &'+ KLM 1V- WX/ @Y WXl KLM ´m- de/ @Y Á¼ del ´m- >? KLMy ¬h/ @ >? h45 Ͳ_ 23l "#$% &' @ + 0« KLM ;< &' \¿/ Á~ ^0 T_ KLM+ ?U 1VN c DE 1V- ~
(7) DE 1VT _ m no ? 2 3l &'+ ?U 1VN m @- \T ]@/ "#$%6 l "#$% &' WX @+ ?U DE 1VWXS 6 @+ ?U 5mY mT ·O ¸h6 ¹4 ?U 1V- WX/Y DEyT Z S ·O¸h ¹/^ DE WXS ´m d e @+ WXl KLMT Z ]@ ´m- ^/ @6 6 @+ ?U o¬ 1VT_ ´l μ@N WXl KLM μ@T ZS ·O¸h Ïm- : 6N [6 hl Ïm >? KLMyT Z ]@ ´m- de 6 del ´m- >? ]@l ?U D Ey 1V- ¬hS 6S @>? KLMy ÏT ?U 1VN DE 1V "#$% .- ]@ A2. 23l KLM ;< &' WX @+ 6\?U m ·O¸h K²Ð<yT 6\?U 1VN 6Ây DE 1V- WX/ @ 6 0« KLM ;< &' WX @+ 6\?U 23l W ½¾@p¥Y¦Yw : WX/Ñ /: X @+ DEyT ZS ½¾@pÒÓ¥YÒÓ¦w- WX S p)w+ 6\?U m @T ·O¸h Ï c/ @6 ´l 5 Ê m @ Ô N ÕT ·O¸h6 Ïcl 5m ÔN m Õ Y Á¼ ?U T ZS ·O¸h r hS 6 Ö GFÓ×uvpw c ·O¸h h/ c?_ m @T ZS ·O¸h K²Ð<y ) |T 6\?U m@ ·O¸h6 .@45
(8)
(9) . p)w.
(10) . pIw p)wT ·O¸h6 Ïcl m @ - >? 6\?U 1V- WX/ @6 ^ 0_ ¥Y ¦Y Á¼ Ø H!)T_ 6\?UT ZS KLM ½¾@- ~
(11)
(12)
(13) .
(14)
(15) . . . pIw. pJw+ DET ZS ·O¸h Ïc/^ D@ y WX/ @6 DET ZS ·O¸h K².
(16) nmlpoqrsj]JvutAUVwxIyz{2.
(17)
(18) !"#$% .
(19) . &'(. .
(20) . . . . . . . . . . . . . . . . . . . . . . . .
(21) .
(22) . .
(23) . . . . . . &)( &*( &'( +#, - . /0
(24) 1 0 2% &)( 3% 45.
(25) 6 78, %9 :;<=> ? %@AB !" #$ CD EFG HI JK. &)( L M
(26) G *+ N %@AB L 7O
(27) PQ R#/S . %@AB L M
(28) G *+ N % T, U
(29) > PQM VW /ID *+ N % XY
(30) > L7OZA S PQ. M
(31) G ' ) AB 7O
(32) PQM R# ' ) % TZY AB 7OZA
(33) % /S PQ[\
(34) G % XY
(35) % S PQ.]N^_ ` *> a bc 45 defW
(36) PQ JK 2ZA
(37) G g hG def PQ #M R# /S . ` * i
(38) G % Tj, U
(39) PQMA
(40) G % kZY
(41) > lm /S PQ[ \
(42) G % XY n 3%
(43) % S P Q. . #,
(44) } M ~ +#> +# .
(45) / # } M / +#% 45. +#> & ( &¡(+ 3% 5 ePQ r p1 I ePQ r uz{q f PQ r i `¢\ £ d #PQ r si{w
(46) # } M ~/S . % + AB ¤%
(47) -¢¥%
(48) e M #¦ ! 0 & ( 5 ePQ 0 2ZA AB+ % ¤% -¢¥% 4 A } ePQ % ePQ . AB+ ¤% -¢ § ZA JK &^(> I ePQ 0 2% % ePQ AB+ % ¤% d¦¨/S ©ª Tg @T ePQ 0 ? % %9/
(49) 6 78 , T9 « @Tg % ?¬ }. -¢¥% f4 -¢¥%$ S }[ Uc @T ePQ r xzs1A 0 /ID
(50) AB+ % ¤% @T % ?¬/S [Y % }.
(51) %@AB £. } TZA }[I ®/\ ¯ ZA ¤[© } }[© L hG
(52) @T e PQ r uz{q, &^(+ 3% JK/ ° &(> f PQ% % ePQ
(53) %!ZA g AB
(54) }± } [I ²-0 @k/I ² ! , 0 ³ e PQ% £ d # PQ &¡(+ 3 % PQM ¤0 ´ZA %+ AB¤%
(55) -¢ % µ I ® 0 . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . . !. . . . . . ". . . #. . . $. . %&. . ! # " .
(56) . . vutwx7LeIJnml. opq * ris1ptuv wpx1spny1pz{ wyv 1z ui{wis| uzti1pz{ y{tvs1ip{1. &^(. ! # " &
(57) . &(. #' " . . . . . . . . . . . .
(58) . . . % $ $ ! . # % " % .
(59) . . . . & (. . . ;A2. 45. } M ~ +#> %g
(60) +#% Tg
(61) 6 } M ~ +#> lA % ZA /\ \
(62) , T9 } M ~ +# 5 ePQD, T9/ @Tg . W, \ a
(63) . } M ~ +# 78, $%\ % @T ePQ / ? r xzs1 } r uz{q , 4/ ? + % $%\ ePQ +
(64) } M ~ +. . ! . &¡(.
(65) . &¶(
(66) defW , \ & ( &¡(, /0 e PQM 0 2% &¶( 0 3% ) PQM I\ AB }[ -¢¥% #. AB · . . . . . . %. .
(67)
(68) .
(69) !"# $%& '' () *+ , -./ . #' " . . ! . 012.
(70) . /& A¡3 /89:/ d¬-& £9/# /89 :3 } £> 0P 2 O0\ 2 0\ ª2 0 ª2 £? /8, !"# lm n/o 0 2 O0\ 2 0\ ª2 0 ª2 ®¯ /89:3 £> £?# 9 ® °±² /{, RSI9 ! |¨?j. 46LA2. "3 4
(71) 5 67 /89:; <=> ?& ; / / ; 3
(72) @A B CDE?& ; / F GHI9 J0KLMML2NOPQ RS; ()H FG 0TMUVWMXU YXZL$W T[X2NO\Q RS]/ ^ _` J RS3 H3
(73) -a / b9 c?d e?& f c gb>/ dh# @A ig& ()H FG RSB ^_? B CDE ?j _. k ig ^_` /89:; lm n/o !"# pq 4& ! Or s tu /_` v f / 89:3 wxy z
(74) {d0|2NO1Q }~` /8 9 :I9 /
(75) B /_? 9:B b, lm n/oI9 ^_` 4& TNQ }~ ` / / 3 S , ; /89: b?# n/o } E 8 / B , R ! "# n/o 7"
(76) ?&
(77) 9 E` , /89: ` pq4& TNQ }~` T I9 T ;¡ 9: lm n/o B I9 9: /8¢£ , ?¤H¡ d DE,. jyUV_z . ¥X O ¦XL $¦M % WLW$ W§WML ! 3 tuB ¨, c¤© ; ¤ ª «9: tut0ªOO52 ¢£/ ! !. ¢¡. ¥X ZX$LM ³$ L [L$XLM lm n/o
(78) ®& 7"/ (EB "´? 0P 2 /89:B d# $ % ` lm n/o 9m 9:I9
(79) ®& 7" / } µ¶?j ! & µ ¶` } / . ·, \} / ¬ &' ¸/ ·?d ¹3 /& ª}9 9: ; n/o ^/ º» e, 8H¡ ¼½ !(] ~D` /9 ^)`. 4(;£¤a¥jo. ¥X LULXZL% WLW$ %M 3 ! r 8F, /89: '' lm n/oI9m
(80) ®& 7"/ B **,.
(81) nmlpoqrsj]JvutAUVwxIyz{2.
(82)
(83) ! "#$% # &'( )***+, -. /
(84) 012 3. ), 4. & 015 6 78% 9 :; , <=> ?@AB ), 4. & C DEFG HI. ni ~F 78<i b
(85) B , . 2 5 H 78 < y
(86) 2 i & . y
(87) c1 = >l 6 . 78< y
(88) 2 ! . ¦§C¨j©AUV/jI¤a¥jo. ST ) U V TW XY TUZ V [ YZTZ J
(89) K ) L M 4 )NO 4LL P)P 4N* "#$ )QR 4*) ROO R44 # **N *LM )4* )O) R \, -. ] 9, ^. _`ab, > 9:; c2 d8F ! e( fg ;h3Bi d<. ! ^. ^jFk e( fg, l mn
(90) < '] op
(91) < ! ;qr Est
(92) <i uFk vw"x y
(93) 2 z{. vw"x y
(94) |}c2 ~F F=> 6] <2 stF \i FG. !ª84¬«8¬eIA. $ P vw"x LQ4U V MMQU O ^ _ ¡ ^b h _`F j. 4OQ9 RPM9 ^e R , . ¢£
(95) < b ¤ ), 4 ^. b ¤ ) ^. O ^. ^Fk 78<
(96) ^, ¥¦¤, . 6] jt y
(97) , ^ 7 8< y
(98) , -. /i 3F! ) 4 6] jt y
(99) > ¥¦¤B 78< §¨, -. y
(100) © ) 4 ¥¦¤B> B 782 , ¥¦¤ < , . % ª 6]<2 3. ^ < y
(101) 2 « ^ _`b _7, §¨ ¬ ! ¥¦¤ 4+, -. ;qrB] ¥¦¤B _7 § ¨ ¬ 78% ¥¦¤ 782 <F! :i _! T vw"xy
(102) 2 ! 4Q*9 RPM96 ^ "=
(103) |}c2 ~F #=( F=> 6]< y
(104) 2 . A2. $ R YZUVJY Z [ X YK P LQ49, vw"x T MMQ9, vw"xy
(105) 2 % T, n y
(106) > wv 78 ^b 5 ( 78 2 <F! . > , &' ,5 DE HI h ..
(107)
(108) . klM! 7m` Ye f O O) noU+0 I!J ikp q! *7 r 7V stu! vwmb O0 R#kl xc y! ]z^W_ [Z f XY & =>c ?&" m`a 9:& ;<U+ !*+, =>N ? ' 8 /{0 !*+, !*/+ -= |}~M! \]^W 12345 @ABC ;<M 6" N 6V" ; < F ?& GHI!J |}~M >& I! JM -A gh -A =>^W_ [Z dVe i [" p# ' g! gU+ ?& !) & g ` 6N U+ mp f!" g q! a % 1!jN \mp f `6c U+ \]&". 8 b®°¯jyzIUVA. . . b®°¯jyzIA2.
(109) !" # $%& '() !*+,! -. -./+0 !*+, 12345 6 70 ' 8 9:& ;< +, =>? 70 ') @ABC +, =>? ! " DE ' F ?& GH I!J =>0 K9 L/ => GH I!J M =>6 $N O " # 6) P Q ! 12345 ) R
(110) ST 7U+ VF !* +, -./+N WO XY& 7Z DE [" DE @ABC V ') !*+, -./+ -A H\ \]^W_ [`a0 bD6c Hd e f ' ' gh XY& =>c ?Z dV e i [" !) GH I!JM+Hj ^) R# 8. 4. `c -W`` ) o# !*+, ! -.Z = ;<!" 9:& ;< !*+, M0 DE R# kl dKM Z E ;<U+ KZ F 9:& ;<Z m " K# 6!) P Q! !*+, HR# aZ !m +, =>N ?m) ;< /{0 %! /z R# ST 7U+ Vm X Y& =>N ?" DE GHR#aZ ! @ ABC /{0 HR#aZ !m) ;<) D R#STc 7^` `a GHR# d F !! &" !) !*+,! *¡m) L/! 7 ) *7V stuM! y! vwe /{0 XY& =>? N c_¢ £ ¤¥ !*+, ;¦Z ?e i §") ¨Z `¥E [" m`a 9:& ;< !*+, HR#P GHR# dKZ EzU+" !*+, GH MZ ?m).
(111) nmlpoqrsj]JvutAUVwxIyz{2.
(112) !" # $% &'!" ()* +,- ./ 0 12 ()* +,3 45 6 7 89: ; <=!" >?: @ A0B
(113) 12 C : D +, &' 7. E`G EiG EG. HIJKLM NOJLPLQ RNSJPTUSVWVXVQPTOX ROWY ZVJ PL[VVJ RV\PXN JV\VS LO]PQOSPVLM JSPZPTPOX ^LSNXXPQNLTN M VX __M V FM WW `FUaFM F__b. VJNLYSNPLM c]NJNSSM OL[ dNLQM O]PQOSPLQ V\PXN
(114) V\VSY eYSNRY OL[ HNTILPKNYM f gNSNJYM S[M F__h jkM lM m no!" mp3 mq rst u vM `wwx (yzmBq{| }m~> M `wwx )jM M oM M no !" A0 j . 3 v u rs M (ypq{| <=M VX FhM V FM WW wUaM `wFw M M U M q{| <=M VX `wM V M WW hiUhbM `wFw KJJOLSUIeSN OL[ H OPXNeM PRKXSOLNVKY XVTOXPOSPVL OL[ ROWWPLQ gOJS ^M ^ccc V\VSPTY OL[ KSVROSPVL OQOPLN M VX FiM WW __UFFwM `wwh wh H OPXNe OL[ KJJOLSUIeSNM PRKXSOLNVKY VTOXPOSPVL OL[ OWWPLQ gOJS ^^M ^ccc V\VSPTY OL[ KSVROSPVL OQOPLN M VX FiM V iM WW FwbUFFaM `wwh g KOLQM ^ VKJPPY OL[ ^
(115) VKRNXPVSPYM \YNJ]O\PXPSeU\OYN[
(116) KXNY ZVJ NYPQLPLQ !VLYPYSNLS cfd cYSPROSVJYM HIN ^LSNJLOSPVLOX VKJLOX VZ V\VSPTY NYNOJTIM VX `_M V xM WW xw`Ux`bM `wFw KXPNJM IXROLLM OL[ d KJJOLSUIeSNM LN RNSIV[ ZVJ SIN LVLXPLNOJ SJOLYZVJROSPVL VZ RNOLY OL[ TV]OJPOLTNY PL ZPXSNJY OL[ NYSPROSVJYM ^ccc HJOLY VL KSVROSPT VLSJVXM VX xM V iM WW aaUb`M `www
(117) OJSPLNU!OLSPL OL[ !OYSNXXOLVYM LYTNLSN[ ZVJ OJQNU TOXN KS[VVJ ^ccc ^LSNJLOSPVLOX cL]PJVLRNLSYM VLZNJNLTN VL ^LSNXXPQNLS V\VSY OL[ eYSNRM WW i`aUii`M `wwx wb g KOLQM ^ VKJPPY OL[ ^
(118) VKRNXPVSPYM L SIN !VRWXNPSe OL[ !VLYPYSNLTe VZ fdU\OYN[ M ^ccc. . . . ExG EhG. . .
(119). EaG.
(120). EbG. E_G.
(121).
(122). !. EFwG. !. EFFG. "
(123) .
(124). ^LSNJLOSPVLOX !VLZNJNLTN VL KSVROSPVLM WW wFUwbM `ww_. !. ^LSNJLOSPVLOX VPLS !VLZNJNLTN VL JSPZPTPOX ^LSNXXPQNLTNM WW FFxFUFFxhM `wwi. ±²³. EFG. ZOTSVJN[ YVXKSPVL SV SIN YPRKXSOLNVKY XVTOXPOSPVL OL[ ROWWPLQ WJV\XNRM# gJVT VZ SIN OSPVLOX VLZNJNLTN VL JSPZPTPOX ^LSNXXPQNLTN M VX FbM WW_iUx_bM `ww` EFiG VLSNRNJXVM HIJKLM fVXXNJM OL[ NQ\JNPSM dOYS `w L ^RWJV]N[ gOJSPTXN dPXSNJPLQ XQVJPSIR ZVJ PRKXSOLNVKY VTOXPOSPVL OL[ OWWPLQ SIOS gJV]O\Xe !VL]NJQNYM.
(125) V\VSPTY. OL[. EF`G VLSNRNJXVM HIJKLM NS OXM dOYS O. EFG VLSNRNJXV OL[ HIJKLM PRKXSOLNVKY VTOXPOSPVL OL[ OWWPLQ PSI LLVL OSO YYVTPOSPVL KYPLQ dOYS M ^ccc ^LSX VLZ VL V\VSPTY OL[ KSVROSPVLM `wwi WW F_bxUF__F EFxG HIJKLM KJQOJ[M OL[ dVM gJV\O\PXPYSPT JV\VSPTYM ^H gJNYYM !OR\JP[QNM `wwx EFhG H H !^M VO[OeY HJNL[Y PL OW NLNJOSPVL ZVJ V\PXN
(126) V\VSYM ^L gJVTNN[PLQ VZ. !.
(127). ^ccc "
(128) PLSNJLOSPVLOX !VLZNJNLTN VL ^LSNXXPQNLS
(129) V\VSY OL[ eYSNRYM WW bbUbiiM. F__h EFaG KXXOLNM VM [ORY OL[ P$NYVROM
(130) OL[VR NS dVJRKXOSPVL ZVJ ^LSNJLOSPVLOX OeNYPOL M ^ccc VLZNJNLTN VL ^LSNXXPQNLS V\VSY OL[ eYSNRYM WW FwiUFw_M `wwb EFbG %&M '(M ) fOKIPSVM
(131) OVU XOTNXXPN[ j mp3 rs u no
(132) *M p <=M VX iM V M WW iwbUiFM `wwb FF EF_G PYYOLOeONM g NROLM g !XOJM d KJJOLSUIeSN OL[ !YVJ\OM YVXKSPVL SV SIN YPRKXSOLNVKY XVTOXPOSPVL OL[ ROW \KPX[PLQ WJV\XNRM ^ccc HJOLY VL V\VSPTY OL[ KSVROSPVLM VX FaM V iM WW ``_U`FM `wwF E`wG :+jM ,-M " j m p rs tM (ypq{| <=M VX FhM V xM WW `wU`aM `wFw E`FG &M :+jM ,-M rs tM ./ 0M m v }* mp3 z5k¡ ~ ' z1¢ <=M VX hM V FM WW ?M. FbUFxhM `wFF E``G &M ,-M :+jM g "£ !¤:9 1 j no!"3 mp rstM `wFF t~ ~> <= M VX `FM V `M WW _UxFM F` `wFF E`iG ,-M :+jM &M M 456 rs t ¤:91 j ¥p3 rstM. z1¢ <=M VX hM V `M WW `bbU`_xM `wFF E`G ) fVM H fPR OL[ VIM VLSN !OJXV VTOXPOSPVL VZ L[NJOSNJ
(133) V\VS YPLQ ^LSNJLOX OL[ cSNJLOX ^LZVJROSPVLM NJ]PTNY. "
(134) .
(135). !. .
(136). . . . 2. . . 3. . !VRWKSPLQ !VLZNJNLTN. g. !!. VL `wFF ^ccc. #.
(137)
(138) .
(139)
(140)
(141)
(142)
(143) . ! "###
(144)
(145) $%
(146)
(147) . & ' () *+ ,-./012 3)4 0567 89:;) .<=>? @ A 4. BCDE FGH I
(148) . I '
(149) / ?J KL MNOLP 0567 Q RST UVEW 3EQ FG $. X # Y Z [ " \
(150)
(151)
(152) $XI. $ ]]] % Y Y %
(153) Y . ]1·¸
(154) 3.
(155) $X LVEW ^_`aEb cE3d
(156) $XI LVEW VEe ^_`a Eb cE3d
(157) $$% LVEW VEe ^_`a Eb cE3d
(158) $$I
(159) $$X m A n .
(160) $$fg UVEW ^_`a67Eb Wj hi Ho67b jk67P Bl:; &% I
(161) X # [YZ Y L1 ¹&3. <*Z´. }~|1µ ¶
(162) 3. I UVEW ^_`aEb cE3d $ UVEW VEe ^_`a Eb cE3d $fg UVEW VEe ^_ `aEb E3 bT hi 0567 jk67 Bl:; &% II&& # Y$
(163)
(164) . !. I UVEW ^_`aEb cE3d
(165) UVEW VEe ^_`a Eb cE3d
(166) fg UVEW VEe T pCDEb 3bT hi 0567 N6`q ! &% II&& # ]Y
(167) .
(168)
관련 문서