diff --git a/ROMFS/px4fmu_common/init.d/rcS b/ROMFS/px4fmu_common/init.d/rcS
index e6d95e59f7276ca929a905ad18034d55257998d3..ef0375ce82d4f6283f39a3366c29107107fb69b8 100644
--- a/ROMFS/px4fmu_common/init.d/rcS
+++ b/ROMFS/px4fmu_common/init.d/rcS
@@ -298,6 +298,17 @@ 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
+		fi
+	fi
+
 	if [ $HIL == yes ]
 	then
 		set OUTPUT_MODE hil