From 51e0ccb199fa73571ca0cd0f366e9453e0741bed Mon Sep 17 00:00:00 2001
From: Anton Babushkin <anton.babushkin@me.com>
Date: Mon, 31 Mar 2014 10:10:50 +0400
Subject: rcS: removed unnecessary sleeps, minor code style fixes

---
 ROMFS/px4fmu_common/init.d/rcS | 10 ++++------
 1 file changed, 4 insertions(+), 6 deletions(-)

(limited to 'ROMFS')

diff --git a/ROMFS/px4fmu_common/init.d/rcS b/ROMFS/px4fmu_common/init.d/rcS
index 503dbb83e..0cb6d281a 100644
--- a/ROMFS/px4fmu_common/init.d/rcS
+++ b/ROMFS/px4fmu_common/init.d/rcS
@@ -294,6 +294,7 @@ then
 				tone_alarm $TUNE_OUT_ERROR
 			fi
 		fi
+		
 		if [ $OUTPUT_MODE == fmu -o $OUTPUT_MODE == ardrone ]
 		then
 			echo "[init] Use FMU as primary output"
@@ -317,6 +318,7 @@ then
 				fi
 			fi
 		fi
+		
 		if [ $OUTPUT_MODE == mkblctrl ]
 		then
 			echo "[init] Use MKBLCTRL as primary output"
@@ -338,7 +340,8 @@ then
 				tone_alarm $TUNE_OUT_ERROR
 			fi
 			
-		fi		
+		fi
+				
 		if [ $OUTPUT_MODE == hil ]
 		then
 			echo "[init] Use HIL as primary output"
@@ -396,34 +399,29 @@ then
 	#
 	# MAVLink
 	#
-	
 	if [ $MAVLINK_FLAGS == default ]
 	then
 		if [ $HIL == yes ]
 		then
 			sleep 1
 			set MAVLINK_FLAGS "-r 10000 -d /dev/ttyACM0"
-			usleep 5000
 		else
 			# Normal mode, use baudrate 57600 (default) and data rate 1000 bytes/s
 			if [ $TTYS1_BUSY == yes ]
 			then
 				# Start MAVLink on ttyS0, because FMU ttyS1 pins configured as something else
 				set MAVLINK_FLAGS "-r 1000 -d /dev/ttyS0"
-				usleep 5000
 				
 				# Exit from nsh to free port for mavlink
 				set EXIT_ON_END yes
 			else
 				# Start MAVLink on default port: ttyS1
 				set MAVLINK_FLAGS "-r 1000"
-				usleep 5000
 			fi
 		fi
 	fi
 
 	mavlink start $MAVLINK_FLAGS
-	usleep 5000
 	
 	#
 	# Start the datamanager
-- 
cgit v1.2.3