PX4_SAME70XPLAINED_V1:Remove unnesasary conditional for FMU mode

This commit is contained in:
David Sidrane
2017-09-17 08:53:04 -10:00
committed by Daniel Agar
parent e967e02c4d
commit 986607b37d
+16 -20
View File
@@ -426,33 +426,29 @@ then
set OUTPUT_MODE uavcan_esc set OUTPUT_MODE uavcan_esc
fi fi
if ver hwcmp PX4_SAME70XPLAINED_V1 # Sensors on the PWM interface bank
if param compare SENS_EN_LL40LS 1
then then
else # clear pins 5 and 6
# Sensors on the PWM interface bank set FMU_MODE pwm4
if param compare SENS_EN_LL40LS 1 set AUX_MODE pwm4
fi
if param greater TRIG_MODE 0
then
# We ONLY support trigger on pins 5 and 6 when simultanously using AUX for actuator output
if param compare TRIG_PINS 56
then then
# clear pins 5 and 6 # clear pins 5 and 6
set FMU_MODE pwm4 set FMU_MODE pwm4
set AUX_MODE pwm4 set AUX_MODE pwm4
else
set FMU_MODE none
set AUX_MODE none
fi fi
if param greater TRIG_MODE 0 camera_trigger start
then
# 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
param set CAM_FBACK_MODE 1 param set CAM_FBACK_MODE 1
camera_feedback start camera_feedback start
fi
fi fi
# If OUTPUT_MODE == none then something is wrong with setup and we shouldn't try to enable output # If OUTPUT_MODE == none then something is wrong with setup and we shouldn't try to enable output