Hotfix for USB: Starting MAVLink only on USB if connected. Needs rewrite of MAVLink and delay / retries for correct approach

ROMFS/px4fmu_common/init.d/rcS

@@ -63,9 +63,8 @@ then
 	if sercon
 	then
 		echo "USB connected"
-	else
-		# second attempt
-		sercon &
+		sleep 3
+		mavlink start -d /dev/ttyACM0 -b 230400
 	fi
 	
 	#
@@ -105,7 +104,7 @@ then
 	fi
 
 	# Try to get an USB console
-	nshterm /dev/ttyACM0 &
+	#nshterm /dev/ttyACM0 &
 	
 	#
 	# Upgrade PX4IO firmware
@@ -219,5 +218,6 @@ then
 		gps start
 	
 	fi
+
 # End of autostart
 fi

src/modules/mavlink/mavlink.c

@@ -516,7 +516,6 @@ void mavlink_update_system(void)
 int mavlink_thread_main(int argc, char *argv[])
 {
 	/* initialize mavlink text message buffering */
-	usleep(1000);
 	mavlink_logbuffer_init(&lb, 10);
 
 	int ch;