naginterfaces.library.tsa.multi_​kalman_​sqrt_​var

naginterfaces.library.tsa.multi_kalman_sqrt_var(a, b, stq, q, c, r, s, tol=0.0)

multi_kalman_sqrt_var performs a combined measurement and time update of one iteration of the time-varying Kalman filter using a square root covariance filter.

For full information please refer to the NAG Library document for g13ea

https://support.nag.com/numeric/nl/nagdoc_30.3/flhtml/g13/g13eaf.html

Parameters

afloat, array-like, shape $(n,n)$

The state transition matrix, $A_i$.

bfloat, array-like, shape $(n,l)$

The noise coefficient matrix $B_i$.

stqbool

If $stq=True$, the state noise covariance matrix $Q_i$ is assumed to be the identity matrix. Otherwise the lower triangular Cholesky factor, $Q_i^{1/2}$, must be provided in $q$.

qfloat, array-like, shape $(:,:)$

Note: the required extent for this argument in dimension 1 is determined as follows: if $not\left(stq\right)$: $l$; otherwise: $1$.

Note: the required extent for this argument in dimension 2 is determined as follows: if $not\left(stq\right)$: $l$; otherwise: $0$.

If $stq=False$, $q$ must contain the lower triangular Cholesky factor of the state noise covariance matrix, $Q_i^{1/2}$. Otherwise $q$ is not referenced.

cfloat, array-like, shape $(m,n)$

The measurement coefficient matrix, $C_i$.

rfloat, array-like, shape $(m,m)$

The lower triangular Cholesky factor of the measurement noise covariance matrix $R_i^{1/2}$.

sfloat, array-like, shape $(n,n)$

The lower triangular Cholesky factor of the state covariance matrix, $S_i$.

tolfloat, optional

The tolerance used to test for the singularity of $H_i^{1/2}$. If $0.0\le tol<m^2\times \text{machine precision}$, then $m^2\times \text{machine precision}$ is used instead. The inverse of the condition number of $H^{1/2}$ is estimated by a call to lapacklin.dtrcon. If this estimate is less than $tol$ then $H^{1/2}$ is assumed to be singular.

Returns

sfloat, ndarray, shape $(n,n)$

The lower triangular Cholesky factor of the state covariance matrix, $S_{i+1}$.

kfloat, ndarray, shape $(n,m)$

The Kalman gain matrix, $K_i$, premultiplied by the state transition matrix, $A_i$, $A_i{K}_i$.

hfloat, ndarray, shape $(m,m)$

The lower triangular matrix $H_i^{1/2}$.

Raises

NagValueError

(errno $1$)

On entry, $tol=⟨value⟩$.

Constraint: $tol\ge 0.0$.

(errno $1$)

On entry, $l=⟨value⟩$.

Constraint: $l\ge 1$.

(errno $1$)

On entry, $m=⟨value⟩$.

Constraint: $m\ge 1$.

(errno $1$)

On entry, $n=⟨value⟩$.

Constraint: $n\ge 1$.

(errno $2$)

The matrix $H_i^{1/2}$ is singular.

Notes

In the NAG Library the traditional C interface for this routine uses a different algorithmic base. Please contact NAG if you have any questions about compatibility.

The Kalman filter arises from the state space model given by:

$$\begin{array}{c}\begin{array}{cc}{X}_{i+1}=A_i{X}_i+B_i{W}_i\text{,}& Var\left(W_i\right)=Q_i\\ & \\ Y_i=C_i{X}_i+V_i\text{,}& Var\left(V_i\right)=R_i\end{array}\end{array}$$

where $X_i$ is the state vector of length $n$ at time $i$, $Y_i$ is the observation vector of length $m$ at time $i$, and $W_i$ of length $l$ and $V_i$ of length $m$ are the independent state noise and measurement noise respectively.

The estimate of $X_i$ given observations $Y_1$ to $Y_{i-1}$ is denoted by ${\hat{X}}_{i|i-1}$ with state covariance matrix $Var\left({\hat{X}}_{i|i-1}\right)=P_{i|i-1}=S_i{S}_i^T$, while the estimate of $X_i$ given observations $Y_1$ to $Y_i$ is denoted by ${\hat{X}}_{i|i}$ with covariance matrix $Var\left({\hat{X}}_{i|i}\right)=P_{i|i}$. The update of the estimate, ${\hat{X}}_{i|i-1}$, from time $i$ to time $(i+1)$, is computed in two stages. First, the measurement-update is given by

$${\hat{X}}_{i|i}={\hat{X}}_{i|i-1}+K_i[Y_i-C_i{\hat{X}}_{i|i-1}]$$

and

$$P_{i|i}=[I-K_i{C}_i]P_{i|i-1}$$

where $K_i=P_{i|i-1}{C}_i^T{[C_i{P}_{i|i-1}{C}_i^T+R_i]}^{-1}$ is the Kalman gain matrix. The second stage is the time-update for $X$ which is given by

$${\hat{X}}_{i+1|i}=A_i{\hat{X}}_{i|i}+D_i{U}_i$$

and

$$P_{i+1|i}=A_i{P}_{i|i}{A}_i^T+B_i{Q}_i{B}_i^T$$

where $D_i{U}_i$ represents any deterministic control used.

The square root covariance filter algorithm provides a stable method for computing the Kalman gain matrix and the state covariance matrix. The algorithm can be summarised as

$$\begin{array}{c}\left(\begin{array}{ccc}{R}_i^{1/2}& C_i{S}_i& 0\\ & & \\ 0& A_i{S}_i& B_i{Q}_i^{1/2}\end{array}\right)U=\left(\begin{array}{ccc}{H}_i^{1/2}& 0& 0\\ & & \\ G_i& S_{i+1}& 0\end{array}\right)\end{array}$$

where $U$ is an orthogonal transformation triangularizing the left-hand pre-array to produce the right-hand post-array. The relationship between the Kalman gain matrix, $K_i$, and $G_i$ is given by

$$A_i{K}_i=G_i{\left(H_i^{1/2}\right)}^{-1}\text{.}$$

multi_kalman_sqrt_var requires the input of the lower triangular Cholesky factors of the noise covariance matrices $R_i^{1/2}$ and, optionally, $Q_i^{1/2}$ and the lower triangular Cholesky factor of the current state covariance matrix, $S_i$, and returns the product of the matrices $A_i$ and $K_i$, $A_i{K}_i$, the Cholesky factor of the updated state covariance matrix $S_{i+1}$ and the matrix $H_i^{1/2}$ used in the computation of the likelihood for the model.

References

Vanbegin, M, van Dooren, P and Verhaegen, M H G, 1989, Algorithm 675: FORTRAN subroutines for computing the square root covariance filter and square root information filter in dense or Hessenberg forms, ACM Trans. Math. Software (15), 243–256

Verhaegen, M H G and van Dooren, P, 1986, Numerical aspects of different Kalman filter implementations, IEEE Trans. Auto. Contr. (AC-31), 907–917