CogniPilot

MODELICA LIBRARY · ENGINEERING REFERENCE

model

SLAM.Inertial.SchmidtReferencePrediction

Public declarations

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

RoleNameTypeDimensions / attributes / defaultDescription
constantcurrentDimensionInteger= 15
constantreferenceDimensionInteger= 6
inputcovarianceReal[currentDimension,currentDimension]
inputcrossCovarianceReal[currentDimension,referenceDimension]
inputreferenceCovarianceReal[referenceDimension,referenceDimension]
inputtransitionReal[currentDimension,currentDimension] = identity(currentDimension)
inputprocessCovarianceReal[currentDimension,currentDimension] = zeros(currentDimension,currentDimension)
inputreferenceAvailableReal= 0.0
inputpredictionEnabledReal= 1.0
outputacceptedReal
outputnextCovarianceReal[currentDimension,currentDimension]
outputnextCrossCovarianceReal[currentDimension,referenceDimension]
outputnextReferenceCovarianceReal[referenceDimension,referenceDimension]

Modelica declarations and implementation

Show parameters, interfaces and source

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

model SchmidtReferencePrediction
  import SchmidtPredictCovariance = SLAM.Inertial.SchmidtPredictCovariance;

  constant Integer currentDimension = 15;
  constant Integer referenceDimension = 6;
  input Real covariance[currentDimension,currentDimension];
  input Real crossCovariance[currentDimension,referenceDimension];
  input Real referenceCovariance[referenceDimension,referenceDimension];
  input Real transition[currentDimension,currentDimension] = identity(currentDimension);
  input Real processCovariance[currentDimension,currentDimension] = zeros(currentDimension,currentDimension);
  input Real referenceAvailable = 0.0;
  input Real predictionEnabled = 1.0;
  output Real accepted;
  output Real nextCovariance[currentDimension,currentDimension];
  output Real nextCrossCovariance[currentDimension,referenceDimension];
  output Real nextReferenceCovariance[referenceDimension,referenceDimension];
algorithm
  (accepted,nextCovariance,nextCrossCovariance,nextReferenceCovariance)
    := SchmidtPredictCovariance(covariance,crossCovariance,referenceCovariance,
      transition,processCovariance,referenceAvailable,predictionEnabled);
end SchmidtReferencePrediction;