diff --git a/ArduCopter/motors.cpp b/ArduCopter/motors.cpp index a2f135a56c..6955d98d61 100644 --- a/ArduCopter/motors.cpp +++ b/ArduCopter/motors.cpp @@ -222,9 +222,13 @@ void Copter::init_disarm_motors() #endif // save compass offsets learned by the EKF - Vector3f magOffsets; - if (ahrs.use_compass() && ahrs.getMagOffsets(magOffsets)) { - compass.set_and_save_offsets(compass.get_primary(), magOffsets); + if (ahrs.use_compass()) { + for(uint8_t i=0; i