model

SLAM.Mapping.RGBDAnchoredLandmarkMap

Public declarations

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

Role	Name	Type	Dimensions / attributes / default
constant	`imageHeight`	`Integer`	`= 90`
constant	`imageWidth`	`Integer`	`= 160`
constant	`mapCapacity`	`Integer`	`= imageHeight*imageWidth`
constant	`featureCapacity`	`Integer`	`= 350`
constant	`keyframeCapacity`	`Integer`	`= 128`
constant	`dimension`	`Integer`	`= 3`
parameter	`coordinateLimit`	`Real`	`= 1e6`
parameter	`voxelWidth`	`Real`	`= 0.25`
parameter	`mergeRadius`	`Real`	`= 0.15`
parameter	`maximumDistance`	`Real`	`= 80.0`
parameter	`tentativeLifetime`	`Real`	`= 0.5`
parameter	`confirmedLifetime`	`Real`	`= 5.0`
parameter	`confirmationObservations`	`Real`	`= 3.0`
parameter	`maximumConfidence`	`Real`	`= 8.0`
parameter	`maximumTentative`	`Real`	`= 700.0`
parameter	`consistencyTolerance`	`Real`	`= 1e-6`
input	`previousPoint`	`Real`	`[mapCapacity,dimension] = zeros(mapCapacity,dimension)`
input	`previousOccupied`	`Real`	`[mapCapacity] = zeros(mapCapacity)`
input	`previousConfidence`	`Real`	`[mapCapacity] = zeros(mapCapacity)`
input	`previousLastSeen`	`Real`	`[mapCapacity] = zeros(mapCapacity)`
input	`previousLastFrame`	`Real`	`[mapCapacity] = zeros(mapCapacity)`
input	`candidatePoint`	`Real`	`[featureCapacity,dimension] = zeros(featureCapacity,dimension)`
input	`candidateEnabled`	`Real`	`[featureCapacity] = zeros(featureCapacity)`
input	`candidateCount`	`Real`	`= 0.0`
input	`bodyPosition`	`Real`	`[dimension] = zeros(dimension)`
input	`poseAccepted`	`Real`	`= 1.0`
input	`previousTime`	`Real`	`= 0.0`
input	`timeNow`	`Real`	`= 0.0`
input	`previousFrame`	`Real`	`= 0.0`
input	`frameNow`	`Real`	`= 1.0`
input	`previousWorldFrame`	`Real`	`= 0.0`
input	`worldFrame`	`Real`	`= 0.0`
input	`resetRequested`	`Real`	`= 0.0`
input	`previousLocalPoint`	`Real`	`[mapCapacity,dimension] = zeros(mapCapacity,dimension)`
input	`previousAnchorId`	`Integer`	`[mapCapacity] = fill(0,mapCapacity)`
input	`previousAnchorSlot`	`Integer`	`[mapCapacity] = fill(0,mapCapacity)`
input	`previousGeneration`	`Integer`	`= 1`
input	`nodeEnabled`	`Boolean`	`[keyframeCapacity] = fill(false,keyframeCapacity)`
input	`nodeId`	`Integer`	`[keyframeCapacity] = fill(0,keyframeCapacity)`
input	`nodePosition`	`Real`	`[keyframeCapacity,dimension] = zeros(keyframeCapacity,dimension)`
input	`nodeRotation`	`Real`	`[keyframeCapacity,dimension,dimension] = zeros(keyframeCapacity,dimension,dimension)`
input	`catalogGeneration`	`Integer`	`= 1`
input	`generation`	`Integer`	`= 1`
input	`selectedAnchorId`	`Integer`	`= 0`
input	`selectedAnchorSlot`	`Integer`	`= 0`
input	`requested`	`Boolean`	`= true`
output	`point`	`Real`	`[mapCapacity,dimension]`
output	`occupied`	`Real`	`[mapCapacity]`
output	`confidence`	`Real`	`[mapCapacity]`
output	`lastSeen`	`Real`	`[mapCapacity]`
output	`lastFrame`	`Real`	`[mapCapacity]`
output	`confirmed`	`Real`	`[mapCapacity]`
output	`accepted`	`Real`
output	`rejectionReason`	`Real`
output	`nextTime`	`Real`
output	`nextFrame`	`Real`
output	`nextWorldFrame`	`Real`
output	`occupiedCount`	`Real`
output	`confirmedCount`	`Real`
output	`tentativeCount`	`Real`
output	`insertedCount`	`Real`
output	`mergedCount`	`Real`
output	`prunedCount`	`Real`
output	`droppedCount`	`Real`
output	`invalidCandidateCount`	`Real`
output	`localPoint`	`Real`	`[mapCapacity,dimension]`
output	`anchorId`	`Integer`	`[mapCapacity]`
output	`anchorSlot`	`Integer`	`[mapCapacity]`
output	`nextGeneration`	`Integer`
output	`mapRejectionReason`	`Real`
output	`anchorRejectionReason`	`Integer`
output	`assignedCount`	`Integer`
output	`retainedCount`	`Integer`
output	`clearedCount`	`Integer`

Modelica declarations and implementation

Show parameters, interfaces and source

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

model RGBDAnchoredLandmarkMap
  import UpdateAnchoredLandmarkMap = SLAM.Mapping.UpdateAnchoredLandmarkMap;

  constant Integer imageHeight = 90; constant Integer imageWidth = 160;
  constant Integer mapCapacity = imageHeight*imageWidth;
  constant Integer featureCapacity = 350; constant Integer keyframeCapacity = 128;
  constant Integer dimension = 3;
  parameter Real coordinateLimit = 1e6; parameter Real voxelWidth = 0.25;
  parameter Real mergeRadius = 0.15; parameter Real maximumDistance = 80.0;
  parameter Real tentativeLifetime = 0.5; parameter Real confirmedLifetime = 5.0;
  parameter Real confirmationObservations = 3.0; parameter Real maximumConfidence = 8.0;
  parameter Real maximumTentative = 700.0; parameter Real consistencyTolerance = 1e-6;
  input Real previousPoint[mapCapacity,dimension] = zeros(mapCapacity,dimension);
  input Real previousOccupied[mapCapacity] = zeros(mapCapacity);
  input Real previousConfidence[mapCapacity] = zeros(mapCapacity);
  input Real previousLastSeen[mapCapacity] = zeros(mapCapacity);
  input Real previousLastFrame[mapCapacity] = zeros(mapCapacity);
  input Real candidatePoint[featureCapacity,dimension] = zeros(featureCapacity,dimension);
  input Real candidateEnabled[featureCapacity] = zeros(featureCapacity); input Real candidateCount = 0.0;
  input Real bodyPosition[dimension] = zeros(dimension); input Real poseAccepted = 1.0;
  input Real previousTime = 0.0; input Real timeNow = 0.0;
  input Real previousFrame = 0.0; input Real frameNow = 1.0;
  input Real previousWorldFrame = 0.0; input Real worldFrame = 0.0; input Real resetRequested = 0.0;
  input Real previousLocalPoint[mapCapacity,dimension] = zeros(mapCapacity,dimension);
  input Integer previousAnchorId[mapCapacity] = fill(0,mapCapacity);
  input Integer previousAnchorSlot[mapCapacity] = fill(0,mapCapacity); input Integer previousGeneration = 1;
  input Boolean nodeEnabled[keyframeCapacity] = fill(false,keyframeCapacity);
  input Integer nodeId[keyframeCapacity] = fill(0,keyframeCapacity);
  input Real nodePosition[keyframeCapacity,dimension] = zeros(keyframeCapacity,dimension);
  input Real nodeRotation[keyframeCapacity,dimension,dimension] = zeros(keyframeCapacity,dimension,dimension);
  input Integer catalogGeneration = 1; input Integer generation = 1;
  input Integer selectedAnchorId = 0; input Integer selectedAnchorSlot = 0; input Boolean requested = true;
  output Real point[mapCapacity,dimension]; output Real occupied[mapCapacity];
  output Real confidence[mapCapacity]; output Real lastSeen[mapCapacity]; output Real lastFrame[mapCapacity];
  output Real confirmed[mapCapacity]; output Real accepted; output Real rejectionReason;
  output Real nextTime; output Real nextFrame; output Real nextWorldFrame;
  output Real occupiedCount; output Real confirmedCount; output Real tentativeCount;
  output Real insertedCount; output Real mergedCount; output Real prunedCount;
  output Real droppedCount; output Real invalidCandidateCount;
  output Real localPoint[mapCapacity,dimension]; output Integer anchorId[mapCapacity];
  output Integer anchorSlot[mapCapacity]; output Integer nextGeneration;
  output Real mapRejectionReason; output Integer anchorRejectionReason;
  output Integer assignedCount; output Integer retainedCount; output Integer clearedCount;
equation
  (point,occupied,confidence,lastSeen,lastFrame,confirmed,accepted,rejectionReason,nextTime,nextFrame,nextWorldFrame,
    occupiedCount,confirmedCount,tentativeCount,insertedCount,mergedCount,prunedCount,droppedCount,invalidCandidateCount,
    localPoint,anchorId,anchorSlot,nextGeneration,mapRejectionReason,anchorRejectionReason,
    assignedCount,retainedCount,clearedCount) = UpdateAnchoredLandmarkMap(
      previousPoint,previousOccupied,previousConfidence,previousLastSeen,previousLastFrame,candidatePoint,candidateEnabled,
      candidateCount,bodyPosition,poseAccepted,previousTime,timeNow,previousFrame,frameNow,previousWorldFrame,worldFrame,resetRequested,
      coordinateLimit,voxelWidth,mergeRadius,maximumDistance,tentativeLifetime,confirmedLifetime,confirmationObservations,
      maximumConfidence,maximumTentative,previousLocalPoint,previousAnchorId,previousAnchorSlot,previousGeneration,
      nodeEnabled,nodeId,nodePosition,nodeRotation,catalogGeneration,generation,selectedAnchorId,selectedAnchorSlot,
      requested,consistencyTolerance);
end RGBDAnchoredLandmarkMap;