Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-08 17:08:28 -04:00
Code Issues Packages Projects Releases Wiki Activity

AP_Compass: do not use GSF if any model has been clipped

Browse Source
This commit is contained in:
Peter Barker 2022-05-10 11:28:33 +10:00 committed by Randy Mackay
parent 7a7d7f91ef
commit 5f39602d8c
1 changed files with 3 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

4
libraries/AP_Compass/Compass_learn.cpp
View File

@ -51,8 +51,10 @@ void CompassLearn::update(void)
AP_Notify::flags.compass_cal_running = true;
ftype yaw_rad, yaw_variance;
if (!gsf->getYawData(yaw_rad, yaw_variance) ||
uint8_t n_clips;
if (!gsf->getYawData(yaw_rad, yaw_variance, &n_clips) ||
!is_positive(yaw_variance) ||
n_clips > 1 ||
yaw_variance >= sq(radians(YAW_ACCURACY_THRESHOLD_DEG))) {
// not converged
return;