自适应卡尔曼滤波算法
180
a
141312
b
8.07.57.0
ObN
SatN
111098
282000
284000
286000
6.56.05.55.0
282000
284000
286000
GPSseond(S)
GPSseond(S)
Fig.1aThenumberofmeasurementsateachepoch.bThenumberofvisibleGPSsatellitesateachepoch
or
vtr( ¯k)>tr( v¯k),
(31)
thenwehaveαk<1.Inthiscase,theweightmatrixof
¯kisαkPxthepredictedstatevectorx¯k,whichissmaller
thanPx¯k,andtherelatedcovariancematrix(1/αk) x¯kislargerthan x¯k.Inturn,thisweakensthecontributionofthemodelpredictedstatetotheestimatedstate.
3.Insomeparticularcases,thediagonalelementsofthe
vestimatedcovariancematrix ¯kofthepredictedresidual
v¯kmaybesmallerthanthoseof k,ortr( vectorv¯k)<
tr( v¯k).Thisindicatesthatthekinematicmodelerrorsaresmall.Inthesecases,theweightmatrixofthepre-dictedstatekeepstheoriginalαk=1,andtheadaptive lteristhestandardKalman lter.Thus,wedonotneed
vtocalculate ¯k k.
4.Analyzingtheapproximatelyoptimaladaptivefactorex-pressedbyEq.(28),we ndthatitisverysimilartothatconstructedbyusingthelearningstatisticofthepre-dictedresidualsandthecorrespondingadaptivefunctionwithtwosegments(YangandGao2005)
1 v¯k≤c
αk≈(32)c
v¯>c,
k
k
anoptimaladaptivefactorshouldsatisfythecondition x ¯k= x¯k.
TheoptimaladaptivefactorbasedonEq.(33)isαk=
tr( x¯k)
.xk)tr(
(35)(34)
ProofInadaptive ltering,theestimatedcovariancematrix
ofthepredictedstatevectorequals x¯k
x .¯k=
k
(36)
TakingthetraceofEq.(36),thenwegettheoptimaladaptivefactorEq.(35),whichcompletestheproof. Usually,wehopethattheadaptivefactorsatis esαk≤1,thentheoptimaladaptivefactorcanbeexpressedas
x 1tr( ¯k)<tr( x¯k)
αk=tr( x¯k)(37)
otherwise. ( x¯k)NowwegiveanapproximatecalculationformulaforEq.
(35).Assumethattheestimatedstatevectoratepochtkis
¯kandx kis k,thenthediscrepancybetweenxx
k x¯k,¯k=x x
kisonlyestimatedbyusinglk,wherex
1T¯¯ k=(ATxkPkAk)AkPklk,
where v¯kis
nk v¯k=
2¯ki=1v
ki
¯kii=1σv
(33)
(38)(39)
andcisanempiricalconstant,whichisusuallyequal
to1.5–2.0basedonexperience(HekimoðluandBerber2003).Ifc=1inEq.(32),thenitrevertstoEq.(28).3Optimaladaptivefactorexpressedbyestimatedcovariancematrixofpredictedstate
Assumethattheestimatedcovariancematrixofthepredicted
x¯kisobtainedas statevectorx¯k,thenwegetanotheropti-maladaptivefactorfortheadaptive ltering.
Theorem2Assumethatwehavetheestimatedcovariance
x¯kas matrixofthepredictedstatevectorx¯kandthethe-oreticalone x¯kfromthecovariancepropagationlaw,then
¯kdenotestheequivalentweightmatrixoflk,whichwhereP
isdeterminedbytherobustestimationprinciple(Yangetal.
¯kiszero2001a).Sincetheexpectationof x¯k)=0.E( x
(40)
ByusingtheSagewindowingmethod,weobtaintheesti-¯kasmatedcovariancematrixofx x ¯k
1
¯k i x= x¯Tk i
N 1
i=1N
(41)
Inordertoavoidthesmoothnessoftheaverageof x¯k i
T x¯k iwithinNepochs,theestimatedcovariancematrixof
The purpose of an adaptive filter is to reduce or bound the gaps by ...Another approach is to estimate the optimal Kalman gain directly without ...
An active filter based o... 4页 1财富值 An Adaptive Color-Based ... 22页 免费 An optimal adaptive Kalm... 7页 5财富值 Adaptive Fading Kalman ...
An optimal adaptive Kalm... 7页 5财富值 Adaptive Fading Kalman F... ... [95.06]Steering an adaptive antenna array by the simplified Kalman filter...
Adaptive Kalman Filter o... 暂无评价 5页 2.00元 Blind Channel ...In addition, particle filtering as an optimal nonlinear/non-Gaussian filtering...
(or in probability)an optimal estimator for H{z.in an oKFs.Then,these ...(optimized multiple model adaptive Kalman filter, oMM—AKF);由于oMM—AKF算法...
文章编号:1001‐2400(2011)06‐0119‐07 An Algorithm of Adaptive Kalman Filter in AHRS TIAN Yi,SUN Jinhai,LI Jinhai,YAN Yuepeng (Institute of ...
An Adaptive Color-Based Particle Filter_专业资料...mean shift or the Kalman/mean shift tracker the...Ramesh, Mean Shift and Optimal Prediction for E?...
The federated filter yields estimates that are globally optimal or ...Neural network-aided adaptive unscented Kalman filter for nonlinear state ...
an adaptive Kalman filter. The simulation demonstrated that both methods could improve the performance of the filter. However,considering of practical limits ...
Kalman滤波和MATLAB实现_信息与通信_工程科技_专业资料。卡尔曼滤波器(Kalman Filter)是一个最优化自回归数据处理算法(optimal recursive data processing algorithm)...
热门文档