CogniPilot

MODELICA LIBRARY · ENGINEERING REFERENCE

model

SLAM.LoopClosure.RGBDBodyRelativeEdge

Public declarations

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

RoleNameTypeDimensions / attributes / defaultDescription
parametercoordinateLimitReal= 100.0
parameterminimumPivotReal= 1e-10
inputcurrentFromReferenceReal[3,3] = identity(3)
inputopticalTranslationReal[3] = zeros(3)
inputopticalCovarianceReal[6,6] = identity(6)
inputreferenceOpticalToBodyReal[3,3] = identity(3)
inputcurrentOpticalToBodyReal[3,3] = identity(3)
inputreferenceCameraOriginReal[3] = zeros(3)
inputcurrentCameraOriginReal[3] = zeros(3)
inputrequestedBoolean= false
outputmeasuredRotationReal[3,3]
outputmeasuredTranslationReal[3]
outputresidualJacobianReal[6,6]
outputresidualCovarianceReal[6,6]
outputinformationReal[6,6]
outputvalidBoolean
outputrejectionReasonInteger
outputminimumScaledPivotReal

Modelica declarations and implementation

Show parameters, interfaces and source

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

model RGBDBodyRelativeEdge
  import RGBDOpticalToBodyEdge = SLAM.LoopClosure.RGBDOpticalToBodyEdge;

  parameter Real coordinateLimit = 100.0;
  parameter Real minimumPivot = 1e-10;
  input Real currentFromReference[3,3] = identity(3);
  input Real opticalTranslation[3] = zeros(3);
  input Real opticalCovariance[6,6] = identity(6);
  input Real referenceOpticalToBody[3,3] = identity(3);
  input Real currentOpticalToBody[3,3] = identity(3);
  input Real referenceCameraOrigin[3] = zeros(3);
  input Real currentCameraOrigin[3] = zeros(3);
  input Boolean requested = false;
  output Real measuredRotation[3,3]; output Real measuredTranslation[3];
  output Real residualJacobian[6,6]; output Real residualCovariance[6,6];
  output Real information[6,6]; output Boolean valid;
  output Integer rejectionReason; output Real minimumScaledPivot;
equation
  (measuredRotation,measuredTranslation,residualJacobian,residualCovariance,
    information,valid,rejectionReason,minimumScaledPivot) = RGBDOpticalToBodyEdge(
      currentFromReference,opticalTranslation,opticalCovariance,
      referenceOpticalToBody,currentOpticalToBody,referenceCameraOrigin,
      currentCameraOrigin,requested,coordinateLimit,minimumPivot);
end RGBDBodyRelativeEdge;