CT Kalman Filter Outline: KF State Equation. Kalman Gain. Error Covariance. Riccati Equation
CT Kalman Filter Outline: KF State Equation. Kalman Gain. Error Covariance. Riccati Equation
CT Kalman Filter Outline: KF State Equation. Kalman Gain. Error Covariance. Riccati Equation
1 2
• Data: 3 4
Orthogonality Principle Apply Orthogonality
5
Evaluate the RHS next 6
Solution
Multiply by
, for
Orthogonality
9 10
,0 0 ,0 , ,
,0 0 ,0 , ,
,0 0 ,0 , ,
11 12
Error Dynamics Error Covariance: Lyapunov Eq.
P t F (t ) K (t ) H (t )Pt
Pt F (t ) K (t ) H (t )
T
G (t )QG T (t ) K (t ) RK T (t )
13 14
15 16
Steady-state Filter Example: Steady-state Filter
Consider the equation of motion
0 1 p1 p2 p1 p2 0 0 0 ⁄
q0 1
0 0 p2 p3 p2 p3 1 0 1 ⁄
p p2 1 1 p1 p2
1 1 0
The term is needed to calculate the
p2 p3 0 r p2 p3 steady-state square error (trace of )
0 2 p2 p12 r , 0 p3 p1 p2 r
0 q p22 r
19 20
Reference
21