Lecture_19_ASEN5070_2012F

advertisement
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
Download