In this post, we explain how the expected value of the state vector and state covariance matrix of linear dynamical systems are propagated in discrete-time. These equations, together with the equations describing the recursive least squares method which are derived in our previous post, are important for deriving the Kalman filter equations.
Linear Dynamical System Affected by the Process Noise (Disturbances)
We are considering the following state equation
(1)
where
is the state vector is the control input vector is the disturbance or process noise vector. We assume that is Gaussian, zero-mean, white noise with the covariance matrix given by , where is the mathematical expectation operator. and are state and input matrices.
A few comments are in order. If the system is time-invariant, then the matrices
State Vector Expectation Propagation
Let us apply the expectation operator to the equation (1), as the result, we obtain
(2)
For notation brevity, we introduce the following notation
(3)
Taking into account that
(4)
State Covariance Matrix Propagation
We define the state covariance matrix as follows
(5)
Consequently, we first need to expand this expression
(6)
and then compute the expectation of every term in that expression. By substituting the equations (1) and (4) in (10), we obtain
(7)
Since
(8)
Also, we have
(9)
(10)
By using these expressions, and by taking the expectation of (7), we obtain the final equation for the propagation of the state covariance matrix
(11)