functionkfStepMatrices

One step, i.e. prediction and update of a kalman filter iteration for discrete systems

Extends from Modelica.Icons.Function (Icon for functions).

Inputs

TypeNameDefaultDescription
Real[:,size(A, 1)]ATransition matrix of the discrete system
Real[size(A, 1),:]BInput matrix of the discrete system
Real[:,size(A, 1)]COutput matrix of the discrete system
Real[size(A, 1),size(A, 1)]PState covariance matrix of the previous instant
Real[size(B, 2),size(B, 2)]QInput or process noise covariance matrix of the previous instant
Real[size(C, 1),size(C, 1)]ROutput or measurement noise covariance matrix of the previous instant

Outputs

TypeNameDefaultDescription
Real[size(A, 1),size(C, 1)]KP*transpose(C)Kalman filter gain matrix
Real[size(A, 1),size(A, 1)]P_newUpdated state covariance matrix
Real[size(C, 1),size(C, 1)]UMutriSquare root (left Cholesky factor) of the covariance matrix M
Real[size(C, 1),size(C, 1)]M
Real[size(A, 1),size(C, 1)]PCT