aepko/Ardupilot2
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

AP_Compass: set AP_Notify::compass_cal_failed

Browse Source
This commit is contained in:
Jonathan Challinger 2015-03-18 17:49:08 -07:00 committed by Andrew Tridgell
parent 5a12991d29
commit 5ef713f3db
1 changed files with 9 additions and 4 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

13
libraries/AP_Compass/AP_Compass_Calibration.cpp
View File

@ -8,14 +8,19 @@ Compass::compass_cal_update()
{
AP_Notify::flags.compass_cal_running = 0;
for(uint8_t i=0; i<COMPASS_MAX_INSTANCES; i++) {
_calibrator[i].run_fit_chunk();
for (uint8_t i=0; i<COMPASS_MAX_INSTANCES; i++) {
bool failure;
_calibrator[i].update(failure);
if (failure) {
AP_Notify::events.compass_cal_failed = 1;
}
if(_calibrator[i].check_for_timeout()) {
if (_calibrator[i].check_for_timeout()) {
AP_Notify::events.compass_cal_failed = 1;
cancel_calibration_all();
}
if(_calibrator[i].running()) {
if (_calibrator[i].running()) {
AP_Notify::flags.compass_cal_running = 1;
}
}