CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 1
ASEN 5070Statistical Orbit Determination I
Fall 2012
Professor Jeffrey S. ParkerProfessor George H. Born
Lecture 15: Numerical Compensations
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 2
Exam 1 Final Project
Homework 5 is not graded…neither is the test. Homework 6 due Today Homework 7 due next week (Tuesday!)
◦ It’s okay to use Matlab to compute partials and to output them. But verify them.
Concept Quizzes to resume Monday!
Guest lecturer next week 10/25
Announcements
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 3
Too easy?
Too short?
Exam 1 Debrief
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 4
Exam 1 Debrief
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 5
Exam 1 Debrief
True. The transpose of a column of zeros becomes a row of zeros. That row propagates through the whole system and the HTH matrix becomes singular.
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 6
Exam 1 Debrief
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 7
Exam 1 Debrief
False. Consider H-tilde = [a, b, 0]^T and Phi = 1.
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 8
Exam 1 Debrief
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 9
Exam 1 Debrief
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 10
Exam 1 Debrief
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 11
Exam 1 Debrief
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 12
Exam 1 Debrief
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 13
Exam 1 Debrief
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 14
Exam 1 Debrief
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 15
Exam 1 Debrief
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 16
Exam 1 Debrief
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 17
Exam 1 Debrief
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 18
Exam 1 Debrief
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 19
Exam 1 Debrief
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 20
Exam 1 Debrief
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 21
Exam 1 Debrief
G(t) = z(t) is the simplest representation of the observation. If you solve the EOM for z, you can also get partials wrt z-dot and c, which is more information (optional).
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 22
Exam 1 Debrief
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 23
Exam 1 Debrief
Can’t use a Laplace Transform because A(t) is time-dependent!
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 24
Exam 1 Debrief
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 25
Exam 1 Debrief
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 26
Conventional Kalman Filter (CKF) Extended Kalman Filter (EKF)
Numerical Issues◦ Machine precision◦ Covariance collapse
Numerical Compensation◦ Joseph, Potter, Cholesky, Square-root free, unscented,
Givens, orthogonal transformation, SVD◦ State Noise Compensation, Dynamical Model Compensation
Topics coming up
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 27
Full, nonlinear system:
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 28
Linearization
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 29
Observations
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 30
Observation Uncertainties
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 31
Least Squares (Batch)
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 32
Least Squares (Batch)
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 33
Least Squares (Batch)
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 34
Least Squares (Batch)
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 35
Least Squares (Batch)
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 36
Least Squares (Batch)
Stat OD Conceptualization
Iterate a few times.• Replace reference trajectory with
best-estimate• Update a priori state• Generate new computed
observations
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 37
Least Squares (Batch)
Stat OD Conceptualization
Note: the linearization assumption will gradually break down.Toward the end, the truth will begin to deviate further from the nominal.Select a measurement interval that balances the number of observations with the length of time being used.
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 38
Conceptualization of the Conventional Kalman Filter (Sequential Filter)
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 39
Conventional Kalman
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 40
Conventional Kalman
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 41
Conventional Kalman
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 42
Conventional Kalman
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 43
Conventional Kalman
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 44
Conventional Kalman
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 45
Conventional Kalman
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 46
Conventional Kalman
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 47
Conventional Kalman
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 48
Conventional Kalman
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 49
Conventional Kalman
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 50
Conventional Kalman
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 51
Conventional Kalman
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 52
Conventional Kalman
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 53
Conventional Kalman
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 54
Conventional Kalman
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 55
Conventional Kalman
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 56
Conventional Kalman
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 57
Conventional Kalman
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 58
Conventional Kalman
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 59
Conventional Kalman
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 60
Conventional Kalman
Stat OD Conceptualization
Evolution of covariance
Mapping of final covariance
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 61
Evolution of the covariance matrix as observations are processed.
Evolution of Covariance Matrix
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 62
Conceptualization of the Extended Kalman Filter (EKF)
Major change: the reference trajectory is updated by the best estimate after every measurement.
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 63
EKF
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 64
EKF
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 65
EKF
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 66
EKF
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 67
EKF
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 68
EKF
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 69
EKF
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 70
EKF
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 71
EKF
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 72
EKF
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 73
EKF
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 74
EKF
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 75
EKF
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 76
EKF
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 77
EKF
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 78
EKF
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 79
EKF
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 80
EKF
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 81
EKF
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 82
EKF
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 83
EKF
Stat OD Conceptualization
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 84
EKF
Stat OD Conceptualization
Evolution of reference, w/covarianceOriginal Reference
Final mapped Reference
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 85
Stat OD Conceptualization
Pitfall 1: Beware of large a priori covariances with noisy data- Breaks linear approximations- Causes filter to diverge
Linear Regime
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 86
Stat OD Conceptualization
Pitfall 2: Beware of collapsing covariance- Prevents new data from influencing solution- More prevalent for longer time-spans
CCARColorado Center for
Astrodynamics Research
University of ColoradoBoulder 87
Final Project
Homework 5 is not graded…neither is the test. Homework 6 due Today Homework 7 due next week (Tuesday!)
◦ It’s okay to use Matlab to compute partials and to output them. But verify them.
Concept Quizzes to resume Monday!
Guest lecturer next week 10/25
The End