public void Update(UasRawImu offsets, DOFSensorType sensorType)
{
switch (sensorType)
{
case DOFSensorType.Accelerometer:
X = offsets.Xacc;
Y = offsets.Yacc;
Z = offsets.Zacc;
break;
case DOFSensorType.Gyro:
X = offsets.Xgyro;
Y = offsets.Ygyro;
Z = offsets.Zgyro;
break;
case DOFSensorType.Magnometer:
X = offsets.Xmag;
Y = offsets.Ymag;
Z = offsets.Zmag;
break;
}
}
public void Update(UasSensorOffsets offsets, DOFSensorType sensorType)
{
switch (sensorType)
{
case DOFSensorType.Accelerometer:
OffsetX = offsets.AccelCalX;
OffsetY = offsets.AccelCalY;
OffsetZ = offsets.AccelCalZ;
break;
case DOFSensorType.Gyro:
OffsetX = offsets.GyroCalX;
OffsetY = offsets.GyroCalY;
OffsetZ = offsets.GyroCalZ;
break;
case DOFSensorType.Magnometer:
MagneticDeclination = offsets.MagDeclination;
OffsetX = offsets.MagOfsX;
OffsetY = offsets.MagOfsY;
OffsetZ = offsets.MagOfsZ;
break;
}
}
