t---v 0+ iieceweb1.rutgers.edu/~gajic/pdffiles/519kalmanfiltering/... · 2014. 3. 30. · c.o ....
Post on 27-Jan-2021
1 Views
Preview:
TRANSCRIPT
-
6 . i· I' Co ,lV\ r~' n.>l.~..-i/\ C~~ e~-1-::> C-O--{j\. a...v, j ct c CC31-(..,:! ~ t--€.e.
Y-o-e mBU" -fc ~ t-o d i'-J e..tcJe.1 \1
3C.e~(.>,,') 't---v ~r:'::> 0+ ::;DV'Y\s:.? Sort. II \\t-\LUJ\t\~ "S~~~t- tnhc> tc) ~- ________......_ •.___.-J..:.:...-=-___.__
b8&~ 5 -e...n 'S ch."':'1...J> e ~ +(}..eUVl ru.::t-~, a.o j ~.~
.. . Factors that contribute to such ill-conditioning include the following:
1. Large uncertainties in the values of the matrix paraIIleters , Q, H, or R. Such modeling errors are not accounted for in the derivation of the Kalman filter.
2. Large ranges of the actual values of these matrix parameters, the measurements, or the state variables-all of which can result from poor choices of scaling or dimensional units.
3. Ill-conditioning of the intermediate result R* =H P RT +R for inversion in the Kalman gain formula.
4. Ill-conditioned theoretical solutions of the matrix Riccati equation-without considering numerical solution errors. With numerical errors, the solution may become indefinite-which can destabilize the filt~r estimation error.
5. Large matrix dimensions. The number of arithmetic operations grows as the square or cube of matrix dimensions, and each o",ration can introduce roundoff errors. I
I
6. Poor machine precision, which makes the roundoff ettors larger. . ... --_....._. ". .. ."-l'I
i
There is a great difference between theory and p*tice. Giacomo Antonelli (1806-~876)1
I
-
(
C.o W\.p.!3JaJ--Vb·V't?tf ~~~~ ~ VY\CLV\. (f ~rs ~-eIs-OCj2-{
re3-u-v~ 7t- ~~~'\S
c'e-ecr-...J.-.-la.tc'"D'li\ S U, Le...t'Yle..t.ll"s}-c..JQ~
:==. P- 1'1-e--E- ~ CCA-T \ ~o~'1l0 f-f
A5tcj~~ li\/\ co...ec...u.....tah'lbV) ~. U-e ~Q.,;.':tcr •
( 6")J l6,~J E-AP-1-\~ (7""Apl-E-M~~'nc\N- M€--n-tCD..)
r0JJ 5 '"'if ert'c5u'tJ 7bl'\fY\ ~'l/) Pc..+) = (PL-) + +f p:1 t
-
1{;,3,ij j,.L.ki-M~ 'P6P-Mu~~QH . i . .. -1 T , .. rK. -.- Pb)t·(T( ~pC-)-f{T+p-) =- {kPL-)'j ({gp(c)} t-l'+RJ
(;?.) 1. p (~) = PH - t.i" VV\ ')V\Q-v.. berVlA S . ~~ ~("YlIl u4.Qa,_~.)1:~.Q~< 0) 4 (0 f··~.e~ 4 c-~ £Jtii.-.f ~i-ct 0Lln~e .+!'V)et1..+ e3 ) .== OCn·:4)
¥ Yl">'?e
·mce ~tj1lY\'M-~\ .. b~ We. Uo~Lc2~1-zJ ~
6C'V)~)
@ r;kCTOP-\2~T~Ct-f t-J\.~~D5 'FeR. JLhl-.MA:H 1=-\ ~T6P-( Nt:rer 0 r et.~et- ~IA~,
.t,{oclO~ Chce..e.~~ ~..Lo Wi>oSL~
t-'l -- U Ou'U .,- -:::::. I- Pi- L '\
1.) =u.-rpe.r ~'1~~~1 L=eJb"7-t0C?..r~~1 P'-10u~
-
H-= (cT) (c.T)' ==- c. TT""'"" c T "--r-'"
(.,~ T 'L-S De:-~~V'e-l \ b:er~. i...$ \ TTT~/l (IIT = TT"= I)
H - C.C.T
·KIO \:f{e>-(-e::r'l t..J1.A O-f' p-e..c~S ~..ILo-Q 1IV\.;;u./\ ~ec-u)'l...~ \.#-€~
~ Le..e C.A7S'~'YU? ~ C 1..-5 -e.:Gtee.r
-
l:-oQ.H~ m.:o...M~.~ HOIA 2e..t"o ~~-e.. ~~
1::e-e m&-e.U ~~a..R
o
~
~\~
Y"Y'~ e
1-A u-~~ a~./\c:~· ~~ ~ ~..e S·IQc:vvd..Lu-~ ~".Qfl.~-(3
r-..;H h Gue r~ e-C25:, g ~~ r ~ '3 01-V\ l.L-(!) c ~tyl >
'1...~ C.1 ., tpll1 -:='G!1 .~ c:...1 ~ VP11
C.2.') =- 01 C9.-f -=') 0-1 -=- 'P~ !C11r?-1 '2.. '":L
( '3) 1>;1.2- -= 0..t t-0).., G2Z =- ~ 'P2 '2. - C~ = ~ P2z - P.2Y~11
Cow...p l.e...-t-e.. ~ete)O 'Sv'hJ~ ~~~~-
C.JI ~..-t'\e.ra...t .'M'Jl-"M 'S 'j VV\ VV\~ ~5c~e o\~e.;~ ~M LD ~ LU --Je-b(R. e,,,7 It~{)~ u-pr:>-er ~CJ a'--f-(-€.ir~)~9-r ...~~.o'S~ ... ~~~>~~~,
-Jf-e. S~ ~~. ~S ~ GS?~)~1
-
t-~ oc>- ty.ced CJnc>.les~D-eco~bSG~01l) ~__ --:cl:.t:;~,a..QvY\.~
1-1 -- V D U' l
U-¥\'Lt u-r.~ h-0CLV\~~
c~ e.t~!),\et."1-s e:t~ l;-t-e ~ ~~~ =-1)
JV-,.L"S CD o-l-so JL..U'\1O~'n -=S U D c:ReC-oc..o-posv~~.
r)"he_ CQO~'3rG1/)c*..~. o.J.~1"'"L~ 1....6 cUU€'-A...t 'lJ'lA TcJ?(Q
Jh::-t- ~1sL. ~s-o ~s -W.e Ck>~(:.s)-tahSl:iV'Et ~ t£Ll~C'Vnl CYl1-..nCW)+k) -5
-
Uses of Cholesky decomposition In Kalman filtering. Cholesky decom
position methods produce triangular matrix factors (Cholesky factors), and the sparse
ness ofthese factors can be exploited in the implementation of the Kalman filter equa
tions. These methods are used for the following purposes:
1. In the decomposition of covariance matrices (P, R, and Q) for implementa
tion of "square root" filters.
2. In "decorrelating" measurement errors between components of vector
valued measurements, so that the components may be processed sequentially
as independent scalar-valued measurements. (See page 218.)
3. As part of a numerically stable method for computing matrix expressions
containing the factor (HPHT+R) -1 in the conventional form of the Kalman
filter. (This matrix inversion can be obviated by the decorrelation methods,
hOWever.)
4. In Monte Carlo analysis of Kalman filters by simulation. Cholesky factors
are used for generating independent random sequences of vectors with pre
specified means and covariance matrices. (See §3.4.8 on page 70.)
.L ~..e.r ) ~"D\/) G ~ c:; ~. D ECoP-P-Ei-fo..-,lOH ~r "'ECrOp..-"-IA~E-D t-AEkSUPEt-{E+rt:$
E i""Y '-ff3 .-.::::-R.,6(l:---C) er R A (~~.lLo') ~ ~Sc~~ t-a
5 L,.I)l C.Q., R. L-:, CIY'! (fe_vIe.t-a-l 'Y\ o~ ~('t01,,"W 'VV\ ~RY.Q-....I-\ ,~, SC cs-J2.et.tr" Cro ~~ r- -::2. C-D-1A Ylol::.. ~,. J,)'Y"Oee 5SR c..{
~-rc~,~ ceJ/~.~("'- e>0~a.:h.s"l)"1'\S t
\Ti.e ~.d-co-r R o--~
-R -:-UDU~
~~Qrj\i:-t-oct.uce ~ c:.Qr-,~ +~~~l£:> -1
::t,~ =- V z.
~~ --;::;. G {,,'n~ ~}.- 6 ( ) -= t.f~ G{ ~ V}(ru'1)-1 $( ') __ u~R.U-"" = -u i (U0UT )U'T [(- ) -=D 8(-)
http:cs-J2.et.tr
-
p... --=:... U D U'
.~J...(E: ~ u..v\ u+ ~~~a.r ~'D~ s4
~~~C: eciJ-1t.e..sh.Jrl,L.c...~ X re-~1-eS O\()ecr- ~ loa ~ £l.Li:>sh~"tJ\ ~~~ ~
~~
~~
. -1. . .. 7> ., CD t-11 PUTI1-f L"? (H P rf' +R J b;j U-5Uh~ GK c) l-E-S ~":7 ~ 0PM~+' R) ,;::::.tJOU~
kt-E'.L,( tJ\r\ CDt-ct-e..r ro ~.~I
(: H PtfT +-Fl)-1.. () ti ~ -~
( 'U 0 u"') C.p.. p+_(r+ p....j ~ t1 =- +-1 , \'- :r~'.,\:::.......--... ~
:=:'X
U 0 u"1 X = +-f
-
D D u"'" ~ ~ +-J ~
-:::: XCi)
~~. e~~ e~~
1J ')(C~J = H -="-:>
o U'"fT)( -= >
top related