CogniPilot

MODELICA LIBRARY · ENGINEERING REFERENCE

function

LinearAlgebra.josephUpdate

Dimension-generic Joseph-form covariance correction

Public declarations

Explicit source declarations; dimensions, modifications and defaults are shown as written, without evaluation.

RoleNameTypeDimensions / attributes / defaultDescription
inputfactorReal[:, size(factor, 1)]I - K*H
inputcovarianceReal[size(factor, 1), size(factor, 1)]Predicted covariance
inputgainReal[size(factor, 1), :]Kalman gain
inputmeasurementNoiseReal[size(gain, 2), size(gain, 2)]Measurement covariance
outputcovarianceNextReal[size(factor, 1), size(factor, 1)]

Modelica declarations and implementation

Show parameters, interfaces and source

Parameters, inputs, outputs, defaults and equations from the source file.

function josephUpdate "Dimension-generic Joseph-form covariance correction"
  input Real factor[:, size(factor, 1)] "I - K*H";
  input Real covariance[size(factor, 1), size(factor, 1)]
    "Predicted covariance";
  input Real gain[size(factor, 1), :] "Kalman gain";
  input Real measurementNoise[size(gain, 2), size(gain, 2)]
    "Measurement covariance";
  output Real covarianceNext[size(factor, 1), size(factor, 1)];
algorithm
  covarianceNext := transformCovariance(factor, covariance)
    + transformCovariance(gain, measurementNoise);
end josephUpdate;