Merge branch 'master' of github.com:PX4/Firmware into fmuv2_bringup

ROMFS/px4fmu_common/init.d/rc.usb

@@ -13,13 +13,14 @@ if mavlink stop
 then
 	echo "stopped other MAVLink instance"
 fi
+sleep 2
 mavlink start -b 230400 -d /dev/ttyACM0
 
-if [ $MODE == autostart ]
-then
-
 # Start the commander
-	commander start
+if commander start
+then
+	echo "Commander started"
+fi
 
 # Start sensors
 sh /etc/init.d/rc.sensors
@@ -42,7 +43,6 @@ then
 then
 	echo "GPS started"
 fi
-fi
 
 echo "MAVLink started, exiting shell.."