ASEN 5070 Statistical Orbit Determination I Fall 2012 Professor Jeffrey S. Parker Professor George H. Born Lecture 19: Numerical Compensations University of Colorado Boulder 1 Homework 8 due next week. ◦ Make sure you spend time studying for the exam Exam 2 in one week (Thursday). Review on Tuesday. Exam 2 will cover: ◦ Batch vs. CKF vs. EKF ◦ Probability and statistics (good to keep this up!) Haven’t settled on a question yet, but it will probably be a conditional probability question. I.e., what’s the probability of X given that Y occurs? ◦ Observability ◦ Numerical compensation techniques, such as the Joseph and Potter formulation. ◦ No calculators should be necessary ◦ Open Book, Open Notes University of Colorado Boulder 2 University of Colorado Boulder 3 Use Matlab and try it out University of Colorado Boulder 4 This is TRUE for the Batch, but you may run into a problem with the Kalman filters. University of Colorado Boulder 5 The best scan of the book ever: University of Colorado Boulder 6 University of Colorado Boulder 7 University of Colorado Boulder 8 University of Colorado Boulder 9 University of Colorado Boulder 10 University of Colorado Boulder 11 University of Colorado Boulder 12 Due in 7 days University of Colorado Boulder 13 University of Colorado Boulder 14 Note that these plots aren’t 100% well-labeled! University of Colorado Boulder 15 University of Colorado Boulder 16 The biggest pitfall When processing the 2nd observation, set that is, use the most current covariance you have as the a priori! Not the original one. University of Colorado Boulder 17 Processing an observation vector one element at a time. Whitening Cholesky Joseph Today ◦ ◦ ◦ ◦ Positive Definiteness Conditioning Number Potter Householder University of Colorado Boulder 18 Definition University of Colorado Boulder 19 Properties of PD matrices University of Colorado Boulder 20 Properties of PD matrices University of Colorado Boulder 21 Quick Break University of Colorado Boulder 22 Summary of Exact to order 1 2 (1 3 ) (1 3 ) 2 4 Joseph (1 3 ) 1 2 (1 3 ) 2 University of Colorado Boulder P2 Results Conventional Kalman 1 1 1 2 1 1 1 Batch (1 3 ) 1 2 (1 3 ) 2 4 Conditioning Number of matrix A: C(A) where the gammas are the min/max eigenvalue of the matrix. Inverting A with p digits of precision becomes error-prone as C(A) 10p. If we invert the square root of A: then C(W)=sqrt(C(A)). Numerical difficulties will arise as C(W) 102p. University of Colorado Boulder 24 Square Root Filter Algorithms University of Colorado Boulder 25 Motivation: ◦ Loss of significant digits that occurs in computing the measurement update of the state error covariance matrix (P) at the observation epoch (Kaminski et al., 1971) ◦ If eigenvalues spread a wide range, then the numerical errors can destroy the symmetry and PDness of the P matrix. Filter divergence can occur. University of Colorado Boulder 26 Define W, the square root of P: Observe that if we have W, then computing P in this manner will always result in a symmetric PD matrix. Note: Square root filters are typically derived to process one observation at a time. Hence, University of Colorado Boulder 27 (Sorry for just scanning the text, but it’s a pretty concise description!) University of Colorado Boulder (Sorry for just scanning the text, but it’s a pretty concise description!) University of Colorado Boulder University of Colorado Boulder This is a key University of Colorado Boulder University of Colorado Boulder University of Colorado Boulder University of Colorado Boulder University of Colorado Boulder University of Colorado Boulder University of Colorado Boulder University of Colorado Boulder University of Colorado Boulder (say, using Cholesky) University of Colorado Boulder University of Colorado Boulder University of Colorado Boulder University of Colorado Boulder University of Colorado Boulder University of Colorado Boulder University of Colorado Boulder Note: if you are given an a priori P matrix, convert it to W using Cholesky or equivalent at start. University of Colorado Boulder University of Colorado Boulder And page 339 of Stat OD text. University of Colorado Boulder Summary of Exact to order 1 2 (1 3 ) (1 3 ) 2 4 P2 Results Potter Algorithm 1 2 (1 ) (1 ) 2 4 Conventional Kalman 1 1 1 2 1 Joseph (1 3 ) 1 2 (1 3 ) 2 University of Colorado Boulder 1 1 Batch (1 3 ) 1 2 (1 3 ) 2 4 Homework 8 due next week. ◦ Make sure you spend time studying for the exam Exam 2 in one week (Thursday). Review on Tuesday. Exam 2 will cover: ◦ Batch vs. CKF vs. EKF ◦ Probability and statistics (good to keep this up!) Haven’t settled on a question yet, but it will probably be a conditional probability question. I.e., what’s the probability of X given that Y occurs? ◦ Observability ◦ Numerical compensation techniques, such as the Joseph and Potter formulation. ◦ No calculators should be necessary ◦ Open Book, Open Notes University of Colorado Boulder 51