gps/dead reckoning navigation with kalman filter integration paul bakker
Post on 21-Dec-2015
238 views
TRANSCRIPT
![Page 1: GPS/Dead Reckoning Navigation with Kalman Filter Integration Paul Bakker](https://reader033.vdocuments.us/reader033/viewer/2022061614/56649d605503460f94a408a1/html5/thumbnails/1.jpg)
GPS/Dead Reckoning GPS/Dead Reckoning Navigation with Kalman Navigation with Kalman
Filter IntegrationFilter IntegrationPaul BakkerPaul Bakker
![Page 2: GPS/Dead Reckoning Navigation with Kalman Filter Integration Paul Bakker](https://reader033.vdocuments.us/reader033/viewer/2022061614/56649d605503460f94a408a1/html5/thumbnails/2.jpg)
Kalman FilterKalman Filter
““The Kalman Filter is an estimator for what The Kalman Filter is an estimator for what is called the linear-quadratic problem, is called the linear-quadratic problem, which is the problem of estimating the which is the problem of estimating the instantaneous ‘state’ of a linear dynamic instantaneous ‘state’ of a linear dynamic system perturbed by white noise – by system perturbed by white noise – by using measurements linearly related to using measurements linearly related to the state but corrupted by white noise. the state but corrupted by white noise. The resulting estimator is statistically The resulting estimator is statistically optimal with respect to any quadratic optimal with respect to any quadratic function of estimation error” [1]function of estimation error” [1]
![Page 3: GPS/Dead Reckoning Navigation with Kalman Filter Integration Paul Bakker](https://reader033.vdocuments.us/reader033/viewer/2022061614/56649d605503460f94a408a1/html5/thumbnails/3.jpg)
Kalman Filter UsesKalman Filter Uses
EstimationEstimation• Estimating the State of Dynamic Estimating the State of Dynamic
SystemsSystems• Almost all systems have some dynamic Almost all systems have some dynamic
componentcomponent Performance AnalysisPerformance Analysis
• Determine how to best use a given set Determine how to best use a given set of sensors for modeling a systemof sensors for modeling a system
![Page 4: GPS/Dead Reckoning Navigation with Kalman Filter Integration Paul Bakker](https://reader033.vdocuments.us/reader033/viewer/2022061614/56649d605503460f94a408a1/html5/thumbnails/4.jpg)
Basic Discrete Kalman Filter Basic Discrete Kalman Filter EquationsEquations
http://www.cs.unc.edu/~welch/media/pdf/kalman_intro.pdf
![Page 5: GPS/Dead Reckoning Navigation with Kalman Filter Integration Paul Bakker](https://reader033.vdocuments.us/reader033/viewer/2022061614/56649d605503460f94a408a1/html5/thumbnails/5.jpg)
Automobile Voltimeter ExampleAutomobile Voltimeter Example
![Page 6: GPS/Dead Reckoning Navigation with Kalman Filter Integration Paul Bakker](https://reader033.vdocuments.us/reader033/viewer/2022061614/56649d605503460f94a408a1/html5/thumbnails/6.jpg)
Time 50 SecondsTime 50 Seconds
![Page 7: GPS/Dead Reckoning Navigation with Kalman Filter Integration Paul Bakker](https://reader033.vdocuments.us/reader033/viewer/2022061614/56649d605503460f94a408a1/html5/thumbnails/7.jpg)
Time 100 SecondsTime 100 Seconds
![Page 8: GPS/Dead Reckoning Navigation with Kalman Filter Integration Paul Bakker](https://reader033.vdocuments.us/reader033/viewer/2022061614/56649d605503460f94a408a1/html5/thumbnails/8.jpg)
Global Positioning SystemGlobal Positioning System
![Page 9: GPS/Dead Reckoning Navigation with Kalman Filter Integration Paul Bakker](https://reader033.vdocuments.us/reader033/viewer/2022061614/56649d605503460f94a408a1/html5/thumbnails/9.jpg)
GPSGPS
24 or more satellites (28 operational 24 or more satellites (28 operational in 2000)in 2000)
6 circular orbits containing 4 or more 6 circular orbits containing 4 or more satellitessatellites
Radii of 26,560 and orbital period of Radii of 26,560 and orbital period of 11.976 hours11.976 hours
Four or more satellites required to Four or more satellites required to calculate user’s positioncalculate user’s position
![Page 10: GPS/Dead Reckoning Navigation with Kalman Filter Integration Paul Bakker](https://reader033.vdocuments.us/reader033/viewer/2022061614/56649d605503460f94a408a1/html5/thumbnails/10.jpg)
GPS Satellite SignalsGPS Satellite Signals
![Page 11: GPS/Dead Reckoning Navigation with Kalman Filter Integration Paul Bakker](https://reader033.vdocuments.us/reader033/viewer/2022061614/56649d605503460f94a408a1/html5/thumbnails/11.jpg)
GPS code sync AnimationGPS code sync Animation
http://www.colorado.edu/geography/gcrafthttp://www.colorado.edu/geography/gcraft/notes/gps/gif/bitsanim.gif/notes/gps/gif/bitsanim.gif
When the Pseudo Random codes match up When the Pseudo Random codes match up the receiver is in sync and can determine the receiver is in sync and can determine its distance from the satelliteits distance from the satellite
![Page 12: GPS/Dead Reckoning Navigation with Kalman Filter Integration Paul Bakker](https://reader033.vdocuments.us/reader033/viewer/2022061614/56649d605503460f94a408a1/html5/thumbnails/12.jpg)
Receiver Block DiagramReceiver Block Diagram
![Page 13: GPS/Dead Reckoning Navigation with Kalman Filter Integration Paul Bakker](https://reader033.vdocuments.us/reader033/viewer/2022061614/56649d605503460f94a408a1/html5/thumbnails/13.jpg)
Navigation PictorialNavigation Pictorial
![Page 14: GPS/Dead Reckoning Navigation with Kalman Filter Integration Paul Bakker](https://reader033.vdocuments.us/reader033/viewer/2022061614/56649d605503460f94a408a1/html5/thumbnails/14.jpg)
Position Estimates with Noise and Position Estimates with Noise and Bias InfluencesBias Influences
![Page 15: GPS/Dead Reckoning Navigation with Kalman Filter Integration Paul Bakker](https://reader033.vdocuments.us/reader033/viewer/2022061614/56649d605503460f94a408a1/html5/thumbnails/15.jpg)
Differential GPS ConceptDifferential GPS Concept
Reduce error by Reduce error by using a known using a known ground reference ground reference and determining and determining the error of the the error of the GPS signalsGPS signals
Then send this Then send this error information error information to receivers to receivers
![Page 16: GPS/Dead Reckoning Navigation with Kalman Filter Integration Paul Bakker](https://reader033.vdocuments.us/reader033/viewer/2022061614/56649d605503460f94a408a1/html5/thumbnails/16.jpg)
GPS Error SourcesGPS Error Sources
![Page 17: GPS/Dead Reckoning Navigation with Kalman Filter Integration Paul Bakker](https://reader033.vdocuments.us/reader033/viewer/2022061614/56649d605503460f94a408a1/html5/thumbnails/17.jpg)
GDOPGDOP
![Page 18: GPS/Dead Reckoning Navigation with Kalman Filter Integration Paul Bakker](https://reader033.vdocuments.us/reader033/viewer/2022061614/56649d605503460f94a408a1/html5/thumbnails/18.jpg)
Example of Importance of Satellite Example of Importance of Satellite ChoiceChoice
The satellites are The satellites are assumed to be at a assumed to be at a 55 degree 55 degree inclination angle inclination angle and in a circular and in a circular orbitorbit
Satellites have Satellites have orbital periods of orbital periods of 43,08243,082
Right Ascension Angular Location
![Page 19: GPS/Dead Reckoning Navigation with Kalman Filter Integration Paul Bakker](https://reader033.vdocuments.us/reader033/viewer/2022061614/56649d605503460f94a408a1/html5/thumbnails/19.jpg)
GDOP (1,2,3,4) vs. (1,2,3,5)GDOP (1,2,3,4) vs. (1,2,3,5)
Optimum GDOP for the satellitesOptimum GDOP for the satellites• The smaller the GDOP the betterThe smaller the GDOP the better
“GDOP Chimney” (Bad) – 2 of the 4 satellites are too close to one another – don’t provide linearly independent equations
![Page 20: GPS/Dead Reckoning Navigation with Kalman Filter Integration Paul Bakker](https://reader033.vdocuments.us/reader033/viewer/2022061614/56649d605503460f94a408a1/html5/thumbnails/20.jpg)
RMS X ErrorRMS X Error
Graphed above is the covariance analysis for RMS Graphed above is the covariance analysis for RMS east position erroreast position error• Uses Riccati equations of a Kalman FilterUses Riccati equations of a Kalman Filter
Optimal and Non-Optimal are similarOptimal and Non-Optimal are similar
![Page 21: GPS/Dead Reckoning Navigation with Kalman Filter Integration Paul Bakker](https://reader033.vdocuments.us/reader033/viewer/2022061614/56649d605503460f94a408a1/html5/thumbnails/21.jpg)
RMS Y ErrorRMS Y Error
Covariance analysis for RMS north position Covariance analysis for RMS north position errorerror
![Page 22: GPS/Dead Reckoning Navigation with Kalman Filter Integration Paul Bakker](https://reader033.vdocuments.us/reader033/viewer/2022061614/56649d605503460f94a408a1/html5/thumbnails/22.jpg)
RMS Z ErrorRMS Z Error
Covariance analysis for vertical position Covariance analysis for vertical position errorerror
![Page 23: GPS/Dead Reckoning Navigation with Kalman Filter Integration Paul Bakker](https://reader033.vdocuments.us/reader033/viewer/2022061614/56649d605503460f94a408a1/html5/thumbnails/23.jpg)
Clock Bias ErrorClock Bias Error
Covariance analysis for Clock bias errorCovariance analysis for Clock bias error
![Page 24: GPS/Dead Reckoning Navigation with Kalman Filter Integration Paul Bakker](https://reader033.vdocuments.us/reader033/viewer/2022061614/56649d605503460f94a408a1/html5/thumbnails/24.jpg)
Clock Drift ErrorClock Drift Error
Covariance analysis for Clock drift errorCovariance analysis for Clock drift error
![Page 25: GPS/Dead Reckoning Navigation with Kalman Filter Integration Paul Bakker](https://reader033.vdocuments.us/reader033/viewer/2022061614/56649d605503460f94a408a1/html5/thumbnails/25.jpg)
Questions & ReferencesQuestions & References
[1] M. S. Grewal, A. P. Andrews, [1] M. S. Grewal, A. P. Andrews, Kalman Filtering, Theory and Kalman Filtering, Theory and Practice Using MATLABPractice Using MATLAB, New York: , New York: Wiley, 2001Wiley, 2001