rcS : properly handle trigger/actuator pin mixing

This commit is contained in:
Mohammed Kabir 2017-04-03 18:06:46 +02:00 committed by Lorenz Meier
parent 827725fbe0
commit 95778c74e2
1 changed files with 11 additions and 3 deletions

View File

@ -462,16 +462,24 @@ then
fi
# Sensors on the PWM interface bank
# clear pins 5 and 6
if param compare SENS_EN_LL40LS 1
then
# clear pins 5 and 6
set FMU_MODE pwm4
set AUX_MODE pwm4
fi
if param greater TRIG_MODE 0
then
set FMU_MODE pwm4
set AUX_MODE pwm4
# We ONLY support trigger on pins 5 and 6 when simultanously using AUX for actuator output
if param compare TRIG_PINS 56
then
# clear pins 5 and 6
set FMU_MODE pwm4
set AUX_MODE pwm4
else
set FMU_MODE none
set AUX_MODE none
fi
camera_trigger start
fi