Upgrade to Pro — share decks privately, control downloads, hide ads and more …

確率ロボティクスの導入

ysuga
May 22, 2019

 確率ロボティクスの導入

ysuga

May 22, 2019
Tweet

More Decks by ysuga

Other Decks in Education

Transcript

  1. SUGAR SWEET ROBOTICS CO., LTD. ・ h • い s

    • • すk l • , ・ • s s ーx y • x y • w t 2
  2. SUGAR SWEET ROBOTICS CO., LTD. , • ・ • h

    h • ・ ) し • ・ , ) • :3 s つ • 4
  3. SUGAR SWEET ROBOTICS CO., LTD. だ ・ • p …

    …: c ・ h K w Z ) 6 • )K 12 だ • 12 だ • …: … 12 だ • だ 1 …: … • 6 12 • … 12 D θ d d RθR RθL Φθ • … 2 … …: )K • 6… 2 … …: ) • う xc ・ ) • x • • w w
  4. SUGAR SWEET ROBOTICS CO., LTD.   h • x )

    tx t • h h 7 ڸ Ϩʔβʔ ൃޫث Ϩʔβʔ डޫث ճస࢛ͯ͠ํʹϨʔβʔ ΛૹΔ डޫ·Ͱͷ࣌ؒ or/and ޫڧ౓Ͱ ڑ཭͕Θ͔Δ ϩϘοτʹ͜ͷΑ͏ͳ ηϯαʔΛ৐ͤΑ͏
  5. SUGAR SWEET ROBOTICS CO., LTD. ・ ) しつ • c

    h h s • t wo し • r ^ _ o ・x ^ _ ) c s k ・ー l • x yso x s • x so x s • r ^ _ x s 8 Xt-1 X’t Ut ϩϘοτϞσϧ ͷ͔֬Β͠͞Ͱ ༧ଌ͕͹Βͭ͘ x’t σ σ ࣮ࡍ͸࢟੎֯౓θ΋͋Δ x࣠ํ޲͚ͩऔΓग़͢ͱ
  6. SUGAR SWEET ROBOTICS CO., LTD. ) • たAZ c )

    ^Z (w c^jZ c た ^Z 10 Xt-1 X’t Ut ϩϘοτϞσϧ ʹΑΔܭࢉͰ༧ଌ Xt-1 X’t Ut Xt Zt ܭଌ݁ՌͱX’t͔Β ࣗݾҐஔXtΛߋ৽
  7. SUGAR SWEET ROBOTICS CO., LTD. ) • ) st.h zc

    し c ! s ず 11 Xt-1 X’t Ut ϩϘοτϞσϧ ͷ͔֬Β͠͞Ͱ ༧ଌ͕͹Βͭ͘ Xt-1 X’t Ut Xt Zt ηϯαͷܭଌ݁Ռͷ ͔֬Β͠͞Ͱ ߋ৽ޙͷҐஔ͕͹Βͭ͘
  8. SUGAR SWEET ROBOTICS CO., LTD. ) • ・ . c

    → ! っ x s じ r w c ! ぐu w s → x 12 Xt-1 X’t Ut ϩϘοτϞσϧ ͷ͔֬Β͠͞Ͱ ༧ଌ͕͹Βͭ͘ Xt-1 X’t Ut Xt Zt ηϯαͷܭଌ݁Ռͷ ͔֬Β͠͞Ͱ ߋ৽ޙͷҐஔ͕͹Βͭ͘
  9. SUGAR SWEET ROBOTICS CO., LTD. y • し . •

    • • m yn r • h, ・ー • z h, y し . • ・ー c ・ s st ご 13
  10. SUGAR SWEET ROBOTICS CO., LTD. h, • m yn .h

    h, X’t ϩϘοτͷӡಈ Ϟσϧʹج͍ͮͯ ύʔςΟΫϧΛ ಈ͔͢ X’t Xt Zt ʮॏΈʯΛ֬཰ͱͯ͠ύʔςΟΫϧΛ બผ͍ͯ͘͠ɽಉ͡ύʔςΟΫϧ͕ෳ਺ճ બ͹ΕΔͷͰ੔߹ੑͷѱ͍ύʔςΟΫϧ͸ ࢮ͵ X’t Xt ఏҊͨ͠ύʔςΟΫϧ͝ͱʹ ؍ଌ݁Ռͱͷ੔߹ੑΛධՁ ֤ͯ͠ύʔςΟΫϧʹ ॏΈΛ෇͚Δ ϦαϯϓϦϯά
  11. SUGAR SWEET ROBOTICS CO., LTD. , ) 5: • ύʔςΟΫϧϑΟϧλΛ࢖ͬͨҐஔਪఆ

    • ॳظύʔςΟΫϧΛੜ੒͢Δ • ܁Γฦ͢ • ϩϘοτ͕ಈ͘ɽಈ͍ͨ݁ՌΛΦυϝτϦͱͯ͠औಘ • ӡಈࢦྩ΋͘͠͸ΦυϝτϦΛݩʹύʔςΟΫϧ΋ಈ͘ʢఏҊ෼෍ʣɽͦͷࡍʹϊ Πζ΋Ճ͑Δ • ΋͠ҰఆྔҎ্ϩϘοτ͕ಈ͍ͨΒ • ϦαϯϓϦϯά͢Δ • ηϯαೖྗͱϚοϓ৘ใΛϚονϯάͯ͠ɼύʔςΟΫϧʹॏΈΛܭࢉ • ॏΈʹैͬͯύʔςΟΫϧΛબ୒ʢॏΈ͕େ͖͍ύʔςΟΫϧ͕ෳ਺ճ બ୒͞ΕΔɽॏΈ͕খ͍͞ύʔςΟΫϧ͸ফ͑Δʣ • ύʔςΟΫϧͷҐஔ࢟੎ͷฏۉ஋ΛࣗݾҐஔͱͯ͠ਪఆɽύʔςΟΫϧ ͷ͹Β͖ͭʹҐஔͷ֬৴౓ 15
  12. SUGAR SWEET ROBOTICS CO., LTD. w • し , s

    r x • け s • OZZ 1 I R T_U P L X K[ Z KLZ PS PK2*.**. 16
  13. SUGAR SWEET ROBOTICS CO., LTD. ・ • , + :

    ・ー . ご s x • ・ ) [ Z c ) B Z B Z ( た • h, c w • h, 17 X’t ϩϘοτͷӡಈ Ϟσϧʹج͍ͮͯ ύʔςΟΫϧΛ ಈ͔͢
  14. SUGAR SWEET ROBOTICS CO., LTD. , + : ・ー .

    • , . t っ c x • そ • • • し , , -x ー • )a+ い • ,a. い • /a( い c ) ^ c u さ • g . ! ・ 3 y s ! x X Z(x d x yz d x = sgg 18
  15. SUGAR SWEET ROBOTICS CO., LTD. , * . • し

    , , * • た[ ] • x 」 • u c Z • s ’ 19
  16. SUGAR SWEET ROBOTICS CO., LTD. ・ • h, た  

    s • h . • :PRLSPO K MPLSK 20 X’t Xt Zt ఏҊͨ͠ύʔςΟΫϧ͝ͱʹ ؍ଌ݁Ռͱͷ੔߹ੑΛධՁ ֤ͯ͠ύʔςΟΫϧʹ ॏΈΛ෇͚Δ
  17. SUGAR SWEET ROBOTICS CO., LTD. fb • • ー :

    • D , ( * t w • • , • ( • 21
  18. SUGAR SWEET ROBOTICS CO., LTD. - * h . •

    ー : h h 3 c ー : COPZ , • COPZ C 22
  19. SUGAR SWEET ROBOTICS CO., LTD. ໬౓ܭࢉ • ֬཰ϩϘςΟΫεࣜɿεΩϟϯ̍ຊͷ໬౓ ʹҎԼͷ̐ͭͷ࿨ •

    ;IJUϨΠΩϟεςΟϯά݁Ռͱͷর߹ • ;TIPSUෆ֬ఆͳΦϒδΣΫτͳͲɼϨΠΩϟ εςΟϯά݁ՌΑΓ΋୹͘ͳΔ໬౓ • ;NBY࠷େܭଌڑ཭ͱͳͬͨ৔߹ͷ໬౓ • ;SBOEෆ֬ఆཁૉͷ໬౓ • ;ͷ࿨͕ʹͳΔΑ͏ʹ͢Δ͜ͱ 23
  20. SUGAR SWEET ROBOTICS CO., LTD. h, • h, ) w

    c , さ h h FR Z • FR Z - () • h h x h, 24
  21. SUGAR SWEET ROBOTICS CO., LTD. - * ( . •

    h hx t • OPZ i d yz d 0, wd • P T OPZ i d h h s t xssd • き d • X UK i xr yz s • h hx s d • T ^ i yい sxc x • x s s c h hx ( しxr • O XZ i z yz d • S TIK O XZ i しd ys s w x w z 25
  22. SUGAR SWEET ROBOTICS CO., LTD. - + • ー :

    た た d ) ー :xr wc z ー :xr • ー :w ー : t 26 26
  23. SUGAR SWEET ROBOTICS CO., LTD. - + • ー :w

    ー : vz 27 1 1 1 3 2 2 2 1 3 2 1 1 1 1 2 3 3 2 2 4 4 4 3 1 3 2 2 3 1 3 2 1 4 6 5 5 5 4 6 5 4
  24. SUGAR SWEET ROBOTICS CO., LTD. • - *+ s d「

    く y • ー : • く • • h h x h, / い 28
  25. SUGAR SWEET ROBOTICS CO., LTD. • ー : • OPZ

    • P T OPZ i x ys x s z • • X UK • y w • T ^ • C ( t 29
  26. SUGAR SWEET ROBOTICS CO., LTD. ϩϘοτͷ஌֮Ϟσϧ • ϏʔϜϞσϧ • ܭࢉෛՙ͕େ͖͍ʢ࠷ॳʹ֤άϦου͝ͱʹશͯͷϨΠΩϟεςΟϯά݁

    ՌΛอଘ͓͚ͯ͠͹ྑ͍͕ߴෛՙɼߴϝϞϦෛՙʣ • ϨΠΩϟεςΟϯά݁Ռͷ໬౓͕ෆ࿈ଓ͗͢Δɽྡ઀ͨ͠ύʔςΟΫϧͰ ΋ධՁ͕શ͘ҟͳΔՄೳੑ • ա৴͕ى͜ΔՄೳੑ͕͋ΔʢϨʔβʔΛඈͼඈͼʹධՁͨ͠΄͏͕͍͍ʣ • ਓؒͳͲͷෆ֬ఆͳো֐෺΁ͷରॲ͕ఏҊ͞Ε͍ͯΔ   • ໬౓৔Ϟσϧ • ࠷ॳʹҰؾʹ໬౓৔Λܭࢉ͓͚ͯ͠Δ • Ϩʔβʔ͕ώοτͨ͜͠ͱ͸ར༻Ͱ͖Δ͕ɼϨʔβʔ͕ώοτ͍ͯ͠ͳ ͍ɼͱ͍͏৘ใ͸ར༻͍ͯ͠ͳ͍ • ϨΠΩϟεςΟϯάͰ͸ɼϨʔβʔ͕ώοτ͢Δͱःณ෺͕ͳ͍ࣄ͕ Θ͔Δ͕ɼ໬౓৔ͩͱԾʹϚοϓ্ʹน͕͋Γɼܭࢉͨ͠άϦου͕ นΛӽ͑ͯώοτ͍ͯͯ͠΋໬౓Λܭࢉͯ͠͠·͏ɽ 30
  27. SUGAR SWEET ROBOTICS CO., LTD. ー ー • h, 2

    31 ʮॏΈʯΛ֬཰ͱͯ͠ύʔςΟΫϧΛ બผ͍ͯ͘͠ɽಉ͡ύʔςΟΫϧ͕ෳ਺ճ બ͹ΕΔͷͰ੔߹ੑͷѱ͍ύʔςΟΫϧ͸ ࢮ͵ X’t
  28. SUGAR SWEET ROBOTICS CO., LTD. 5: • し , /

    ) • *a. い c h, • ・ + い • ・ , い • h, ~ ) ^ ] • /a(( いxー ー • ] h, 0 い • s h, u ( い 32
  29. SUGAR SWEET ROBOTICS CO., LTD. h, • u eee h

    ・ 33 w_sum = 0 for p in particles: w_sum += p.w threshold = w_sum * random() w_sum = 0 for i in range(particle_num): w_sum += p.w if w_sum > threshold: return p ·ͣɼύʔςΟΫϧͷॏΈͷ૯࿨Λग़͢ ૯࿨ʹ(0,1)ͷϥϯμϜͳ࣮਺Λ͔͚ͨ஋Λ ᮢ஋ͱ͢Δ ύʔςΟΫϧͷॏΈΛॱ൪ʹ଍͠߹Θͤͯɼ ᮢ஋Λ௒͑ͨ࣌ͷύʔςΟΫϧΛબ୒͢Δ ॏΈ͕େ͖͍ύʔςΟΫϧ΄Ͳબ୒͞ΕΔ֬཰͕ߴ͍
  30. SUGAR SWEET ROBOTICS CO., LTD. ੜଘ͢ΔύʔςΟΫϧͷબ୒ • ϧʔϨοτબ୒ • ύʔςΟΫϧͷॏ

    Έʹൺྫͨ֯͠౓ ΛׂΓ౰ͯͯϧʔ ϨοτΛճ͢ • ྑ͍ύʔςΟΫϧ ͕উͪ͗͢ΔͷΛ ๷͙ํ๏͕͍ͭ͘ ͔ݕ౼͞Ε͍ͯΔ 34 Douc, R. and Cappe, O. and Moulines, E., “Comparison of Resampling Schemes for Particle Filtering”, Image and Signal Processing and Analysis, 2005.
  31. SUGAR SWEET ROBOTICS CO., LTD. 5: う • h, 5=A

    た / ) * • r w   k l • た ご k ー l • ) k l • h, u 9:6 ー • kが lw x s / (* • h, • xあs u s 5: • P^Z[XL 5: 35
  32. SUGAR SWEET ROBOTICS CO., LTD. :3 • :3 PT[SZ UL

    [ : SP ZP U UK PU • x ) 36
  33. SUGAR SWEET ROBOTICS CO., LTD. :3 ち • :3 •

    sz • ぞ • :3 • x せ w • 37
  34. SUGAR SWEET ROBOTICS CO., LTD. :3 • ・ ) x

    r c h hxr s s • h h w ・ ) z s • r Z Zj h hxr s 3 x c ・ ) s • h h s eee • eee w eee 38
  35. SUGAR SWEET ROBOTICS CO., LTD.   • x .h l

    c z s w • ・ ) x sz • 85= :3 39
  36. SUGAR SWEET ROBOTICS CO., LTD. • • し , 1

    OX[U 4[X XK 7 ^ • :3 1 え か • h h ・ • U P ZP U Z R X X • = 1 IPSL I Z =X X TTPU SRPZ TX Z X 40
  37. SUGAR SWEET ROBOTICS CO., LTD. • ・ h x い

    s • し sx • y • , ) • :3 • c s 41