AP_Compass: use ahrs for location instead of GPS directly for calibration

This commit is contained in:
Willian Galvani 2024-07-01 21:38:13 -03:00 committed by Andrew Tridgell
parent df0b4cdf6d
commit 325d6f6c94
1 changed files with 2 additions and 2 deletions

View File

@ -1065,14 +1065,14 @@ bool CompassCalibrator::calculate_orientation(void)
*/
bool CompassCalibrator::fix_radius(void)
{
if (AP::gps().status() < AP_GPS::GPS_OK_FIX_2D) {
Location loc;
if (!AP::ahrs().get_location(loc) && !AP::ahrs().get_origin(loc)) {
// we don't have a position, leave scale factor as 0. This
// will disable use of WMM in the EKF. Users can manually set
// scale factor after calibration if it is known
_params.scale_factor = 0;
return true;
}
const Location &loc = AP::gps().location();
float intensity;
float declination;
float inclination;