Model formulation
We consider a linear dynamical system with additive Gaussian noise:
where:
- is the state vector at time step ,
- is an optional control input,
- is the measurement vector,
- is the state transition matrix,
- is the control-input matrix,
- is the observation matrix,
- is the process noise covariance,
- is the measurement noise covariance.
Kalman filtering
The Kalman filter maintains the mean and covariance of the posterior distribution under the Gaussian assumption.
Prediction step
Given the previous posterior :
Here, are the predicted state mean and covariance.
Update step
With a new measurement :
- Innovation (measurement residual):
- Innovation covariance:
- Kalman gain:
- Updated mean and covariance:
The filter proceeds recursively for each time step.