ASEN 5070: Statistical Orbit Determination I Fall 2015 Professor Brandon A. Jones Lecture 35: Fixed-Interval Smoothing
Announcements Homework 10 due on Friday Lecture quiz due by 5pm on Friday Already posted to D2L
Homework 10 Expected Accuracy
Homework 10 Expected Results The following slides outline expected agreement between your filter and the online solutions We do not expect the same plots, but this illustrates roughly what you should get
CKF Relative Difference at 18,340 s
CKF Relative Difference with Batch at Epoch
Lecture Quiz 7
Question 1 Percent Correct: 76% When analyzing the performance of a filter, one output to consider when characterize the performance is the residuals. When assessing accuracy based on post-fit residual ratios, we expect random values that are mostly between -3 and 3. True False
Question 2 Percent Correct: 63% Assume we have a scenario where we want to estimate the position and velocity of a satellite and the height of a table in the Engineering Center for a total of n=7 state parameters. We are given m >> 7 independent observations of the range and range-rate of the satellite taken from a station in Hawaii (p=2). Hence, in this case, the H-tilde matrix is 2x7 and there are many observation times. We use the Batch processor and accumulate the sum of H^T*H for each observation time. There is no a priori information available. What conclusion can we draw from this scenario? The system is observable and the accumulated information matrix is rank n The system is unobservable and the accumulated information matrix is rank n The system is unobservable and the accumulated information matrix is rank p-1 The system is unobservable and the accumulated information matrix is rank n-1 17% 12% 7% 63%
Question 3 Percent Correct: 56% Consider the scenario where: There are two spacecraft in Earth orbit. The two vehicles are in a two-body gravity field. There is no modeling error. We have an infinite precision computer Negligible measurement error with a small variance and zero mean. Range observations are gathered relative to a ground station with a fixed location in the inertial space. We make no other assumptions on the scenario. Which of the following statements apply to this scenario? The position and velocity states of both spacecraft are observable The position and velocity states of neither spacecraft are observable We can estimate the state of one spacecraft at a time If we add a third spacecraft to the scenario, then we can estimate the states of all three 27% 56% 15% 2%
Question 4 Percent Correct: 92% When characterizing the performance of a filter by inspecting the covariance matrix, we should take a look at: The variances on the diagonal of the matrix The correlation coefficients using the off-diagonal terms Both of the above. Neither of the above.
Question 5 Percent Correct: 76% In the method of orthogonal transformations, we generate the matrix Q such that: QH = [ R; 0 ] and the resulting R matrix is orthogonal. True False
Probability Ellipsoids (Revisit)
The Probability Ellipsoid
The Probability Ellipsoid
2D Example
2D Example
Fixed Interval Smoothing
Motivation The batch processor provides an estimate based on a full span of data When including process noise, we lose this equivalence between the batch and any of the sequential processors Is there some way to update the estimated state using information gained from future observations?
Forward-Backward Smoothing Forward-backward smoothing is a method by which a state estimate (and optionally, the covariance) may be constructed using observations before and after the epoch. Step 1. Process all observations using a CKF with process noise (SNC, DMC, etc.). Step 2. Start with the last observation processed and smooth back through the observations.
Our Notation for Smoothing Based on observations up to and including Value/vector/matrix Time of current estimate As presented in the book, the most common source of confusion for smoothing is the notation Indexing errors are the main source of software bugs!
Smoothing visualization Process observations forward in time: If you were to process them backward in time (given everything needed to do that):
Smoothing visualization Process observations forward in time: If you were to process them backward in time (given everything needed to do that):
Smoothing visualization Smoothing does not actually combine them, but you can think about it in order to conceptualize what smoothing does. Smoothing results in a much more consistent solution over time. And it results in an optimal estimate using all observations.
Smoothing Caveats: If you use process noise or some other way to increase the covariance, the result is that the optimal estimate at any time really only pays attention to observations nearby. While this is good, it also means smoothing doesn’t always have a big effect. Smoothing shouldn’t remove the white noise found on the signals. It’s not a “cleaning” function, it’s a “use all the data for your estimate” function.
Smoothing of State Estimate First, we use If Q = 0,
Smoothing of State Estimate Hence, in the CKF, we store:
Smoothing of Covariance Optionally, we may smooth the state error covariance matrix
Smoothing Algorithm
Smoothing Algorithm
Smoothing If we suppose that there is no process noise (Q=0), then the smoothing algorithm reduces to the CKF mapping relationships:
An example: 4-41 and 4-42 Book p. 283
An example: 4-41 and 4-42 Book p. 284
Smoothing Say there are 100 observations We want to construct new estimates using all data, i.e.,
Smoothing Say there are 100 observations
Smoothing Say there are 100 observations
Smoothing Say there are 100 observations