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

Copter: add CAL_ALWAYS_REBOOT option

This commit is contained in:
Jonathan Challinger 2016-01-05 16:23:16 -08:00 committed by Randy Mackay
parent 60bd7de2d7
commit d916413a15
1 changed files with 13 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

13
ArduCopter/sensors.cpp
View File

@ -179,6 +179,12 @@ void Copter::compass_cal_update()
if (!hal.util->get_soft_armed()) {
compass.compass_cal_update();
}
#ifdef CAL_ALWAYS_REBOOT
if (compass.compass_cal_requires_reboot()) {
hal.scheduler->delay(1000);
hal.scheduler->reboot(false);
}
#endif
}
void Copter::accel_cal_update()
@ -192,6 +198,13 @@ void Copter::accel_cal_update()
if(ins.get_new_trim(trim_roll, trim_pitch)) {
ahrs.set_trim(Vector3f(trim_roll, trim_pitch, 0));
}
#ifdef CAL_ALWAYS_REBOOT
if (ins.accel_cal_requires_reboot()) {
hal.scheduler->delay(1000);
hal.scheduler->reboot(false);
}
#endif
}
#if EPM_ENABLED == ENABLED