Keyboard shortcuts

Press or to navigate between chapters

Press S or / to search in the book

Press ? to show this help

Press Esc to hide this help

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.