diff --git a/mk/PX4/ROMFS/init.d/rc.APM b/mk/PX4/ROMFS/init.d/rc.APM
index 5fd9eee363..f742f7ec37 100644
--- a/mk/PX4/ROMFS/init.d/rc.APM
+++ b/mk/PX4/ROMFS/init.d/rc.APM
@@ -193,8 +193,10 @@ then
         echo "Setting FMU mode_serial"
         fmu mode_serial
 else
-        echo "Setting FMU mode_pwm"
-        fmu mode_pwm
+        if fmu mode_pwm4
+        then
+                echo "Set FMU mode_pwm4"
+        fi
 fi