IO failsafe - apply failsafe values to outputs when in failsafe.

This is required because otherwise, IO would output disarmed values if
FMU goes into a disarmed state.
This commit is contained in:
bresch
2019-04-26 18:03:00 +02:00
committed by Beat Küng
parent 96da46d1aa
commit c75f71abc2
+2 -1
View File
@@ -360,7 +360,8 @@ mixer_tick(void)
isr_debug(5, "> PWM disabled");
}
if (mixer_servos_armed && (should_arm || should_arm_nothrottle)
if (mixer_servos_armed
&& (should_arm || should_arm_nothrottle || (source == MIX_FAILSAFE))
&& !(r_setup_arming & PX4IO_P_SETUP_ARMING_LOCKDOWN)) {
/* update the servo outputs. */
for (unsigned i = 0; i < PX4IO_SERVO_COUNT; i++) {