実践カルマンフィルタ

Transcript

1. . , .,. . A A M A I K
2. . , .,. . 2 n n     n    n  
    ! n n       
   
3. 2 4 , .12 2 ,3 2 4 3 C
    C L M
4. . , .,. .    4
   
5. 1(. . ) 1 1,. 1 5 n L C c C CTb n M c d C n 3 . ( n 2 2 3 , ,)  
   #*. (&), etc.) !'$ (-  ,+) % (-  ,+) % !'     ,+ - , "( (1) (2) (3)
6. . , .,. . 6 n n C n M L n n n 1 n 
   
7. . , .,. .      7
   
8. . , .,. . 8     
     (Propagate) step  (Update) step 
   [2] p.36 
9. . , .,. . 9 1 t-1 
     t 
     ) (  [2] p.38 
10. . , .,. . 10 ( ( ) ) 1  %! ( t %! )  %! - " 2 %!  
    ! ! #  - !     [2] p.38 $
11. , 3 11 n xgc e o c eF n M A d] L E n A l tULc e nmr M y n eb a[e 3 3 ) ( MC n 3 ) ( . / s n FA eb a[e Fh T KC i 
    
12. . , .,. .  12    
      (Propagate) step  (Update) step  
    [2] p.51 
13. . , .,. .   13
    
14. . , .,. . 14 n n . / ) ) / / n K ) . n C n L n / ( n :R D / / [4] A
15. / 2 2 ) 15 n ( I , . U C PSM TL K n TL , . UL l gbosGC U e I i d G hC n K cC K   
       : :  :
16. . , .,. . 16 n L bC C ce M n 2. -0 M 9 n d T n I   
      :   :    : 1 U 9
17. . , .,. . 17 n M n   
       n L M C  
       :
18. . , .,. . 18 
    © OpenStreetMap contributors
19. . , .,. . "( '$%  , #"(  
    19 "(   1+)&*! 
    
20. . , .,. . n M C L 20   100^2 
    
21. . , .,. . 21 n L C   0.01^2 
    
22. . , .,. .  22
    
23. , / / . 23 n Tc d c K P y t P n Py n G US P n o gI P h P d L e P y ib c y P P n Tc d c I l n MC n c c m l k _ : n ie g :bh n : c : n bh c a m p f o n s C n / / / ./ ) . ( 
    
24. SGNPNW HMRSPSLN V 2S :WI 24 D E ? 6U FP FRI 0 0RIU V 0TTPNHFWNSRV SK 9FP FR NPW UNRL NR 0 USVTFH - WS WM U V RW D7NVWSUNHFP UVT HWN VE 8444 2SRWUSP ? VW V FLF]NR ( ( . - , D E ? M UR C 1 ULFUI FRI 3 S[ USGFGNPNVWNH SGNWNHV MWWTV. ISHV KTU GU IFRN PVFRWSV USGFGNPNVWNH SGSWNHV TIK d)b,cae D(E 4 0 CFR FRI BFR 3 U U M ARVH RW I 9FP FR NPW U KSU SRPNR FU 4VWN FWNSR 8R USH SK 8444 0IFTWN ? VW V KSU ?NLRFP USH VVNRL 2S RNHFWNSRV FRI 2SRWUSP ? TSVN D)E 0 6 NL U : R] FRI AUWFV R 0U C FI KSU 0 WSRS S V 3UN NRL/ M 98 8 BNVNSR 1 RHM FU ? NW 8R USH SK 8444 2SRK U RH SR 2S T W U BNVNSR FRI FWW UR HSLRNWNSR 
    
25. L C M . , .,. . 25