Browse Source

PX4_SAME70XPLAINED_V1:Remove unnesasary conditional for FMU mode

sbg
David Sidrane 7 years ago committed by Daniel Agar
parent
commit
986607b37d
  1. 36
      ROMFS/px4fmu_common/init.d/rcS

36
ROMFS/px4fmu_common/init.d/rcS

@ -426,33 +426,29 @@ then @@ -426,33 +426,29 @@ then
set OUTPUT_MODE uavcan_esc
fi
if ver hwcmp PX4_SAME70XPLAINED_V1
# Sensors on the PWM interface bank
if param compare SENS_EN_LL40LS 1
then
else
# Sensors on the PWM interface bank
if param compare SENS_EN_LL40LS 1
# clear pins 5 and 6
set FMU_MODE pwm4
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
# clear pins 5 and 6
set FMU_MODE pwm4
set AUX_MODE pwm4
else
set FMU_MODE none
set AUX_MODE none
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
# 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
camera_trigger start
param set CAM_FBACK_MODE 1
camera_feedback start
fi
param set CAM_FBACK_MODE 1
camera_feedback start
fi
# If OUTPUT_MODE == none then something is wrong with setup and we shouldn't try to enable output

Loading…
Cancel
Save