Parameters
Matrix<double>
x0
Initial state estimate.
Matrix<double>
P0
Covariance of initial state estimate.
Square root filtering is designed to produce more stable covariance matrices by performing decomposition of the covariance matrix to ensure that roundoff errors do not occur.This particular implementation stores the covariance in a UDU' decomposed form, and uses a Thornton UD update and a Bierman observational update algorithm. This means that there are no square roots performed as part of this.
Matrix<double>
x0Initial state estimate.
Matrix<double>
P0Covariance of initial state estimate.
Matrix<double>
FState transition matrix.
Matrix<double>
FState transition matrix.
Matrix<double>
GNoise coupling matrix.
Matrix<double>
QNoise covariance matrix.
Matrix
to describe the noise of the system.
Matrix<double>
zThe measurements of the system.
Matrix<double>
HMeasurement model.
Matrix<double>
RCovariance of measurements.