確率ロボティクスの導入

Transcript

1. SUGAR SWEET ROBOTICS CO., LTD. ֬཰ϩϘςΟΫεʹΑΔ
   ҠಈϩϘοτͷࣗݾҐஔਪఆ גࣜձࣾ46("3
   48&&5
   30#05*$4
   ૣҴాେֶදݱ޻ֶՊ
   ඌܗݚڀࣨ
   ੁɹ༎थ 1
2. SUGAR SWEET ROBOTICS CO., LTD. ・ h • い s • • すk l • ， ・ • s s ーx y • x y • w t 2
3. SUGAR SWEET ROBOTICS CO., LTD. 3
4. SUGAR SWEET ROBOTICS CO., LTD. ， • ・ • h h • ・ ） し • ・ ， ） • :3 s つ • 4
5. SUGAR SWEET ROBOTICS CO., LTD. 　 h • ・ ） • ・ • c ） y 5
6. 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
7. SUGAR SWEET ROBOTICS CO., LTD. 　 h • x ） tx t • h h 7 ڸ Ϩʔβʔ ൃޫث Ϩʔβʔ डޫث ճస࢛ͯ͠ํʹϨʔβʔ ΛૹΔ डޫ·Ͱͷ࣌ؒ or/and ޫڧ౓Ͱ ڑ཭͕Θ͔Δ ϩϘοτʹ͜ͷΑ͏ͳ ηϯαʔΛ৐ͤΑ͏
8. 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࣠ํ޲͚ͩऔΓग़͢ͱ
9. SUGAR SWEET ROBOTICS CO., LTD. u • t yc x u • sc おこx r c y 9
10. 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Λߋ৽
11. SUGAR SWEET ROBOTICS CO., LTD. ） • ） st．h zc し c ！ s ず 11 Xt-1 X’t Ut ϩϘοτϞσϧ ͷ͔֬Β͠͞Ͱ ༧ଌ͕͹Βͭ͘ Xt-1 X’t Ut Xt Zt ηϯαͷܭଌ݁Ռͷ ͔֬Β͠͞Ͱ ߋ৽ޙͷҐஔ͕͹Βͭ͘
12. 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 ηϯαͷܭଌ݁Ռͷ ͔֬Β͠͞Ͱ ߋ৽ޙͷҐஔ͕͹Βͭ͘
13. SUGAR SWEET ROBOTICS CO., LTD. y • し ． • • • m yn r • h， ・ー • z h， y し ． • ・ー c ・ s st ご 13
14. SUGAR SWEET ROBOTICS CO., LTD. h， • m yn ．h h， X’t ϩϘοτͷӡಈ Ϟσϧʹج͍ͮͯ ύʔςΟΫϧΛ ಈ͔͢ X’t Xt Zt ʮॏΈʯΛ֬཰ͱͯ͠ύʔςΟΫϧΛ બผ͍ͯ͘͠ɽಉ͡ύʔςΟΫϧ͕ෳ਺ճ બ͹ΕΔͷͰ੔߹ੑͷѱ͍ύʔςΟΫϧ͸ ࢮ͵ X’t Xt ఏҊͨ͠ύʔςΟΫϧ͝ͱʹ ؍ଌ݁Ռͱͷ੔߹ੑΛධՁ ֤ͯ͠ύʔςΟΫϧʹ ॏΈΛ෇͚Δ ϦαϯϓϦϯά
15. SUGAR SWEET ROBOTICS CO., LTD. ， ） 5: • ύʔςΟΫϧϑΟϧλΛ࢖ͬͨҐஔਪఆ • ॳظύʔςΟΫϧΛੜ੒͢Δ • ܁Γฦ͢ • ϩϘοτ͕ಈ͘ɽಈ͍ͨ݁ՌΛΦυϝτϦͱͯ͠औಘ • ӡಈࢦྩ΋͘͠͸ΦυϝτϦΛݩʹύʔςΟΫϧ΋ಈ͘ʢఏҊ෼෍ʣɽͦͷࡍʹϊ Πζ΋Ճ͑Δ • ΋͠ҰఆྔҎ্ϩϘοτ͕ಈ͍ͨΒ • ϦαϯϓϦϯά͢Δ • ηϯαೖྗͱϚοϓ৘ใΛϚονϯάͯ͠ɼύʔςΟΫϧʹॏΈΛܭࢉ • ॏΈʹैͬͯύʔςΟΫϧΛબ୒ʢॏΈ͕େ͖͍ύʔςΟΫϧ͕ෳ਺ճ બ୒͞ΕΔɽॏΈ͕খ͍͞ύʔςΟΫϧ͸ফ͑Δʣ • ύʔςΟΫϧͷҐஔ࢟੎ͷฏۉ஋ΛࣗݾҐஔͱͯ͠ਪఆɽύʔςΟΫϧ ͷ͹Β͖ͭʹҐஔͷ֬৴౓ 15
16. 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
17. SUGAR SWEET ROBOTICS CO., LTD. ・ • , + ： ・ー ． ご s x • ・ ） [ Z c ） B Z B Z ( た • h， c w • h， 17 X’t ϩϘοτͷӡಈ Ϟσϧʹج͍ͮͯ ύʔςΟΫϧΛ ಈ͔͢
18. SUGAR SWEET ROBOTICS CO., LTD. , + ： ・ー ． • , . t っ c x • そ • • • し ， , -x ー • )a+ い • ,a. い • /a( い c ） ^ c u さ • g ． ！ ・ ３ y s ！ x X Z(x d x yz d x = sgg 18
19. SUGAR SWEET ROBOTICS CO., LTD. , * ． • し ， , * • た[ ] • x 」 • u c Z • s ’ 19
20. SUGAR SWEET ROBOTICS CO., LTD. ・ • h， た 　 s • h ． • :PRLSPO K MPLSK 20 X’t Xt Zt ఏҊͨ͠ύʔςΟΫϧ͝ͱʹ ؍ଌ݁Ռͱͷ੔߹ੑΛධՁ ֤ͯ͠ύʔςΟΫϧʹ ॏΈΛ෇͚Δ
21. SUGAR SWEET ROBOTICS CO., LTD. fb • • ー ： • D , ( * t w • • , • ( • 21
22. SUGAR SWEET ROBOTICS CO., LTD. - * h ． • ー ： h h ３ c ー ： COPZ ， • COPZ C 22
23. SUGAR SWEET ROBOTICS CO., LTD. ໬౓ܭࢉ • ֬཰ϩϘςΟΫεࣜɿεΩϟϯ̍ຊͷ໬౓ ʹҎԼͷ̐ͭͷ࿨
    • ;IJU
    ϨΠΩϟεςΟϯά݁Ռͱͷর߹
    • ;TIPSU
    ෆ֬ఆͳΦϒδΣΫτͳͲɼϨΠΩϟ εςΟϯά݁ՌΑΓ΋୹͘ͳΔ໬౓
    • ;NBY
    ࠷େܭଌڑ཭ͱͳͬͨ৔߹ͷ໬౓
    • ;SBOE
    ෆ֬ఆཁૉͷ໬౓
    • ;ͷ࿨͕ʹͳΔΑ͏ʹ͢Δ͜ͱ 23
24. SUGAR SWEET ROBOTICS CO., LTD. h， • h， ） w c ， さ h h FR Z • FR Z - () • h h x h， 24
25. 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
26. SUGAR SWEET ROBOTICS CO., LTD. - + • ー ： た た d ） ー ：xr wc z ー ：xr • ー ：w ー ： t 26 26
27. 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
28. SUGAR SWEET ROBOTICS CO., LTD. • - *+ s d「 く y • ー ： • く • • h h x h， / い 28
29. SUGAR SWEET ROBOTICS CO., LTD. • ー ： • OPZ • P T OPZ i x ys x s z • • X UK • y w • T ^ • C ( t 29
30. SUGAR SWEET ROBOTICS CO., LTD. ϩϘοτͷ஌֮Ϟσϧ • ϏʔϜϞσϧ
    • ܭࢉෛՙ͕େ͖͍ʢ࠷ॳʹ֤άϦου͝ͱʹશͯͷϨΠΩϟεςΟϯά݁ ՌΛอଘ͓͚ͯ͠͹ྑ͍͕ߴෛՙɼߴϝϞϦෛՙʣ
    • ϨΠΩϟεςΟϯά݁Ռͷ໬౓͕ෆ࿈ଓ͗͢Δɽྡ઀ͨ͠ύʔςΟΫϧͰ ΋ධՁ͕શ͘ҟͳΔՄೳੑ
    • ա৴͕ى͜ΔՄೳੑ͕͋ΔʢϨʔβʔΛඈͼඈͼʹධՁͨ͠΄͏͕͍͍ʣ
    • ਓؒͳͲͷෆ֬ఆͳো֐෺΁ͷରॲ͕ఏҊ͞Ε͍ͯΔ
    
    
    • ໬౓৔Ϟσϧ
    • ࠷ॳʹҰؾʹ໬౓৔Λܭࢉ͓͚ͯ͠Δ
    • Ϩʔβʔ͕ώοτͨ͜͠ͱ͸ར༻Ͱ͖Δ͕ɼϨʔβʔ͕ώοτ͍ͯ͠ͳ ͍ɼͱ͍͏৘ใ͸ར༻͍ͯ͠ͳ͍
    • ϨΠΩϟεςΟϯάͰ͸ɼϨʔβʔ͕ώοτ͢Δͱःณ෺͕ͳ͍ࣄ͕ Θ͔Δ͕ɼ໬౓৔ͩͱԾʹϚοϓ্ʹน͕͋Γɼܭࢉͨ͠άϦου͕ นΛӽ͑ͯώοτ͍ͯͯ͠΋໬౓Λܭࢉͯ͠͠·͏ɽ 30
31. SUGAR SWEET ROBOTICS CO., LTD. ー ー • h， ２ 31 ʮॏΈʯΛ֬཰ͱͯ͠ύʔςΟΫϧΛ બผ͍ͯ͘͠ɽಉ͡ύʔςΟΫϧ͕ෳ਺ճ બ͹ΕΔͷͰ੔߹ੑͷѱ͍ύʔςΟΫϧ͸ ࢮ͵ X’t
32. SUGAR SWEET ROBOTICS CO., LTD. 5: • し ， / ) • *a. い c h， • ・ + い • ・ , い • h， ~ ） ^ ] • /a(( いxー ー • ] h， 0 い • s h， u ( い 32
33. 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)ͷϥϯμϜͳ࣮਺Λ͔͚ͨ஋Λ ᮢ஋ͱ͢Δ ύʔςΟΫϧͷॏΈΛॱ൪ʹ଍͠߹Θͤͯɼ ᮢ஋Λ௒͑ͨ࣌ͷύʔςΟΫϧΛબ୒͢Δ ॏΈ͕େ͖͍ύʔςΟΫϧ΄Ͳબ୒͞ΕΔ֬཰͕ߴ͍
34. 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.
35. 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
36. SUGAR SWEET ROBOTICS CO., LTD. :3 • :3 PT[SZ UL [ : SP ZP U UK PU • x ） 36
37. SUGAR SWEET ROBOTICS CO., LTD. :3 ち • :3 • sz • ぞ • :3 • x せ w • 37
38. SUGAR SWEET ROBOTICS CO., LTD. :3 • ・ ） x r c h hxr s s • h h w ・ ） z s • r Z Zj h hxr s ３ x c ・ ） s • h h s eee • eee w eee 38
39. SUGAR SWEET ROBOTICS CO., LTD. 　 • x ．h l c z s w • ・ ） x sz • 85= :3 39
40. 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
41. SUGAR SWEET ROBOTICS CO., LTD. • ・ h x い s • し sx • y • ， ） • :3 • c s 41