the kalman filter: a study of covariances
DESCRIPTION
David Wheeler Kyle Ingersoll EcEn 670. The Kalman Filter: A Study of Covariances. A Comparison between Analytical and Simulated Results. December 5, 2013. Kalman Overview:. Predict (P) Forward One Step. P. P. P. P. P. P. P. P. U. U. U. Common Applications 1 : - PowerPoint PPT PresentationTRANSCRIPT
![Page 1: The Kalman Filter: A Study of Covariances](https://reader036.vdocuments.us/reader036/viewer/2022062305/56815fe9550346895dceee6f/html5/thumbnails/1.jpg)
David WheelerKyle Ingersoll
EcEn 670
December 5, 2013
A Comparison between Analytical and Simulated Results
The Kalman Filter: A Study of Covariances
![Page 2: The Kalman Filter: A Study of Covariances](https://reader036.vdocuments.us/reader036/viewer/2022062305/56815fe9550346895dceee6f/html5/thumbnails/2.jpg)
2
Kalman Overview:
Common Applications1:• Inertial Navigation (IMU + GPS)• Global Navigation Satellite Systems• Estimating Constants in the Presence of
Noise• Simultaneous Localization and Mapping
(SLAM)• Object Tracking In Computer Vision• Economics
Predict (P) Forward One Step
Update (U)Use Measurements If Available
P P P P P P P P
U U U
![Page 3: The Kalman Filter: A Study of Covariances](https://reader036.vdocuments.us/reader036/viewer/2022062305/56815fe9550346895dceee6f/html5/thumbnails/3.jpg)
3
Kalman Intuition: Predict Using Underlying Model
1 2 3 4 5 ?
![Page 4: The Kalman Filter: A Study of Covariances](https://reader036.vdocuments.us/reader036/viewer/2022062305/56815fe9550346895dceee6f/html5/thumbnails/4.jpg)
4
Kalman Intuition: Predict Using Underlying Model
1 2 3 4 5 ?
![Page 5: The Kalman Filter: A Study of Covariances](https://reader036.vdocuments.us/reader036/viewer/2022062305/56815fe9550346895dceee6f/html5/thumbnails/5.jpg)
5
Kalman Intuition: Update by Weighing Measurement and Model
1 2 3 4 5 ?
Measurement,
Model Estimate,
Residual
![Page 6: The Kalman Filter: A Study of Covariances](https://reader036.vdocuments.us/reader036/viewer/2022062305/56815fe9550346895dceee6f/html5/thumbnails/6.jpg)
6
Kalman Intuition: Update by Weighing Measurement and Model
1 2 3 4 5 ?
Measurement Covariance,
State Covariance,
KalmanGain,
![Page 7: The Kalman Filter: A Study of Covariances](https://reader036.vdocuments.us/reader036/viewer/2022062305/56815fe9550346895dceee6f/html5/thumbnails/7.jpg)
7
Kalman Intuition: Summary
1 2 3 4 5 ?
KalmanGain,
Predict Step(1)Predict state forward one step.(2)Predict covariance forward one step.Update Step(1)Determine Kalman Gain
(optimal weighting between and ).(2)Update state using Kalman gain and
residual.(3)Update state covariance .
![Page 8: The Kalman Filter: A Study of Covariances](https://reader036.vdocuments.us/reader036/viewer/2022062305/56815fe9550346895dceee6f/html5/thumbnails/8.jpg)
8
Prediction Derivation: Linear:
Prediction Step: Linear Example
Current State
Recent State
Process Noise
Recent Input
k=1
𝑥
𝑦 Δ𝑥
Δy
𝑥 𝑙𝑜𝑐
𝑦 𝑙𝑜𝑐
k=2
Example 1
============
![Page 9: The Kalman Filter: A Study of Covariances](https://reader036.vdocuments.us/reader036/viewer/2022062305/56815fe9550346895dceee6f/html5/thumbnails/9.jpg)
9
Update: Measurement:
Update Step: Linear Example
Measurement Model’s Guess for Measurement
Noise ResidualWeighting
𝑓 (𝑃 𝐾 ,𝑅)
![Page 10: The Kalman Filter: A Study of Covariances](https://reader036.vdocuments.us/reader036/viewer/2022062305/56815fe9550346895dceee6f/html5/thumbnails/10.jpg)
10
Results: Linear Example
Ten Steps “Predict" Only:
500 runs 10 time steps
![Page 11: The Kalman Filter: A Study of Covariances](https://reader036.vdocuments.us/reader036/viewer/2022062305/56815fe9550346895dceee6f/html5/thumbnails/11.jpg)
11
Results: Linear Example
Experimental covariance (Cyan dots)
MATLAB cov command Analytical covariance
(Red solid line)
Individual runs (Magenta dots)(Dark blue dots)
![Page 12: The Kalman Filter: A Study of Covariances](https://reader036.vdocuments.us/reader036/viewer/2022062305/56815fe9550346895dceee6f/html5/thumbnails/12.jpg)
12
Results: Linear Example
Update Step:
500 runs
0.01
![Page 13: The Kalman Filter: A Study of Covariances](https://reader036.vdocuments.us/reader036/viewer/2022062305/56815fe9550346895dceee6f/html5/thumbnails/13.jpg)
13
Results: Linear Example
Experimental covariance(Green dots)
MATLAB cov command Analytical covariance
(Magenta solid line)
Individual runs(Dark blue dots)
![Page 14: The Kalman Filter: A Study of Covariances](https://reader036.vdocuments.us/reader036/viewer/2022062305/56815fe9550346895dceee6f/html5/thumbnails/14.jpg)
14
Linear Example: Comparing Covariance Trends
Experimental Covariance (Blue)Analytical Covariance (Red)
![Page 15: The Kalman Filter: A Study of Covariances](https://reader036.vdocuments.us/reader036/viewer/2022062305/56815fe9550346895dceee6f/html5/thumbnails/15.jpg)
15
Linear Example: Convergence of Covariances
![Page 16: The Kalman Filter: A Study of Covariances](https://reader036.vdocuments.us/reader036/viewer/2022062305/56815fe9550346895dceee6f/html5/thumbnails/16.jpg)
16
Process
Non-Linear Example
𝑥𝑘=[ 𝑥 𝑙𝑜𝑐𝑦 𝑙𝑜𝑐
𝜃h𝑒𝑎𝑑𝑖𝑛𝑔]𝑢=[𝐷 𝑓𝑜𝑟𝑤𝑎𝑟𝑑
Δ𝜃h ]
𝑥
𝑦
Δ𝑥
Δy
𝑥 𝑙𝑜𝑐
𝑦 𝑙𝑜𝑐
Δ𝜃h𝜃h
Example 2
𝑓 𝑥=[𝑥 𝑙𝑜𝑐+𝐷 𝑓 ∗ cos (𝜃h+Δ𝜃h2
)
𝑦 𝑙𝑜𝑐+𝐷 𝑓 ∗ sin (𝜃h+Δ𝜃h2
)
𝜃h+Δ𝜃h]
𝑥𝑏
𝑦 𝑏𝑧𝑘
![Page 17: The Kalman Filter: A Study of Covariances](https://reader036.vdocuments.us/reader036/viewer/2022062305/56815fe9550346895dceee6f/html5/thumbnails/17.jpg)
17
Results: Non-linear Example
30 Time Steps 500 runs Input: Input Noise is Gaussian,
±5%
(known to start at origin) Analytical Covariance
(Cyan Ellipse) Beacon Location
(Red Circle)
![Page 18: The Kalman Filter: A Study of Covariances](https://reader036.vdocuments.us/reader036/viewer/2022062305/56815fe9550346895dceee6f/html5/thumbnails/18.jpg)
18
Results: Non-linear Example
Beacon Location(Red Circle)
Measurement (7/500)(Green Lines)
Gaussian Noise on Measurement(Red Xs)
Covariance (before update)Analytical (Thin
Cyan)Experimental (Thick
Cyan)
𝑅
![Page 19: The Kalman Filter: A Study of Covariances](https://reader036.vdocuments.us/reader036/viewer/2022062305/56815fe9550346895dceee6f/html5/thumbnails/19.jpg)
19
Results: Non-linear Example
Covariance Before update
Analytical (Thin Cyan) Experimental (Thick Cyan)
After update Analytical (Thin
Magenta) Experimental (Thick
Magenta)
Note – the update step reduces the uncertainty in the direction of the measurement only!
![Page 20: The Kalman Filter: A Study of Covariances](https://reader036.vdocuments.us/reader036/viewer/2022062305/56815fe9550346895dceee6f/html5/thumbnails/20.jpg)
20
Under certain conditions, a Kalman filter causes the covariance to converge
Analytical and simulated covariances match closely Analytical and simulated covariances converge quickly if
seeded with different values Individual measurements can significantly reduce the
covariance of the state estimate
Conclusion
![Page 21: The Kalman Filter: A Study of Covariances](https://reader036.vdocuments.us/reader036/viewer/2022062305/56815fe9550346895dceee6f/html5/thumbnails/21.jpg)
21
Questions & Discussion