From d5a9dffd43b699dfd482fb2ef70677e759eda2af Mon Sep 17 00:00:00 2001
From: Lorenz Meier <lm@inf.ethz.ch>
Date: Thu, 23 Apr 2015 13:33:54 +0200
Subject: [PATCH] Startup script: Add OSD support

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

diff --git a/ROMFS/px4fmu_common/init.d/rcS b/ROMFS/px4fmu_common/init.d/rcS
index 67ec7821c9..e2b247a76c 100644
--- a/ROMFS/px4fmu_common/init.d/rcS
+++ b/ROMFS/px4fmu_common/init.d/rcS
@@ -461,10 +461,16 @@ then
 	#
 	if ver hwcmp PX4FMU_V2
 	then
+		# XXX We need a better way for runtime eval of shell variables,
+		# but this works for now
 		if param compare SYS_COMPANION 921600
 		then
 			mavlink start -d /dev/ttyS2 -b 921600 -m onboard -r 20000
 		fi
+		if param compare SYS_COMPANION 57600
+		then
+			mavlink start -d /dev/ttyS2 -b 57600 -m onboard -r 1000
+		fi
 	fi
 
 	# UAVCAN