CogniPilot

MODELICA LIBRARY · ENGINEERING REFERENCE

function

Estimation.FusionHorizon.packMagnetometer

Flatten one magnetometer sample into a queue row

Public declarations

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

RoleNameTypeDimensions / attributes / defaultDescription
inputmeasurementAvionics.MagnetometerSample
outputrowReal[MagnetometerMeasurementLength]

Modelica declarations and implementation

Show parameters, interfaces and source

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

function packMagnetometer "Flatten one magnetometer sample into a queue row"
  input Avionics.MagnetometerSample measurement;
  output Real row[MagnetometerMeasurementLength];
algorithm
  row := cat(1,
    {measurement.timestamp_s},
    measurement.magneticFieldBodyFlu_T,
    measurement.covarianceBody_T2[1, :],
    measurement.covarianceBody_T2[2, :],
    measurement.covarianceBody_T2[3, :]);
end packMagnetometer;