AME 60617 Bayesian Data Assimilation Homework 3: 1 Problem 1: Standard Kalman Filtering For A Linear Problem
AME 60617 Bayesian Data Assimilation Homework 3: 1 Problem 1: Standard Kalman Filtering For A Linear Problem
AME 60617 Bayesian Data Assimilation Homework 3: 1 Problem 1: Standard Kalman Filtering For A Linear Problem
Homework 3
Instructor: Dr. Jian-Xun Wang
Assistant Professor, Department of Aerospace and Mechanical Engineering
Note: Please upload your solution to each problem in your homework assignment as a single
PDF file to the appropriate assignment section. Use the following file naming convention: DA-
Lastname-FirstName-HW3.pdf. Source codes should also be attached.
xk = Axk−1 + q,
q ∼ N (0, Q)
where A and Q is given as,
1 5 1 4 1 3
20 ∆t 0 8 ∆t 0 6 ∆t 0
0 1 5 1 4 1 3
1 4 20 ∆t 0 8 ∆t 0 6 ∆t
∆t 1 3 1 2
8 0 3 ∆t 0 2 ∆t 0
Q=
0 1 4 1 3 1
2
8 ∆t 0 3 ∆t 0 2 ∆t
1 ∆t3 0 1 2
6 2 ∆t 0 ∆t 0
1 3 1 2
0 6 ∆t 0 2 ∆t 0 ∆t
1
where ∆t = 0.5 and q = 1.
1. Please generate synthetic data by using the forward model given above with the “ground
(T ruth)
truth” of x0 = [0, 0, 1, 0.6, 0.4, 0.8]T (corrupted with some Gaussian measurement noise.)
Note: (1) you can start from x0 = [0, 0, 0, 0, 0, 0]T with state covariance P0 = diag([0.1, 0.1, 0.1, 0.1, 0.5, 0.5]).
(2) Please show plots of filtered results compared with synthetic observation and ground truth.
yk = h(xk , k) + rk = ak sin(θk ) + rk
1. Please generate synthetic data by using the forward model given above with the “ground
(T ruth)
truth” of x0 = [0, 10, 1]T . (corrupted with some Gaussian measurement noise.)
2. Derive EKF for this problem (explicitly write out Jacobi, forecase, and update ...)
2
4. Play with the measurement noise.
Note: (1) you can start from x0 = [0, 10, 1]T with state covariance P0 = diag([3, 3, 3]). (2) Please
show plots of filtered results compared with synthetic observation and ground truth.