From a82bcbf1d70c71f0e2b282a86029ad614a02ba6d Mon Sep 17 00:00:00 2001
From: Lorenz Meier <lm@inf.ethz.ch>
Date: Wed, 4 Mar 2015 09:04:01 +0100
Subject: [PATCH] Fix IO update when safety can not be set to on. From
 @zottgrammes

---
 ROMFS/px4fmu_common/init.d/rcS | 5 +++++
 1 file changed, 5 insertions(+)

diff --git a/ROMFS/px4fmu_common/init.d/rcS b/ROMFS/px4fmu_common/init.d/rcS
index 9118f26013..1d21d77727 100644
--- a/ROMFS/px4fmu_common/init.d/rcS
+++ b/ROMFS/px4fmu_common/init.d/rcS
@@ -200,8 +200,13 @@ then
 
 			if px4io start
 			then
+				# try to safe px4 io so motor outputs dont go crazy
 				if px4io safety_on
 				then
+					# success! no-op
+				else
+					# px4io did not respond to the safety command
+					px4io stop
 				fi
 			fi