maddentut.ps

用matlab实现kalman滤波器condensation滤波器跟踪自由落体的小球

%!PS-Adobe-2.0
%%Creator: dvips 5.479 Copyright 1986-92 Radical Eye Software
%%Title: kalman.dvi
%%Pages: 28 1
%%BoundingBox: 0 0 612 792
%%EndComments
%DVIPSCommandLine: dvips kalman
%%BeginProcSet: tex.pro
/TeXDict 250 dict def TeXDict begin /N{def}def /B{bind def}N /S{exch}N /X{S N}
B /TR{translate}N /isls false N /vsize 11 72 mul N /@rigin{isls{[0 -1 1 0 0 0]
concat}if 72 Resolution div 72 VResolution div neg scale isls{Resolution hsize
-72 div mul 0 TR}if Resolution VResolution vsize -72 div 1 add mul TR matrix
currentmatrix dup dup 4 get round 4 exch put dup dup 5 get round 5 exch put
setmatrix}N /@landscape{/isls true N}B /@manualfeed{statusdict /manualfeed
true put}B /@copies{/#copies X}B /FMat[1 0 0 -1 0 0]N /FBB[0 0 0 0]N /nn 0 N
/IE 0 N /ctr 0 N /df-tail{/nn 8 dict N nn begin /FontType 3 N /FontMatrix
fntrx N /FontBBox FBB N string /base X array /BitMaps X /BuildChar{
CharBuilder}N /Encoding IE N end dup{/foo setfont}2 array copy cvx N load 0 nn
put /ctr 0 N[}B /df{/sf 1 N /fntrx FMat N df-tail}B /dfs{div /sf X /fntrx[sf 0
0 sf neg 0 0]N df-tail}B /E{pop nn dup definefont setfont}B /ch-width{ch-data
dup length 5 sub get}B /ch-height{ch-data dup length 4 sub get}B /ch-xoff{128
ch-data dup length 3 sub get sub}B /ch-yoff{ch-data dup length 2 sub get 127
sub}B /ch-dx{ch-data dup length 1 sub get}B /ch-image{ch-data dup type
/stringtype ne{ctr get /ctr ctr 1 add N}if}B /id 0 N /rw 0 N /rc 0 N /gp 0 N
/cp 0 N /G 0 N /sf 0 N /CharBuilder{save 3 1 roll S dup /base get 2 index get
S /BitMaps get S get /ch-data X pop /ctr 0 N ch-dx 0 ch-xoff ch-yoff ch-height
sub ch-xoff ch-width add ch-yoff setcachedevice ch-width ch-height true[1 0 0
-1 -.1 ch-xoff sub ch-yoff .1 add]{ch-image}imagemask restore}B /D{/cc X dup
type /stringtype ne{]}if nn /base get cc ctr put nn /BitMaps get S ctr S sf 1
ne{dup dup length 1 sub dup 2 index S get sf div put}if put /ctr ctr 1 add N}
B /I{cc 1 add D}B /bop{userdict /bop-hook known{bop-hook}if /SI save N @rigin
0 0 moveto}N /eop{SI restore showpage userdict /eop-hook known{eop-hook}if}N
/@start{userdict /start-hook known{start-hook}if /VResolution X /Resolution X
1000 div /DVImag X /IE 256 array N 0 1 255{IE S 1 string dup 0 3 index put cvn
put}for 65781.76 div /vsize X 65781.76 div /hsize X}N /p{show}N /RMat[1 0 0 -1
0 0]N /BDot 260 string N /rulex 0 N /ruley 0 N /v{/ruley X /rulex X V}B /V
statusdict begin /product where{pop product dup length 7 ge{0 7 getinterval
(Display)eq}{pop false}ifelse}{false}ifelse end{{gsave TR -.1 -.1 TR 1 1 scale
rulex ruley false RMat{BDot}imagemask grestore}}{{gsave TR -.1 -.1 TR rulex
ruley scale 1 1 false RMat{BDot}imagemask grestore}}ifelse B /a{moveto}B
/delta 0 N /tail{dup /delta X 0 rmoveto}B /M{S p delta add tail}B /b{S p tail}
B /c{-4 M}B /d{-3 M}B /e{-2 M}B /f{-1 M}B /g{0 M}B /h{1 M}B /i{2 M}B /j{3 M}B
/k{4 M}B /w{0 rmoveto}B /l{p -4 w}B /m{p -3 w}B /n{p -2 w}B /o{p -1 w}B /q{p 1
w}B /r{p 2 w}B /s{p 3 w}B /t{p 4 w}B /x{0 S rmoveto}B /y{3 2 roll p a}B /bos{
/SS save N}B /eos{SS restore}B end
%%EndProcSet
%%BeginProcSet: special.pro
TeXDict begin /SDict 200 dict N SDict begin /@SpecialDefaults{/hs 612 N /vs
792 N /ho 0 N /vo 0 N /hsc 1 N /vsc 1 N /ang 0 N /CLIP 0 N /rwiSeen false N
/rhiSeen false N /letter{}N /note{}N /a4{}N /legal{}N}B /@scaleunit 100 N
/@hscale{@scaleunit div /hsc X}B /@vscale{@scaleunit div /vsc X}B /@hsize{/hs
X /CLIP 1 N}B /@vsize{/vs X /CLIP 1 N}B /@clip{/CLIP 2 N}B /@hoffset{/ho X}B
/@voffset{/vo X}B /@angle{/ang X}B /@rwi{10 div /rwi X /rwiSeen true N}B /@rhi
{10 div /rhi X /rhiSeen true N}B /@llx{/llx X}B /@lly{/lly X}B /@urx{/urx X}B
/@ury{/ury X}B /magscale true def end /@MacSetUp{userdict /md known{userdict
/md get type /dicttype eq{userdict begin md length 10 add md maxlength ge{/md
md dup length 20 add dict copy def}if end md begin /letter{}N /note{}N /legal{
}N /od{txpose 1 0 mtx defaultmatrix dtransform S atan/pa X newpath clippath
mark{transform{itransform moveto}}{transform{itransform lineto}}{6 -2 roll
transform 6 -2 roll transform 6 -2 roll transform{itransform 6 2 roll
itransform 6 2 roll itransform 6 2 roll curveto}}{{closepath}}pathforall
newpath counttomark array astore /gc xdf pop ct 39 0 put 10 fz 0 fs 2
F/|______Courier fnt invertflag{PaintBlack}if}N /txpose{pxs pys scale ppr
aload pop por{noflips{pop S neg S TR pop 1 -1 scale}if xflip yflip and{pop S
neg S TR 180 rotate 1 -1 scale ppr 3 get ppr 1 get neg sub neg ppr 2 get ppr 0
get neg sub neg TR}if xflip yflip not and{pop S neg S TR pop 180 rotate ppr 3
get ppr 1 get neg sub neg 0 TR}if yflip xflip not and{ppr 1 get neg ppr 0 get
neg TR}if}{noflips{TR pop pop 270 rotate 1 -1 scale}if xflip yflip and{TR pop
pop 90 rotate 1 -1 scale ppr 3 get ppr 1 get neg sub neg ppr 2 get ppr 0 get
neg sub neg TR}if xflip yflip not and{TR pop pop 90 rotate ppr 3 get ppr 1 get
neg sub neg 0 TR}if yflip xflip not and{TR pop pop 270 rotate ppr 2 get ppr 0
get neg sub neg 0 S TR}if}ifelse scaleby96{ppr aload pop 4 -1 roll add 2 div 3
1 roll add 2 div 2 copy TR .96 dup scale neg S neg S TR}if}N /cp{pop pop
showpage pm restore}N end}if}if}N /normalscale{Resolution 72 div VResolution
72 div neg scale magscale{DVImag dup scale}if 0 setgray}N /psfts{S 65781.76
div N}N /startTexFig{/psf$SavedState save N userdict maxlength dict begin
/magscale false def normalscale currentpoint TR /psf$ury psfts /psf$urx psfts
/psf$lly psfts /psf$llx psfts /psf$y psfts /psf$x psfts currentpoint /psf$cy X
/psf$cx X /psf$sx psf$x psf$urx psf$llx sub div N /psf$sy psf$y psf$ury
psf$lly sub div N psf$sx psf$sy scale psf$cx psf$sx div psf$llx sub psf$cy
psf$sy div psf$ury sub TR /showpage{}N /erasepage{}N /copypage{}N /p 3 def
@MacSetUp}N /doclip{psf$llx psf$lly psf$urx psf$ury currentpoint 6 2 roll
newpath 4 copy 4 2 roll moveto 6 -1 roll S lineto S lineto S lineto closepath
clip newpath moveto}N /endTexFig{end psf$SavedState restore}N /@beginspecial{
SDict begin /SpecialSave save N gsave normalscale currentpoint TR
@SpecialDefaults count /ocount X /dcount countdictstack N}N /@setspecial{CLIP
1 eq{newpath 0 0 moveto hs 0 rlineto 0 vs rlineto hs neg 0 rlineto closepath
clip}if ho vo TR hsc vsc scale ang rotate rwiSeen{rwi urx llx sub div rhiSeen{
rhi ury lly sub div}{dup}ifelse scale llx neg lly neg TR}{rhiSeen{rhi ury lly
sub div dup scale llx neg lly neg TR}if}ifelse CLIP 2 eq{newpath llx lly
moveto urx lly lineto urx ury lineto llx ury lineto closepath clip}if
/showpage{}N /erasepage{}N /copypage{}N newpath}N /@endspecial{count ocount
sub{pop}repeat countdictstack dcount sub{end}repeat grestore SpecialSave
restore end}N /@defspecial{SDict begin}N /@fedspecial{end}B /li{lineto}B /rl{
rlineto}B /rc{rcurveto}B /np{/SaveX currentpoint /SaveY X N 1 setlinecap
newpath}N /st{stroke SaveX SaveY moveto}N /fil{fill SaveX SaveY moveto}N
/ellipse{/endangle X /startangle X /yrad X /xrad X /savematrix matrix
currentmatrix N TR xrad yrad scale 0 0 1 startangle endangle arc savematrix
setmatrix}N end
%%EndProcSet
TeXDict begin 40258431 52099146 1000 300 300 @start /Fa 56
123 df<3801807C0380FE0380FE0700EE0700EE0E00EE0E00EE0E00FE1C00FE1C007C38003838
0000700000700000700000E00000E00001C00001C00001C0000380000383800707C0070FE00E0E
E00E0EE00E0EE01C0EE01C0EE0380FE03807C018038013207F9C16>37 D<183C3E1E0E0E0E1E1C
3C78F060070D799816>39 D<00E001E007C007000F001E003C0038007800700070007000F000E0
00E000E000E000E000E000E000F000700070007000780038003C001E000F00070007C001E000E0
0B217A9C16>I<E000F0007C001C001E000F000780038003C001C001C001C001E000E000E000E0
00E000E000E000E001E001C001C001C003C0038007800F001E001C007C00F000E0000B217C9C16
>I<01C00001C00001C00001C00071C700F9CF807FFF001FFC0007F00007F0001FFC007FFF00F9
CF8071C70001C00001C00001C00001C00011127E9516>I<01C00001C00001C00001C00001C000
01C00001C00001C000FFFF80FFFF80FFFF8001C00001C00001C00001C00001C00001C00001C000
01C00011137E9516>I<387C7E7E3E0E1E3C7CF860070B798416>I<FFFF80FFFF80FFFF8011037E
8D16>I<70F8F8F8700505788416>I<000180000380000380000700000700000E00000E00001C00
001C0000380000380000700000700000E00000E00001C00001C000038000038000070000070000
0E00000E00001C00001C0000380000380000700000700000E00000E00000C0000011207E9C16>
I<03E0000FF8001FFC001E3C00380E00780F00700700700700E00380E00380E00380E00380E003
80E00380E00380E00380F00780700700700700780F003C1E001E3C001FFC000FF80003E0001119
7E9816>I<01800380038007800F807F80FF807380038003800380038003800380038003800380
038003800380038003807FF87FFC7FF80E197C9816>I<07E0001FF8007FFE00783F00F00F00F0
0780F00380F00380000380000380000780000700000F00001E00003C0000780000F00003E00007
80000F00001E03803C03807FFF80FFFF807FFF8011197E9816>I<07E0001FFC007FFE00781F00
780F00780700000700000F00000F00003E0007FC0007F80007FC00001E00000700000780000380
000380F00380F00780F00700F81F007FFE003FFC0007E00011197E9816>I<007C0000FC0000DC
0001DC00039C00039C00071C000F1C000E1C001E1C003C1C00381C00781C00F01C00FFFFE0FFFF
E0FFFFE0001C00001C00001C00001C00001C0001FFC001FFC001FFC013197F9816>I<3FFE003F
FE003FFE003800003800003800003800003800003800003800003BF0003FFC003FFE003C0F0030
0700000780000380600380F00380F00780F00F00F81F007FFE001FF80007E00011197E9816>I<
00F80003FE000FFF001F0F003E0F003C0F00780600700000F00000F3F800EFFE00FFFE00F80F00
F00780F00780E00380F00380F00380700380780780780F003C1F001FFE000FF80003E00011197E
9816>I<07F0001FFC003FFE007C1F00F00780E00380E00380E003807007007C1F001FFC0007F0
001FFC003C1E00700700F00780E00380E00380E00380F007807007007C1F003FFE001FFC0007F0
0011197E9816>56 D<03E0000FF8003FFC007C1E00780F00F00700E00700E00780E00780E00380
F00780F00780780F803FFF803FFB800FE380000780000700300F00780E00781E00787C007FF800
3FE0000F800011197E9816>I<70F8F8F870000000000000000070F8F8F8700512789116>I<387C
7C7C380000000000000000387C7C7C3C1C3C38F8F0600618799116>I<7FFF00FFFF80FFFF8000
0000000000000000000000000000FFFF80FFFF807FFF00110B7E9116>61
D<00E00001F00001F00001B00001B00003B80003B80003B800031800071C00071C00071C00071C
00071C000E0E000E0E000FFE000FFE001FFF001C07001C07001C07007F1FC0FF1FE07F1FC01319
7F9816>65 D<7FF800FFFE007FFF001C0F001C07801C03C01C01C01C01C01C01E01C00E01C00E0
1C00E01C00E01C00E01C00E01C00E01C00E01C01C01C01C01C03C01C07801C0F807FFF00FFFE00
7FF8001319809816>68 D<7FFFC0FFFFC07FFFC01C01C01C01C01C01C01C01C01C00001C00001C
1C001C1C001FFC001FFC001FFC001C1C001C1C001C00001C00E01C00E01C00E01C00E01C00E07F
FFE0FFFFE07FFFE013197F9816>I<FFC000FFC000FFC0001C00001C00001C00001C00001C0000
1C00001C00001C00001C00001C00001C00001C00001C00001C00001C00401C00E01C00E01C00E0
1C00E0FFFFE0FFFFE0FFFFE013197F9816>76 D<FE0FE0FF1FE0FE0FE03803801C07001C07001C
07001C07000E0E000E0E000E0E000E0E00060C00071C00071C00071C00071C0003180003B80003
B80003B80001B00001F00001F00000E00013197F9816>86 D<FC07E0FE0FE0FC07E07001C07001
C07001C030018038038038038038038038E38039F38039F38039B38019B30019B30019B30019B3
0019B30019B3001913001B1B000F1E000F1E000E0E0013197F9816>I<7F1F807F3F807F1F800E
1E000E1C00073C0007380003B80003F00001F00001E00000E00001E00001F00003F00003B80007
B800071C00071C000E0E000E0E001C07007F1FC0FF1FE07F1FC013197F9816>I<FE0FE0FF1FE0
FE0FE01C07001C07000E0E000E0E00071C00071C00071C0003B80003B80001F00001F00000E000
00E00000E00000E00000E00000E00000E00000E00003F80007FC0003F80013197F9816>I<FFF0
FFF0FFF0E000E000E000E000E000E000E000E000E000E000E000E000E000E000E000E000E000E0
00E000E000E000E000E000E000E000E000FFF0FFF0FFF00C20789C16>91
D<FFF0FFF0FFF00070007000700070007000700070007000700070007000700070007000700070
0070007000700070007000700070007000700070FFF0FFF0FFF00C207F9C16>93
D<1FE0007FF8007FFC00783C00301E00000E00000E0003FE001FFE007E0E00F00E00E00E00E00E
00F01E00F83E007FFFE03FE7E00F83E013127E9116>97 D<7E0000FE00007E00000E00000E0000
0E00000E00000E3E000EFF800FFFC00F83E00F01E00E00F00E00F00E00700E00700E00700E0070
0E00F00F00E00F01E00F83C00FFFC00EFF00063C001419809816>I<03F80FFE1FFE3C1E780C70
00F000E000E000E000E000F000700778073E0F1FFE0FFC03F010127D9116>I<003F00007F0000
3F0000070000070000070000070003C7000FF7003FFF003C1F00780F00F00700F00700E00700E0
0700E00700E00700F00700F00F00781F007C3F003FFFE01FF7F007C7E014197F9816>I<03E00F
F81FFC3C1E780E7007E007FFFFFFFFFFFFE000E000700778073C0F1FFE0FFC03F010127D9116>
I<001F00007F8000FF8001E78001C30001C00001C0007FFF00FFFF00FFFF0001C00001C00001C0
0001C00001C00001C00001C00001C00001C00001C00001C00001C0003FFE007FFF003FFE001119
7F9816>I<03E3C00FFFE01FFFE01E3CC03C1E00380E00380E00380E003C1E001E3C001FFC001F
F8003BE0003800003800001FFC001FFF003FFFC07803C0F001E0E000E0E000E0E000E0F001E07C
07C03FFF800FFE0003F800131C7F9116>I<7E0000FE00007E00000E00000E00000E00000E0000
0E3C000EFF000FFF800F87800F03800F03800E03800E03800E03800E03800E03800E03800E0380