diff --git a/ROMFS/px4fmu_common/init.d/rcS b/ROMFS/px4fmu_common/init.d/rcS
index b2c9410883a..9d37644533f 100644
--- a/ROMFS/px4fmu_common/init.d/rcS
+++ b/ROMFS/px4fmu_common/init.d/rcS
@@ -813,7 +813,9 @@ fi
 mavlink stop-all
 
 # XXX Stop multicopter attitude controller, the controls come from snapdragon
-mc_att_control stop
+if mc_att_control stop
+then
+fi
 
 # XXX Start snapdragon interface on serial port. On pixfalcon this is the standard telemetry port.
 snapdragon_rc_pwm start -d /dev/ttyS1