function

Estimation.FusionHorizon.unpackMagnetometer

Expand one magnetometer queue row into connector fields

Public declarations

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

Role	Name	Type	Dimensions / attributes / default
input	`row`	`Real`	`[MagnetometerMeasurementLength]`
output	`timestamp_s`	`Real`
output	`magneticFieldBodyFlu_T`	`Real`	`[3]`
output	`covarianceBody_T2`	`Real`	`[3, 3]`

Modelica declarations and implementation

Show parameters, interfaces and source

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

function unpackMagnetometer
  "Expand one magnetometer queue row into connector fields"
  input Real row[MagnetometerMeasurementLength];
  output Real timestamp_s;
  output Real magneticFieldBodyFlu_T[3];
  output Real covarianceBody_T2[3, 3];
algorithm
  timestamp_s := row[1];
  magneticFieldBodyFlu_T := row[2:4];
  covarianceBody_T2 :=
    [row[5], row[6], row[7];
     row[8], row[9], row[10];
     row[11], row[12], row[13]];
end unpackMagnetometer;