From 4683e20187a482d0b2203e5bbb8bf6e537d348ea Mon Sep 17 00:00:00 2001 From: Lorenz Meier Date: Wed, 29 Jun 2016 12:49:08 +0200 Subject: [PATCH] Clean up camera trigger interface code --- ROMFS/px4fmu_common/init.d/rcS | 22 +++------------------- 1 file changed, 3 insertions(+), 19 deletions(-) diff --git a/ROMFS/px4fmu_common/init.d/rcS b/ROMFS/px4fmu_common/init.d/rcS index 834a4f655a..30fbf5856f 100644 --- a/ROMFS/px4fmu_common/init.d/rcS +++ b/ROMFS/px4fmu_common/init.d/rcS @@ -308,22 +308,6 @@ then set FMU_MODE gpio_serial fi - if param greater TRIG_MODE 0 - then - if [ $PWM_OUT == 1234 ] - then - if ver hwcmp PX4FMU_V4 - then - set FMU_MODE pwm4 - fi - - if ver hwcmp PX4FMU_V2 - then - set FMU_MODE pwm4 - fi - fi - fi - if [ $HIL == yes ] then set OUTPUT_MODE hil @@ -556,13 +540,13 @@ then # clear pins 5 and 6 if param compare SENS_EN_LL40LS 1 then + set FMU_MODE pwm4 set AUX_MODE pwm4 fi if param greater TRIG_MODE 0 then - # Get FMU driver out of the way - set MIXER_AUX none - set AUX_MODE none + set FMU_MODE pwm4 + set AUX_MODE pwm4 camera_trigger start fi fi