diff --git a/libraries/AP_Compass/CompassCalibrator.cpp b/libraries/AP_Compass/CompassCalibrator.cpp index 031fa0a006..3a472a7aeb 100644 --- a/libraries/AP_Compass/CompassCalibrator.cpp +++ b/libraries/AP_Compass/CompassCalibrator.cpp @@ -780,6 +780,9 @@ bool CompassCalibrator::calculate_orientation(void) return true; } + // this function is very slow + hal.scheduler->expect_delay_ms(1000); + float variance[ROTATION_MAX] {}; for (enum Rotation r = ROTATION_NONE; rexpect_delay_ms(0); + if (!pass) { set_status(COMPASS_CAL_BAD_ORIENTATION); return false;