Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

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
parent b172f086de
commit ad3a3aefae
1 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
libraries/AP_Compass/CompassCalibrator.cpp
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;