reset position hold flag

This commit is contained in:
tumbili 2015-11-24 16:57:19 +01:00
parent da59e632b2
commit 78ace92530
1 changed files with 10 additions and 0 deletions

View File

@ -1141,6 +1141,16 @@ MulticopterPositionControl::task_main()
_run_pos_control = true; _run_pos_control = true;
_run_alt_control = true; _run_alt_control = true;
// reset the horizontal and vertical position hold flags for non-manual modes
// or if position is not controlled
if (!_control_mode.flag_control_position_enabled || !_control_mode.flag_control_manual_enabled) {
_pos_hold_engaged = false;
}
if (!_control_mode.flag_control_altitude_enabled || !_control_mode.flag_control_manual_enabled) {
_alt_hold_engaged = false;
}
/* select control source */ /* select control source */
if (_control_mode.flag_control_manual_enabled) { if (_control_mode.flag_control_manual_enabled) {
/* manual control */ /* manual control */