IO firmware supports termination failsafe

This commit is contained in:
Lorenz Meier
2014-08-27 08:00:12 +02:00
parent 1fbdca4ee9
commit 49846d476f
3 changed files with 28 additions and 3 deletions

View File

@@ -154,6 +154,16 @@ mixer_tick(void)
}
}
/*
* Check if failsafe termination is set - if yes,
* set the force failsafe flag once entering the first
* failsafe condition.
*/
if ((r_setup_arming & PX4IO_P_SETUP_ARMING_TERMINATION_FAILSAFE) &&
(source == MIX_FAILSAFE)) {
r_setup_arming |= PX4IO_P_SETUP_ARMING_FORCE_FAILSAFE;
}
/*
* Check if we should force failsafe - and do it if we have to
*/