From 03434a0b9e24c8001fb7389d533cb5b8f1a2e874 Mon Sep 17 00:00:00 2001
From: Lorenz Meier <lm@inf.ethz.ch>
Date: Sat, 23 Jan 2016 18:25:07 +0100
Subject: [PATCH] Start 3rd MAVLink instance on OSD port

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

diff --git a/ROMFS/px4fmu_common/init.d/rcS b/ROMFS/px4fmu_common/init.d/rcS
index 5e859ae222..4ce6610b1f 100644
--- a/ROMFS/px4fmu_common/init.d/rcS
+++ b/ROMFS/px4fmu_common/init.d/rcS
@@ -550,7 +550,7 @@ then
 			# Avoid using ttyS1 for MAVLink on FMUv4
 			if ver hwcmp PX4FMU_V4
 			then
-				set MAVLINK_F "-r 1200 -d /dev/ttyS2"
+				set MAVLINK_F "-r 1200 -d /dev/ttyS1"
 				# Start MAVLink on Wifi (ESP8266 port)
 				mavlink start -r 800000 -b 921600 -d /dev/ttyS0
 			fi
@@ -560,6 +560,12 @@ then
 	mavlink start $MAVLINK_F
 	unset MAVLINK_F
 
+	if ver hwcmp PX4FMU_V4
+	then
+		# Start MAVLink on OSD (TELEM2 port)
+		mavlink start -r 1200 -d /dev/ttyS2 -b 57600 -m osd
+	fi
+
 	#
 	# MAVLink onboard / TELEM2
 	#