7.4.4 Introduction to the Kalman Filter-Smoother

PREDICTION



Initial State Vector

The state vector contains some of the parameters needed to describe the system. For kinematic applications its main components are usually position (and perhaps velocity). Additional parameters can be included, depending on the task and data at hand. At time t0, the state vector and its variance-covariance matrix are represented by and Q. Knowledge of the initial state vector may have been derived from measurements, or it is the result of a previous (filter) adjustment.

	

Kinematic Model

To express the kinematic behaviour of the system between two epochs, a kinematic model is defined by a linear relation between the system parameters at two different epochs:

(7.4-1)

where:

is the state vector at time t0,
x is the state vector at time t,
F is the transition matrix, and
w is the system noise.

The noise term w expresses the possible deviations from the defined trajectory of the vehicle between two epochs and is assumed to have mean zero and variance-covariance Qww. The term "dynamic" is also commonly used, but "kinematic" is preferred here, because the underlying forces governing the behaviour of the system do not appear explicitly in the model.

	

Parametric Expression

Implicit in the kinematic model is the capability to estimate the state vector at future epochs. If x has been estimated at time t0, as w has mean zero, the predicted value at time t is simply:

(7.4-2)

According to the Law of Propagation of Variances, and assuming that and w are independent, the variance-covariance matrix of the predicted estimate is:

(7.4-3)

The predicted estimate of the state vector can be regarded as an observation of its true value, with random error vx and weight P = Q-1:

(7.4-4a)

It is tempting, and usually possible, to choose = , thus reducing eqn (7.4-4) to = - vx, however such a substitution can be considered as a particular case of a more general result. Nevertheless, eqn (7.4-4) can be slightly modified:

(7.4-4b)

	

Back To Chapter 7 Contents / Next Topic / Previous Topic

© Chris Rizos, SNAP-UNSW, 1999