diff --git a/src/sensors/softfusion/CalibrationBase.h b/src/sensors/softfusion/CalibrationBase.h index e5c4b574..1f6e3df9 100644 --- a/src/sensors/softfusion/CalibrationBase.h +++ b/src/sensors/softfusion/CalibrationBase.h @@ -82,6 +82,7 @@ class CalibrationBase { virtual void scaleGyroSample(sensor_real_t gyroSample[3]) = 0; virtual float getGyroTimestep() = 0; + virtual float getMagTimestep() = 0; virtual float getTempTimestep() = 0; @@ -100,7 +101,7 @@ class CalibrationBase { IMU::SensorVQFParams, getGyroTimestep(), getAccelTimestep(), - getTempTimestep() + getMagTimestep() ); } diff --git a/src/sensors/softfusion/SoftfusionCalibration.h b/src/sensors/softfusion/SoftfusionCalibration.h index b4b7850b..2e174c32 100644 --- a/src/sensors/softfusion/SoftfusionCalibration.h +++ b/src/sensors/softfusion/SoftfusionCalibration.h @@ -231,6 +231,7 @@ class SoftfusionCalibrator : public CalibrationBase { } float getGyroTimestep() final { return calibration.G_Ts; } + float getMagTimestep() final { return calibration.M_Ts; } float getTempTimestep() final { return calibration.T_Ts; } diff --git a/src/sensors/softfusion/runtimecalibration/RuntimeCalibration.h b/src/sensors/softfusion/runtimecalibration/RuntimeCalibration.h index 0fa1a530..a27ea5d1 100644 --- a/src/sensors/softfusion/runtimecalibration/RuntimeCalibration.h +++ b/src/sensors/softfusion/runtimecalibration/RuntimeCalibration.h @@ -179,6 +179,7 @@ class RuntimeCalibrator : public Sensors::CalibrationBase { } float getGyroTimestep() final { return activeCalibration.G_Ts; } + float getMagTimestep() final { return activeCalibration.M_Ts; } float getTempTimestep() final { return activeCalibration.T_Ts; }